#include <Servo.h> //Миша СПб
Servo servo_3; Servo servo_4;
int x_grad ; int y_grad ;
int x , y ;
void setup() { Serial.begin(9600);
pinMode(A2, INPUT); //поворот
pinMode(A3, INPUT); //клешня
servo_3.attach(11); servo_3.write(90); //поворот(начало)
servo_4.attach(5); servo_4.write(90); //Исправить на 0 клешня(начало)
// Какие attach() каким джойстикаам соотв.?
}
void loop() {
y = analogRead(A2); Serial.println(y); //поворот
x = analogRead(A3); Serial.println(x); //клешня
if(y < 400) y_grad -= 7;
else if(y > 600) y_grad += 7;
if(x < 400) x_grad -= 7;
else if(x > 600) x_grad += 7;
if(y_grad>180) y_grad=180; // поворот
if(y_grad<0) y_grad=0;
if(x_grad>180) x_grad=180; //клешня Лучше 0
if(x_grad<175) x_grad=175; // Лучше 5
servo_3.write(y_grad);
servo_4.write(x_grad);
delay(100);
}
Вниз
Вниз
Вверх
клешня
поворот
X
Y
Вверх