#include <Servo.h>
Servo Xservo;
Servo Yservo;
int XSpin=6;
int YSpin=3;
int WVx;
int WVy;

int Xpin=A4;
int Ypin=A5;
int Spin=2;
int Xval;
int Yval;
int Sval;
int dt = 200;


void setup() {  

  Serial.begin(9600);
  pinMode(Xpin, INPUT);
  pinMode(Ypin, INPUT);
  pinMode(Spin, INPUT);
  pinMode(XSpin, OUTPUT);
  pinMode(YSpin, OUTPUT);
  digitalWrite(Spin, HIGH);

  Xservo.attach(XSpin);
  Yservo.attach(YSpin);

  
  // put your setup code here, to run once:

}

void loop() {


  Xval=analogRead(Xpin);
  Yval=analogRead(Ypin);
  Sval=digitalRead(Spin);
  delay(dt);
  WVx=(180./1023.)*Xval;
  WVy=(180./1023.)*Yval;
  Xservo.write(WVx);
  Yservo.write(WVy);

  Serial.print("     Xval = " );
  Serial.print(Xval);
  Serial.print("     Yval = ");
  Serial.print(Yval);
  Serial.print("     Sval = ");
  Serial.print(Sval);

  
  // put your main code here, to run repeatedly:

}