New servo test

2016-10-10 21:03:53 +01:00
parent d1044b7aad
commit 41efc6edc7
1 changed files with 9 additions and 1 deletions
--- a/examples/Servo/Servo.cpp
+++ b/examples/Servo/Servo.cpp
@@ -18,12 +18,20 @@ int main()
    dw.initialize();
    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(2, SERVO_MIN);
        usleep(1000000);
        dw.setServoPWMmS(1, SERVO_MAX);
+        dw.setServoPWMmS(2, SERVO_MAX);
        usleep(1000000);
    }

+    dw.setServoOff( 1 );
+    dw.setServoOff( 2 );
+
    return 0;
 }