#include <Servo.h>
int Xin=A1;
int Yin=A0;
int Sin=5;
int servo1Pin=11;
int servo2Pin=10;
int servo1Val;
int servo2Val;
int angleX;
int angleY;
int Xval;
int Yval;
int Sval;
int dt=500;
Servo servo1;
Servo servo2;
void setup() {
// put your setup code here, to run once:
pinMode(Xin,INPUT);
pinMode(Yin,INPUT);
pinMode(Sin,INPUT);
pinMode(servo1Pin,OUTPUT);
pinMode(servo2Pin,OUTPUT);
servo1.attach(servo1Pin);
servo2.attach(servo2Pin);
Serial.begin(9600);
}
void loop() {
Xval=analogRead(Xin);
Yval=analogRead(Yin);
Sval=analogRead(Sin);
Serial.print("Horiz : ");
Serial.print( Xval);
Serial.print(" , ");
Serial.print("Vert : ");
Serial.print( Yval);
angleX=(180./1023.)*Xval;
angleY=(180./1023.)*Yval;
servo1.write(angleX);
servo2.write(angleY);
Serial.print(" , X Angle : ");
Serial.print( angleX);
Serial.print(" , ");
Serial.print("Y Angle : ");
Serial.println( angleY);
}