Chuck Webb
main.cpp@0:b87696259aa1, 2016-12-16 (annotated)
- Committer:
- chuckwebb
- Date:
- Fri Dec 16 19:08:43 2016 +0000
- Revision:
- 0:b87696259aa1
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| chuckwebb | 0:b87696259aa1 | 1 | #include "mbed.h" |
| chuckwebb | 0:b87696259aa1 | 2 | #include "ServoOut.h" |
| chuckwebb | 0:b87696259aa1 | 3 | |
| chuckwebb | 0:b87696259aa1 | 4 | DigitalOut myled(LED1); |
| chuckwebb | 0:b87696259aa1 | 5 | |
| chuckwebb | 0:b87696259aa1 | 6 | Serial pc(USBTX, USBRX); |
| chuckwebb | 0:b87696259aa1 | 7 | |
| chuckwebb | 0:b87696259aa1 | 8 | ServoOut servo1(p15); |
| chuckwebb | 0:b87696259aa1 | 9 | ServoOut servo2(p16); |
| chuckwebb | 0:b87696259aa1 | 10 | ServoOut servo3(p17); |
| chuckwebb | 0:b87696259aa1 | 11 | |
| chuckwebb | 0:b87696259aa1 | 12 | int main() { |
| chuckwebb | 0:b87696259aa1 | 13 | char rx_str[100]; |
| chuckwebb | 0:b87696259aa1 | 14 | float PW; |
| chuckwebb | 0:b87696259aa1 | 15 | |
| chuckwebb | 0:b87696259aa1 | 16 | while(1) { |
| chuckwebb | 0:b87696259aa1 | 17 | |
| chuckwebb | 0:b87696259aa1 | 18 | if(pc.readable()) |
| chuckwebb | 0:b87696259aa1 | 19 | { |
| chuckwebb | 0:b87696259aa1 | 20 | pc.scanf("%f*",&PW); |
| chuckwebb | 0:b87696259aa1 | 21 | |
| chuckwebb | 0:b87696259aa1 | 22 | pc.printf("Commanded pulse width: %f [microsec]\n",PW); |
| chuckwebb | 0:b87696259aa1 | 23 | } |
| chuckwebb | 0:b87696259aa1 | 24 | |
| chuckwebb | 0:b87696259aa1 | 25 | servo1.pulse_us = PW; |
| chuckwebb | 0:b87696259aa1 | 26 | servo2.pulse_us = PW; |
| chuckwebb | 0:b87696259aa1 | 27 | servo3.pulse_us = PW; |
| chuckwebb | 0:b87696259aa1 | 28 | |
| chuckwebb | 0:b87696259aa1 | 29 | myled = 1; |
| chuckwebb | 0:b87696259aa1 | 30 | wait(1); |
| chuckwebb | 0:b87696259aa1 | 31 | myled = 0; |
| chuckwebb | 0:b87696259aa1 | 32 | wait(1); |
| chuckwebb | 0:b87696259aa1 | 33 | } |
| chuckwebb | 0:b87696259aa1 | 34 | } |