#include <Servo.h>

int vel=100; //Ajustar la velocidad (entre [50-200])
int pasos=50; //Cuantos pasos quieres que de
int x=0, y=0;
Servo delante;
Servo medio;
Servo detras;

void setup() {
  delante.attach(6);
  medio.attach(5);
  detras.attach(4);
  posicion_inicial();
}

void loop() {
  //while (x<pasos){
  //  andar_hacia_delante();
  //  x++;
  //}
  while (y<pasos){
    andar_hacia_detras();
    y++;
  }
} 

void posicion_inicial(){
  delante.write(90); delay(100);
  medio.write(90); delay(100);
  detras.write(90);delay(1000);
}

void andar_hacia_delante(){
  medio.write(120); delay(vel);
  delante.write(135); delay(vel);
  detras.write(135); delay(vel);
  medio.write(90); delay(vel);
  delante.write(90); delay(vel);
  detras.write(90); delay(vel);
  medio.write(60); delay(vel);
  delante.write(45); delay(vel);
  detras.write(45); delay(vel);
  medio.write(90); delay(vel);
  delante.write(90); delay(vel);
  detras.write(90); delay(vel);
}

void andar_hacia_detras(){
  medio.write(120); delay(vel);
  delante.write(45); delay(vel);
  detras.write(45); delay(vel);
  medio.write(90); delay(vel);
  delante.write(90); delay(vel);
  detras.write(90); delay(vel);
  medio.write(60); delay(vel);
  delante.write(135); delay(vel);
  detras.write(135); delay(vel);
  medio.write(90); delay(vel);
  delante.write(90); delay(vel);
  detras.write(90); delay(vel);
}