#include<Servo.h>
int x = A5;
int y = A4;
int x2 = A3;
int y2 = A2;
int SRV = 3;
int SRV2 = 5;
int SRV3 = 6;
int SRV4 = 9;
Servo motor;
Servo motor2;
Servo motor3;
Servo motor4;
void setup() {
Serial.begin(9600);
motor.attach(SRV);
motor2.attach(SRV2);
motor3.attach(SRV3);
motor4.attach(SRV4);
motor.write(0);
pinMode(x, INPUT);
pinMode(y, INPUT);
pinMode(x2, INPUT);
pinMode(y2, INPUT);
}
void loop() {
int egx = analogRead(x);
int xang = map(egx, 0, 1023, 0, 180 );
int egy = analogRead(y);
int yang = map(egy, 0, 1023, 0, 180 );
int egx2 = analogRead(x2);
int xang2 = map(egx2, 0, 1023, 0, 180 );
int egy2 = analogRead(y2);
int yang2 = map(egy2, 0, 1023, 0, 180 );
Serial.print("angulo x: ");
Serial.print(xang);
Serial.print(" ");
Serial.print("angulo y: ");
Serial.print(yang);
Serial.println(" ");
Serial.print("angulo x2: ");
Serial.print(xang2);
Serial.print(" ");
Serial.print("angulo y2: ");
Serial.print(yang2);
Serial.println(" ");
motor.write(xang);
motor2.write(yang);
motor3.write(xang2);
motor4.write(yang2);
delay(550);
}