#include <Servo.h>
int x = 220;

Servo myservo_FL;
Servo myservo_BL;
Servo myservo_FR;
Servo myservo_BR;

void setup() {
  myservo_FL.attach(5);
  myservo_BL.attach(13);
  myservo_FR.attach(4);
  myservo_BR.attach(12);
}

void go(int a, int b, int c, int d) {
  myservo_FL.write(a);
  myservo_BL.write(b);
  myservo_FR.write(c);
  myservo_BR.write(d);
  delay(x);
}

void forward(){
  go(90,50,130,90);
  go(130,50,130,50);
  go(130,90,90,50);
  go(90,90,90,90);
  go(50,90,90,130);
  go(50,130,50,130);
  go(90,130,50,90);
  go(90,90,90,90);
}

void backward(){  
  go(50,90,90,130);
  go(50,130,50,130);
  go(90,130,50,90);
  go(90,90,90,90);
  go(90,50,130,90);
  go(130,50,130,50);
  go(130,90,90,50);
  go(90,90,90,90);
}

void turnright(){
  go(90,50,50,90);
  go(130,50,50,130);
  go(135,90,90,135);
  go(90,90,90,90);
}

void turnleft(){
  go(135,90,90,135);
  go(130,50,50,130);
  go(90,50,50,90);
  go(90,90,90,90);
}

void hello(){
  go(90,90,90,90);
  go(90,90,130,90);
  go(90,90,170,90);
  go(90,90,130,90);
  go(90,90,90,90);
}

void shake(){
  go(30,30,150,150);
  go(90,90,90,90);
  go(150,150,30,30);
  go(90,90,90,90);
}

void loop() {
  go(90,90,90,90);
  //forward();
  //backward();
  //turnleft();
  //turnright();
  //hello();
  //shake();
}