código brazo robot

#include <Servo.h> // Incluir la librería Servo
Servo servo1; // Crear un objeto tipo Servo llamado servo1
Servo servo2; // Crear un objeto tipo Servo llamado servo2
int anguloX = 90 ; // Empezamos en el centro
int anguloY = 90 ;
int salto = 10 ; // Controla el salto por movimient
void setup()
{
 servo1.attach(5) ; // Conectar servo1 al pin 7
 servo2.attach(6) ; // Conectar servo1 al pin 8
}
void loop()
{
 //EJE X
 int p = analogRead(A0);
 if ( p < 400 ) // Si la lectura es menor de 400
 anguloX = anguloX - salto ;
   if (anguloX<20){
    anguloX=20;
   }
  // disminuimos el angulo
 else if (p > 600) // Si mayor de 600
 anguloX = anguloX + salto ;
 if (anguloX>170){
  anguloX=170;// Aumentamos el angulo
 }
 servo1.write(anguloX); // Y este es el que mueve el servo 1
// delay (50); // Este delay regula la velocidad del movimiento

 //EJE Y
 int q = analogRead(A1);
 if ( q < 400 ) // Si la lectura es menor de 400
 anguloY = anguloY - salto ;
 if (anguloY<20){
  anguloY=20;// disminuimos el angulo
 }
 else if (q > 600) // Si mayor de 600
 anguloY = anguloY + salto ;
 if(anguloY>170){
  anguloY=170;// Aumentamos el angulo
 }
 servo2.write(anguloY); // Y este es el que mueve el servo 2
 delay (50); // Este delay regula la velocidad del movimiento
}