#include <Servo.h>
Servo servo1;
Servo servo2;
Servo servo3;
Servo servo4;
const int pinServo1 = 5;
const int pinServo2 = 6;
const int pinServo3 = 9;
const int pinServo4 = 10;
const int pinX1 = A1;
const int pinY1 = A0;
const int pinX2 = A2;
const int pinY2 = A3;
// светодиоды
const int LED1=A4;
const int LED2=A5;
void setup() {
// put your setup code here, to run once:
servo1.attach(pinServo1);
servo2.attach(pinServo2);
servo3.attach(pinServo3);
servo4.attach(pinServo4);
pinMode(pinX1, INPUT);
pinMode(pinY1, INPUT);
pinMode(pinX2, INPUT);
pinMode(pinY2, INPUT);
// светодиоды
// #1
pinMode(LED1, OUTPUT);
// #2
pinMode(LED2, OUTPUT);
}
void loop() {
freeMode();
}
void freeMode() {
int X1 = analogRead(pinX1);
int Y1 = analogRead(pinY1);
int X2 = analogRead(pinX2);
int Y2 = analogRead(pinY2);
// 1
int yAngle1 = map(Y1, 1023, 0, 180, 0);
int xAngle1 = map(X1, 0, 1023, 0, 180);
// 2
int yAngle2 = map(Y2, 0, 1023, 0, 180);
int xAngle2 = map(X2, 0, 1023, 180, 0);
// левая
servo1.write(xAngle2);
servo3.write(yAngle2);
// правая
servo2.write(xAngle1);
servo4.write(yAngle1);
// светодиоды
// #1
analogWrite(LED1, HIGH);
// #2
digitalWrite(LED2, HIGH);
delay(500);
digitalWrite(LED2, LOW);
delay(500);
}