#include <Servo.h>
Servo servo;
int led1 = 10;
int led2 = 9;
int JoyX = A0;
int JoyY = A1;
int test = 5;
int servopin = 11;
void setup ()
{
servo.attach(servopin);
pinMode (led1, OUTPUT);
pinMode (led2, OUTPUT);
pinMode (JoyX, INPUT);
pinMode (JoyY, INPUT);
Serial.begin(9600);
}
void loop (){
int Xvalue = analogRead (JoyX);
int JoyOutX = map (Xvalue, 0, 1023, 0, 180);
int Yvalue = analogRead (JoyY);
int JoyOutY = map (Yvalue, 0, 1023, 0, 180);
Serial.print (JoyOutX);
Serial.print (" --- ");
Serial.print (test);
Serial.print (" --- ");
Serial.println (JoyOutY);
if (JoyOutY>135 || JoyOutY<45)
{while(test!=5) {
test = abs(test-5);
}
}
else {
if (JoyOutX>135) {
while (test<10) {
test++;
}
}
else if (JoyOutX<45) {
while (test>0) {
test--;
}
}
else {
digitalWrite (led1, LOW);
digitalWrite (led2, LOW);
}
if (test>5) {
digitalWrite (led1, HIGH);
digitalWrite (led2, LOW);
servo.write(0);
}
else if (test<5)
{
digitalWrite (led1, LOW);
digitalWrite (led2, HIGH);
servo.write(180);
}
else {
digitalWrite (led1, LOW);
digitalWrite (led2, LOW);
servo.write(90);
}
}
}