#include <Servo.h>
Servo xServo;
Servo yServo;
int xPin = A0;
int yPin = A1;
int sPin = 2;
int xVal;
int yVal;
int sVal;
int dur = 200;
String part1 = "X value: ";
String part2 = ", Y value: ";
String part3 = ", S state: ";
int xServoPin = 9;
int yServoPin = 10;
int buzzPin = 7;
int WVx;
int WVy;
void setup() {
// put your setup code here, to run once:
Serial.begin(9600);
pinMode(xPin, INPUT);
pinMode(yPin, INPUT);
pinMode(sPin, INPUT);
digitalWrite(sPin, HIGH);
pinMode(xServoPin, OUTPUT);
pinMode(yServoPin, OUTPUT);
pinMode(buzzPin, OUTPUT);
xServo.attach(xServoPin);
yServo.attach(yServoPin);
}
void loop() {
xVal = analogRead(xPin);
WVx= (180./ 1023.) * xVal;
yVal = analogRead(yPin);
WVy= (180./ 1023.) * yVal;
sVal = digitalRead(sPin);
xServo.write(WVx);
yServo.write(WVy);
if(sVal == 0){
digitalWrite(buzzPin, HIGH);
} else {
digitalWrite(buzzPin, LOW);
}
delay(dur);
Serial.println( part1 + xVal + part2 + yVal + part3 + sVal);
//Serial.println("WVx: " + WVx);
//Serial.println("WVy: " + WVy);
}