#include <Servo.h>
Servo myservo1;
Servo myservo2;
int joyPin1 = 0; // davant 3 - darrera 1023
int joyPin2 = 1; //esquerra 1023 - dreta 0
void setup() {
Serial.begin(9600);
myservo1.attach(9);
myservo2.attach(10);
pinMode(joyPin1, INPUT);
pinMode(joyPin2, INPUT);
}
void loop() {
int davant_darrera = analogRead(joyPin1);
int esquerra_dreta = analogRead(joyPin2);
Serial.println(davant_darrera);
if (davant_darrera<200) //davant
{
Serial.println("Endevant...");
myservo1.write(0);
myservo2.write(180);
}
else if (davant_darrera>800)//darrera
{Serial.println("Darrera...");
myservo1.write(180);
myservo2.write(0);
}
else if (esquerra_dreta<200) //dreta
{
myservo1.write(0);
myservo2.write(0);
}
else if (esquerra_dreta>800)//esquerra
{
myservo1.write(180);
myservo2.write(180);
}
else
{
Serial.println("Aturat...");
myservo1.write(90);
myservo2.write(90);
}
delay(100);
}
I2luY2x1ZGUgPFNlcnZvLmg+ClNlcnZvIG15c2Vydm8xOyAgClNlcnZvIG15c2Vydm8yOyAgCiBpbnQgam95UGluMSA9IDA7ICAvLyBkYXZhbnQgMyAtIGRhcnJlcmEgMTAyMyAgICAgICAgICAgICAgIAogaW50IGpveVBpbjIgPSAxOyAgLy9lc3F1ZXJyYSAxMDIzIC0gZHJldGEgMCAgICAgICAgICAgICAgIAogICAgICAgICAgICAgCiB2b2lkIHNldHVwKCkgewogICAgU2VyaWFsLmJlZ2luKDk2MDApOwogICAgbXlzZXJ2bzEuYXR0YWNoKDkpOwogICAgbXlzZXJ2bzIuYXR0YWNoKDEwKTsKICAgIHBpbk1vZGUoam95UGluMSwgSU5QVVQpOwogICAgcGluTW9kZShqb3lQaW4yLCBJTlBVVCk7CiB9CgogIHZvaWQgbG9vcCgpIHsKICBpbnQgZGF2YW50X2RhcnJlcmEgPSBhbmFsb2dSZWFkKGpveVBpbjEpOyAgCiAgaW50IGVzcXVlcnJhX2RyZXRhID0gYW5hbG9nUmVhZChqb3lQaW4yKTsKICBTZXJpYWwucHJpbnRsbihkYXZhbnRfZGFycmVyYSk7ICAKICBpZiAoZGF2YW50X2RhcnJlcmE8MjAwKSAvL2RhdmFudAogICAgewogICAgICBTZXJpYWwucHJpbnRsbigiRW5kZXZhbnQuLi4iKTsKICAgICAgbXlzZXJ2bzEud3JpdGUoMCk7CiAgICAgIG15c2Vydm8yLndyaXRlKDE4MCk7CiAgICB9CiAgICBlbHNlIGlmIChkYXZhbnRfZGFycmVyYT44MDApLy9kYXJyZXJhCiAgICB7U2VyaWFsLnByaW50bG4oIkRhcnJlcmEuLi4iKTsKICAgICAgbXlzZXJ2bzEud3JpdGUoMTgwKTsKICAgICAgbXlzZXJ2bzIud3JpdGUoMCk7CiAgICB9CiAgIGVsc2UgaWYgKGVzcXVlcnJhX2RyZXRhPDIwMCkgLy9kcmV0YQogICAgewogICAgICBteXNlcnZvMS53cml0ZSgwKTsKICAgICAgbXlzZXJ2bzIud3JpdGUoMCk7CiAgICB9CiAgICBlbHNlIGlmIChlc3F1ZXJyYV9kcmV0YT44MDApLy9lc3F1ZXJyYQogICAgewogICAgICBteXNlcnZvMS53cml0ZSgxODApOwogICAgICBteXNlcnZvMi53cml0ZSgxODApOwogICAgfQogICAgZWxzZQogICAgewogICAgICBTZXJpYWwucHJpbnRsbigiQXR1cmF0Li4uIik7CiAgICAgIG15c2Vydm8xLndyaXRlKDkwKTsKICAgICAgbXlzZXJ2bzIud3JpdGUoOTApOwogICAgfSAKICAgIGRlbGF5KDEwMCk7CiB9