servo test
This commit is contained in:
@@ -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;
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user