#include <Servo.h>
Servo Xservo;
Servo Yservo;
int XSpin=9;
int YSpin=10;
int WVx;
int WVy;
int Xpin=A2;
int Ypin=A1;
int Spin=2;
int Xval;
int Yval;
int Sval;
int buzzPin=4;
int dt=250;
void setup() {
// put your setup code here, to run once:
Serial.begin(115200);
pinMode(XSpin, OUTPUT);
pinMode(YSpin, OUTPUT);
pinMode(Xpin, INPUT);
pinMode(Ypin, INPUT);
pinMode(Spin, INPUT);
pinMode(buzzPin, OUTPUT);
Xservo.attach (XSpin);
Yservo.attach (YSpin);
digitalWrite(Spin, HIGH);
}
void loop() {
// put your main code here, to run repeatedly:
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);
if (Sval==0);{
digitalWrite(buzzPin, HIGH);
}
if (Sval==1);{
digitalWrite(buzzPin, LOW);
}
Serial.println(Sval);
}