#include <Servo.h>

int valorX = 0; //LECTURA DEL EJE X
int valorY = 0; // LECTURA DEL EJE Y
int valorZ = 0;
int valorW = 0;
int valorR = 0;
int valorS = 0;
int pinJX = A0; // PIN ANALOGICO A0 DEL EJE X
int pinJY = A1; // PIN ANALOGICO A1 DEL EJE Y
int pinJZ = A2;
int pinJW = A3;
int pinJR = A4;
int pinJS = A5;
Servo motor1; // DECLARAR SERVO 
Servo motor2; // DECLARAR SERVO 2
Servo motor3;
Servo motor4;
Servo motor5;
Servo motor6;
int grados1 = 0; // GRADOS DEL SERVO 1
int grados2 = 0; // GRADOS DEL SERVO 2
int grados3 = 0;
int grados4 = 0;
int grados5 = 0;
int grados6 = 0;

void setup() {
  Serial.begin(9600); // ACTIVA LA COMUNICACION CON LA PLACA BUILD&CODE UNO
  motor1.attach(6); // PIN DIGITAL PWM 6 DONDE ESTA CONECTADPO EL SERVO 1
  motor1.write(0);
  motor2.attach(9); // PIN DIGITAL PWM 9 DONDE ESTA CONECTADO EL SERVO 2
  motor2.write(0);
  motor3.attach(11);
  motor3.write(0);
  motor4.attach(10);
  motor4.write(0);
  motor5.attach(5);
  motor5.write(0);
  motor6.attach(3);
  motor6.write(0);
}

void loop () {

  valorX = analogRead(pinJX); // LECTURA DEL PUERTO ANALOGO. A0 DEL EJE X
  valorY = analogRead(pinJY); // LECTURA DEL PUERTO ANALOGO A1 DEL EJE Y
  valorZ = analogRead(pinJZ);
  valorW = analogRead(pinJW);
  valorR = analogRead(pinJR);
  valorS = analogRead(pinJS);

  grados1 = map(valorX,0,1023,0,180);
  grados2 = map(valorY,0,1023,0,180);
  grados3 = map(valorZ,0,1023,0,180);
  grados4 = map(valorW,0,1023,0,180);
  grados5 = map(valorR,0,1023,0,180);
  grados6 = map(valorS,0,1023,0,180);


  motor1.write(grados1); // ENVIAR LOS GRADOS DEL SERVO 1
  motor2.write(grados2); // ENVIAR LOS GRADOS AL SERVO 2
  motor3.write(grados3);
  motor4.write(grados4);
  motor5.write(grados5);
  motor6.write(grados6);
}