New servo test

This commit is contained in:
shrkey
2016-10-10 21:03:53 +01:00
parent d1044b7aad
commit 41efc6edc7

View File

@@ -18,12 +18,20 @@ int main()
dw.initialize(); dw.initialize();
dw.setFrequency(50); dw.setFrequency(50);
while (true) { dw.setServoOff( 1 );
dw.setServoOff( 2 );
for( int a = 10; a >= 0; a-- ) {
dw.setServoPWMmS(1, SERVO_MIN); dw.setServoPWMmS(1, SERVO_MIN);
dw.setServoPWMmS(2, SERVO_MIN);
usleep(1000000); usleep(1000000);
dw.setServoPWMmS(1, SERVO_MAX); dw.setServoPWMmS(1, SERVO_MAX);
dw.setServoPWMmS(2, SERVO_MAX);
usleep(1000000); usleep(1000000);
} }
dw.setServoOff( 1 );
dw.setServoOff( 2 );
return 0; return 0;
} }