const int servo1 = 9;
const int servo2 = 10;
// w = 1000 microseconds to 2000 microseconds for 0 to 180 deg respectively
void setup() {
Serial.begin(9600);
pinMode(servo1, OUTPUT);
pinMode(servo2, OUTPUT);
}
void loop() {
// square wave
wave(0);
delay(1000);
wave(1500);
delay(1000);
wave(2000);
delay(1000);
// for(int i = 0; i<50; i++){
// digitalWrite(servo1, HIGH);
// delayMicroseconds(1000);
// }
}
void wave(int w){
for(int i = 0; i<=50; i++){
digitalWrite(servo1, HIGH);
delayMicroseconds(w);
digitalWrite(servo1, LOW);
// delayMicroseconds(20000-w);
delay(20-(w/1000));
}
}