#include <Servo.h>
Servo servo1;
Servo servo2;
int joyX = A3;
int joyY = A4;
const int buttonPin1 = A0;
const int buttonPin2 = A5;
int buttonState = 0;
int camx = 0;
int camy = 0;
int state = 0;
int servoVal;
int LEFT_THRESHOLD = 400;
int RIGHT_THRESHOLD = 800;
int UP_THRESHOLD = 400;
int DOWN_THRESHOLD = 800;
int xValue = 90; // To store value of the X axis
int yValue = 90; // To store value of the Y axis
int xAngle = 90; // To store value of the X axis
int yAngle = 90; // To store value of the Y axis
void setup() {
// put your setup code here, to run once:
servo1.attach(A1);
servo2.attach(A2);
pinMode(buttonPin1, INPUT);
}
void loop() {
xValue = analogRead(joyX);
yValue = analogRead(joyY);
// put your main code here, to run repeatedly:
buttonState = digitalRead(buttonPin1);
if (buttonState == HIGH) {
servo1.write(0);
servo2.write(0);
xAngle=0;
yAngle=0;
delay(30); }
else {
if (xValue < LEFT_THRESHOLD){
if (xAngle > 0){
xAngle -= 5;
servo1.write(xAngle);
}
}
else if (xValue > RIGHT_THRESHOLD){
if (xAngle < 180){
xAngle += 5;
servo1.write(xAngle);
}
}
if (yValue < UP_THRESHOLD){
if (yAngle > 0){
yAngle -= 5;
servo2.write(yAngle);
}
}
else if (yValue > DOWN_THRESHOLD){
if (yAngle < 180){
yAngle += 5;
servo2.write(yAngle);
}
}
delay(50);
}
}