![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
My version of servo tester for single servo.
Dependencies: F746_GUI Servo mbed
main.cpp@0:d63249ffaef5, 2018-02-12 (annotated)
- Committer:
- no111u3
- Date:
- Mon Feb 12 17:59:43 2018 +0000
- Revision:
- 0:d63249ffaef5
- Child:
- 1:63566652d74d
First commit to servo tester proto
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
no111u3 | 0:d63249ffaef5 | 1 | #include "mbed.h" |
no111u3 | 0:d63249ffaef5 | 2 | #include "Servo.h" |
no111u3 | 0:d63249ffaef5 | 3 | #include "PinNames.h" |
no111u3 | 0:d63249ffaef5 | 4 | |
no111u3 | 0:d63249ffaef5 | 5 | Serial pc(SERIAL_TX, SERIAL_RX); |
no111u3 | 0:d63249ffaef5 | 6 | DigitalOut led(LED1); |
no111u3 | 0:d63249ffaef5 | 7 | |
no111u3 | 0:d63249ffaef5 | 8 | Servo test_servo(D0); |
no111u3 | 0:d63249ffaef5 | 9 | |
no111u3 | 0:d63249ffaef5 | 10 | int main() |
no111u3 | 0:d63249ffaef5 | 11 | { |
no111u3 | 0:d63249ffaef5 | 12 | pc.printf("Press '1' to turn LED1 ON, '0' to turn it OFF\n"); |
no111u3 | 0:d63249ffaef5 | 13 | pc.printf("2,3,4 - Position Servo (full left, middle, full right)\n"); |
no111u3 | 0:d63249ffaef5 | 14 | float position = 0.0f; |
no111u3 | 0:d63249ffaef5 | 15 | |
no111u3 | 0:d63249ffaef5 | 16 | while(1) { |
no111u3 | 0:d63249ffaef5 | 17 | char c = pc.getc(); // Read hyperterminal |
no111u3 | 0:d63249ffaef5 | 18 | switch (c) { |
no111u3 | 0:d63249ffaef5 | 19 | case '0': |
no111u3 | 0:d63249ffaef5 | 20 | led = 0; // OFF |
no111u3 | 0:d63249ffaef5 | 21 | break; |
no111u3 | 0:d63249ffaef5 | 22 | case '1': |
no111u3 | 0:d63249ffaef5 | 23 | led = 1; // ON |
no111u3 | 0:d63249ffaef5 | 24 | break; |
no111u3 | 0:d63249ffaef5 | 25 | case '2': |
no111u3 | 0:d63249ffaef5 | 26 | position = 0.0f; |
no111u3 | 0:d63249ffaef5 | 27 | test_servo = position; |
no111u3 | 0:d63249ffaef5 | 28 | break; |
no111u3 | 0:d63249ffaef5 | 29 | case '3': |
no111u3 | 0:d63249ffaef5 | 30 | position = 0.5f; |
no111u3 | 0:d63249ffaef5 | 31 | test_servo = position; |
no111u3 | 0:d63249ffaef5 | 32 | break; |
no111u3 | 0:d63249ffaef5 | 33 | case '4': |
no111u3 | 0:d63249ffaef5 | 34 | position = 1.0f; |
no111u3 | 0:d63249ffaef5 | 35 | test_servo = position; |
no111u3 | 0:d63249ffaef5 | 36 | break; |
no111u3 | 0:d63249ffaef5 | 37 | } |
no111u3 | 0:d63249ffaef5 | 38 | } |
no111u3 | 0:d63249ffaef5 | 39 | } |