#include <Servo.h>
#define NUM_SERVOS 5
Servo myServo[NUM_SERVOS];
int iAngle;
int iDelay;
void setup() {
// put your setup code here, to run once:
myServo[0].attach(3);
myServo[1].attach(5);
myServo[2].attach(6);
myServo[3].attach(9);
myServo[4].attach(10);
// set all servos at 0°
iDelay = 500;
for (int i=0; i < NUM_SERVOS;i++) {
myServo[i].write(0);
}
}
void loop() {
iAngle = 0;
setAngle(iAngle);
// put your main code here, to run repeatedly:
for (int i=0; i < NUM_SERVOS;i++) {
iAngle = iAngle + 30;
myServo[i].write(iAngle);
}
delay(iDelay);
// reset all servos
setAngle(0);
delay(iDelay);
setAngle(180);
delay(iDelay);
}
void setAngle(int iiAngle) {
for (int i=0; i < NUM_SERVOS; i++) {
myServo[i].write(iiAngle);
}
}