#include <Servo.h>
#define SERVO_COUNT 2
#define SERVO_Pos 5
Servo servo[SERVO_COUNT];
byte servo_pins[SERVO_COUNT] = {5, 4};
int servo0_pos[SERVO_Pos] = { 0, 180, 90, 45, 0 };
int servo1_pos[SERVO_Pos] = { 0, 100, 180, 90, 0 };
void setup() {
//To attach the servos to pins
for(int n = 0; n < SERVO_COUNT; n++)
{
servo[n].attach(servo_pins[n]);
}
}
void loop() {
for(int j = 0; j < SERVO_Pos; j++)
{
servo[0].write(servo0_pos[j]);
servo[1].write(servo1_pos[j]);
delay (800);
}
}