/*
control_many_servos.ino
Control more than one servo motor
https://www.y2kLeader.com
*/
#include <Servo.h>
Servo motor[2];
int angle[2];
void setup() {
  motor[0].attach(9); 
  motor[1].attach(10); 
  moveto (0,0);
  moveto (1,0);
  sweep (0,0,180,5,100);
  sweep (1,0,180,1,100);
}
void loop(){}
void sweep(int motor_number,int startangle, int endangle, int increment, int speed_in_milliseconds) {
  for (angle[motor_number] = startangle; angle[motor_number] <= endangle; angle[motor_number] += increment) { 
     // tell servo to go to position in variable angle
     motor[motor_number].write(angle[motor_number]);
     // waits for a time to slow it down (minimum of 15);
     delay(speed_in_milliseconds); 
  }
}
void moveto(int motor_number,int motor_angle){
  motor[motor_number].write(motor_angle);
  delay(1000);
}