#include <Servo.h>
Servo SV1;
Servo SV2;

void setup() {
  // put your setup code here, to run once:
  //Serial.begin(9600);
  pinMode(A0, INPUT);
  pinMode(A1, INPUT);
  pinMode(2, INPUT);
  pinMode(3, OUTPUT);
  pinMode(13, OUTPUT);

  SV1.attach(9);
  SV2.attach(6);
  SV1.write(90);
  SV2.write(90);
  delay(1000);
  digitalWrite(3, HIGH);
  digitalWrite(13, HIGH);
  delay(150);
  digitalWrite(3, LOW);
  digitalWrite(13, LOW);
  delay(150);
  digitalWrite(3, HIGH);
  digitalWrite(13, HIGH);

  SV1.write(0);
  SV2.write(0);

  delay(1000);

  for(int Pos=0; Pos<=180; Pos++){
    SV1.write(Pos);
    SV2.write(Pos);
    delay(20);
  }
 for(int Pos=180; Pos>=0; Pos--){
    SV1.write(Pos);
    SV2.write(Pos);
    delay(5);
  }
  delay(500);
  for(int Pos=0; Pos<=90; Pos++){
    SV1.write(Pos);
    SV2.write(Pos);
    delay(5);
  }

  digitalWrite(3, LOW);
  digitalWrite(13, LOW);

  delay(100);
}

void loop() {
  // put your main code here, to run repeatedly:
 
  int Ver0 = analogRead(A0);
  int Hor0 = analogRead(A1);
  bool digS = digitalRead(2);
 
  float Ver = 1024-analogRead(A0);
  float Hor = 1024-analogRead(A1);

  //Serial.println(Ver);
  //Serial.println(Hor);
  //delay(500);

  float Ver1 = Ver/1024;
  float Hor1 = Hor/1024;

  //Serial.println(Ver1);
  //Serial.println(Hor1);
  //delay(500);

  int Ver2 = Ver1*180;
  int Hor2 = Hor1*180;

  SV1.write(Ver2);
  SV2.write(Hor2);

  if((Ver0!=512)||(Hor0!=512)){
    digitalWrite(3, HIGH);
  }else{
    digitalWrite(3,LOW);
  }
  if(digS == HIGH){
    digitalWrite(13, HIGH);
  }else{
    digitalWrite(13, LOW);
  }

  //Serial.println(digS);


}