/*
* _4.2_continuous_servo
*
* The board  will control the continuous rotation servo by writing a speed to it instead of a position.
*
* (c) 2013-2016 Arduino LLC.
*/

#include <Servo.h>

Servo myservo1, myservo2, myservo3;

int pos = 0; 

void setup() {
  myservo1.attach(9); // base servo
  myservo2.attach(6); // right eye
  myservo3.attach(5); // left eye

  myservo1.write(90);
  myservo2.write(0);
  myservo3.write(180);
}


void loop() {

 delay(2000);
  for (pos = 0; pos <= 90; pos += 1) 
  { // goes from 0 degrees to 180 degrees
    // in steps of 1 degree
    myservo1.write(pos);              // tell servo to go to position in variable 'pos'
    myservo2.write(pos); 
    myservo3.write(180 - pos); 
    delay(15);                       // waits 15ms for the servo to reach the position
  }
  delay(2000);
  for (pos = 90; pos >= 0; pos -= 1) { // goes from 180 degrees to 0 degrees
    myservo1.write(pos);              // tell servo to go to position in variable 'pos'
    myservo2.write(pos); 
    myservo3.write(abs(pos-180)); 
    delay(15);                       // waits 15ms for the servo to reach the position
  }
}