#include <Servo.h>

Servo Left0;
Servo Left1;
Servo Left2;
Servo Right0;
Servo Right1;
Servo Right2;

void setup()
{
  Left0.attach(2);//pies
  Left1.attach(3);  //rodilla
  Left2.attach(4);//cadera
  Right1.attach(11);//cadera
  Right2.attach(10);//rodilla
  Right0.attach(9); //pies
  Serial.begin(9600);

}
//YA QUEDO//
void loop(){
  //Serial.println("Contacto Inicial R - prewing L");
  //Contacto Inicial
  Left0.write(90);//pies
  Left1.write(90);//rodilla
  Left2.write(90);//cadera

  Right0.write(130);//pata
  Right1.write(60);//cadera
  Right2.write(30);//rodilla
  delay(1000);
  //YA QUEDO//
 //Serial.println("Carga" - Swing inicial);
  //Respuesta a carga
  Left0.write(100);//pata
  Left1.write(120);//rodilla
  Left2.write(90);//cadera

  Right0.write(100);//pata
  Right1.write(50);//cadera
  Right2.write(80);//rodille
  delay(1000);
//YA QUEDO//
  //Media
  //Serial.println(" Media - Swing medio");
  Left0.write(160);//pies
  Left1.write(130);//rodilla
  Left2.write(150);//cadera

  Right0.write(70);//pata
  Right1.write(80);//cadera
  Right2.write(70);//rodilla
  delay(1000);
//YA QUEDO//
 //Serial.println(" Terminal- swing terminal");
  Left0.write(60);//pata
  Left1.write(130);//rodilla
  Left2.write(150);//cadera

  Right0.write(90);//pata
  Right1.write(90);//cadera
  Right2.write(90);//rodilla
  delay(1000);
  /*YA QUEDO
//Serial.println(" Preswing - Choque de talon");
  //Pre-swing
  Left0.write(50);//pata
  Left1.write(100);//rodilla
  Left2.write(90);//cadera

  Right0.write(90); // pata
  Right1.write(90);// cadera
  Right2.write(90);//rodilla
  delay(1000);
//Serial.println(" Swing - Respuesta a carga");
  //Swing inicial
  Left0.write(100);//pata
  Left1.write(80);//rodilla
  Left2.write(50);//cadera

  Right0.write(100);//pata
  Right1.write(90);//cadera
  Right2.write(120);//rodilla
  delay(1000);
//Serial.println(" Swing medio - medio");
  //Swing Medio
  Left0.write(90);//pata
  Left1.write(60);//rodilla
  Left2.write(40);//cadera

  Right0.write(160);//pata
  Right1.write(150);//cadera
  Right2.write(130);//rodilla
  delay(1000);
//Serial.println(" Swing Termi R - Terminal L");
  //Swing terminal
  Left0.write(50);//pata
  Left1.write(100);//rodilla
  Left2.write(90);//cadera

  Right0.write(60);//pata
  Right1.write(150);//cadera
  Right2.write(130);//rodilla
  delay(1000);*/
}