#include <Servo.h>
Servo motor;
Servo motor2;
int X;
int Y;
int angulo=90;
int angul=90;
int sw;



void setup() {
  motor.attach(6);
  motor2.attach(9);
  pinMode(10, INPUT);
  


}

void loop(){
  X = analogRead(A0);                        //1023--520-480---0
  Y = analogRead(A1);
  sw = digitalRead(10);
  
  if(X>700){
    angulo +=3;
    motor.write(angulo);
  delay(15);
  }  
  if(X<700 && X>520){
    angulo +=1;
    motor.write(angulo);
  delay(15);
  }                    
  if(X<200){
    angulo -=3;
    motor.write(angulo);
  delay(15);
  }
  if(X>200 && X<480){
    angulo -=1;
    motor.write(angulo);
  delay(15);
  } 
  if(Y>700){
    angul +=3;
    motor2.write(angul);
  delay(15);
  }           
   if(Y<700 && Y>520){
    angul +=1;
    motor2.write(angul);
  delay(15);
  }            
  if(Y<200){
    angul -=3;
    motor2.write(angul);
  delay(15);
  }
  if(Y>200 && Y<480){
    angul -=1;
    motor2.write(angul);
  delay(15);
  }
  if(sw==1){
    angul =90;
    angulo =90;
    motor.write(angulo);
    motor2.write(angul);
    delay(15);

  }
}