My version of servo tester for single servo.

Dependencies:   F746_GUI Servo mbed

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?

UserRevisionLine numberNew 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 }