3Servos.ino

/*
  October 11, 2012
  Kyle Zhou
  Controls a set of 3 servos for Arduino

*/

#include <Servo.h>

Servo servo[3];

void setup(){
  servo[0].attach(9);
  servo[1].attach(10);
  servo[2].attach(11);

}

void oscillate(Servo *servo){
  int angle;
  int diffAngle = 1;
  int numServo = sizeof servo + 1;
  for(angle = 90; angle < 180; angle += diffAngle){
    servo[0].write(angle);
    servo[1].write(180-angle);
    servo[2].write(angle);
    delay(10);
  }
  for(angle = 90; angle < 180; angle += diffAngle){
    servo[0].write(180-angle);
    servo[1].write(angle);
    servo[2].write(180-angle);
    delay(10);
  }
  for(angle = 179; angle >= 90; angle -= diffAngle){
    servo[0].write(180-angle);
    servo[1].write(angle);
    servo[2].write(180-angle);
    delay(10);
  }
}

void reset(Servo servo){
  servo.write(90);
  return;
}

void loop(){

  // reset all servos
  for(int i = 0; i < 3; ++i){
    reset(servo[i]);
  }
  oscillate(servo);

}