int servoChan[] = {PB0, PB1}; // one pin per servo
#define angle0 450 // specific to this servo at 0 degrees
#define angle180 2450 //specific to this servo at 180 degrees
void setup() {
pinMode(servoChan[0], OUTPUT);
pinMode(servoChan[1], OUTPUT);
}
void loop() {
gotoZRO(servoChan[0]);
goto180(servoChan[1]);
goto180(servoChan[0]);
gotoZRO(servoChan[1]);
}
void gotoZRO(int servo) {
digitalWrite(servo, HIGH);
delayMicroseconds(angle0);
digitalWrite(servo, LOW);
delayMicroseconds(20000 - angle0);
delay(300);
}
void goto180(int servo) {
digitalWrite(servo, HIGH);
delayMicroseconds(angle180);
digitalWrite(servo, LOW);
delayMicroseconds(20000 - angle180);
delay(300);
}