#include<Servo.h>
Servo m1;
Servo m2;
Servo m3;
Servo m4;
Servo m5;
Servo m6;

void setup()
{
  m1.attach(5); // va a ser el servomotor de la cadera derecha
  m2.attach(6); // va a ser el servomotor de la rodilla derecha
  m3.attach(7); // va a ser el servomotor del tobillo derecho
  m4.attach(10); // va a ser el servomotor de la cadera izquierda
  m5.attach(9); // va a ser el servomotor de la rodilla izquierda
  m6.attach(8); // va a ser el servomotor del tobillo izquierda

  m1.write(90); //Más de 90 grados cadera hacia en frente
  m2.write(90); //Más de 90 grados rodilla hacia atrás
  m3.write(95);//Más de 90 grados el tobillo se mueve hacia adelante
  m4.write(95); //Menos de 90 grados cadera hacia en frente
  m5.write(90);//Si es 50 dobla la rodilla bien
  m6.write(75); //90 Dobla estiende el tobillo va hacia atras
  delay(2000);
  
}

void loop()
{
  m1.write(130);
  m2.write(130);
  m3.write(100);
  m4.write(115);
  m5.write(90);
  m6.write(85);
  delay(1000);
  /*m1.write(90);
  m2.write(90);
  m3.write(95);
  m4.write(95);
  m5.write(90);
  m6.write(75);
  delay(800);*/
  m1.write(80);
  m2.write(90);
  m3.write(75);
  m4.write(55);
  m5.write(50);
  m6.write(65);
  delay(1000);    
 

}