servo test

This commit is contained in:
shrkey
2016-10-10 22:12:31 +01:00
parent 774de67bf7
commit de71233303

View File

@@ -18,20 +18,23 @@ int main()
dw.initialize(); dw.initialize();
dw.setFrequency(50); dw.setFrequency(50);
dw.setServoOff( 1 ); DW_Servo *s1 = dw.getServo(1);
dw.setServoOff( 2 ); DW_Servo *s2 = dw.getServo(2);
s1->off();
s2->off();
for( int a = 10; a >= 0; a-- ) { for( int a = 10; a >= 0; a-- ) {
dw.setServoPWMmS(1, SERVO_MIN); s1->setPWMmS(SERVO_MIN);
dw.setServoPWMmS(2, SERVO_MIN); s2->setPWMmS(SERVO_MIN);
usleep(1000000); usleep(1000000);
dw.setServoPWMmS(1, SERVO_MAX); s1->setPWMmS(SERVO_MAX);
dw.setServoPWMmS(2, SERVO_MAX); s2->setPWMmS(SERVO_MAX);
usleep(1000000); usleep(1000000);
} }
dw.setServoOff( 1 ); s1->off();
dw.setServoOff( 2 ); s2->off();
return 0; return 0;
} }