Uwe Gartmann
Futaba S-BUS Library. Let you control 16 servos and 2 digital channels
main.cpp@0:83e415034198, 2012-03-07 (annotated)
- Committer:
- Digixx
- Date:
- Wed Mar 07 18:18:43 2012 +0000
- Revision:
- 0:83e415034198
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| Digixx | 0:83e415034198 | 1 | #include "FutabaSBUS.h" |
| Digixx | 0:83e415034198 | 2 | #include "TextLCD.h" |
| Digixx | 0:83e415034198 | 3 | #include "mbed.h" |
| Digixx | 0:83e415034198 | 4 | |
| Digixx | 0:83e415034198 | 5 | DigitalOut mled(LED4); |
| Digixx | 0:83e415034198 | 6 | TextLCD lcd(p26, p25, p24, p23, p22, p20, p19, TextLCD::LCD20x4); |
| Digixx | 0:83e415034198 | 7 | FutabaSBUS sbus(p28, p27); |
| Digixx | 0:83e415034198 | 8 | |
| Digixx | 0:83e415034198 | 9 | |
| Digixx | 0:83e415034198 | 10 | int main() { |
| Digixx | 0:83e415034198 | 11 | sbus.passthrough(false); |
| Digixx | 0:83e415034198 | 12 | while (1) { |
| Digixx | 0:83e415034198 | 13 | sbus.servo(1,200); |
| Digixx | 0:83e415034198 | 14 | wait(0.5); |
| Digixx | 0:83e415034198 | 15 | sbus.servo(1,1700); |
| Digixx | 0:83e415034198 | 16 | wait(0.5); |
| Digixx | 0:83e415034198 | 17 | mled=!mled; |
| Digixx | 0:83e415034198 | 18 | |
| Digixx | 0:83e415034198 | 19 | lcd.locate(0,0); |
| Digixx | 0:83e415034198 | 20 | lcd.printf("fs:"); |
| Digixx | 0:83e415034198 | 21 | lcd.printf("%i",sbus.failsafe()); |
| Digixx | 0:83e415034198 | 22 | lcd.printf(" "); |
| Digixx | 0:83e415034198 | 23 | |
| Digixx | 0:83e415034198 | 24 | lcd.locate(0,1); |
| Digixx | 0:83e415034198 | 25 | lcd.printf("dg:"); |
| Digixx | 0:83e415034198 | 26 | lcd.printf("%i",sbus.digichannel(1)); |
| Digixx | 0:83e415034198 | 27 | lcd.printf("#"); |
| Digixx | 0:83e415034198 | 28 | lcd.printf("%i",sbus.digichannel(2)); |
| Digixx | 0:83e415034198 | 29 | lcd.printf(" "); |
| Digixx | 0:83e415034198 | 30 | |
| Digixx | 0:83e415034198 | 31 | lcd.locate(0,2); |
| Digixx | 0:83e415034198 | 32 | lcd.printf("Q:"); |
| Digixx | 0:83e415034198 | 33 | lcd.printf("%i",sbus.channel(1)); |
| Digixx | 0:83e415034198 | 34 | lcd.printf(" "); |
| Digixx | 0:83e415034198 | 35 | |
| Digixx | 0:83e415034198 | 36 | lcd.locate(10,2); |
| Digixx | 0:83e415034198 | 37 | lcd.printf("H:"); |
| Digixx | 0:83e415034198 | 38 | lcd.printf("%i",sbus.channel(2)); |
| Digixx | 0:83e415034198 | 39 | lcd.printf(" "); |
| Digixx | 0:83e415034198 | 40 | |
| Digixx | 0:83e415034198 | 41 | lcd.locate(0,3); |
| Digixx | 0:83e415034198 | 42 | lcd.printf("G:"); |
| Digixx | 0:83e415034198 | 43 | lcd.printf("%i",sbus.channel(3)); |
| Digixx | 0:83e415034198 | 44 | lcd.printf(" "); |
| Digixx | 0:83e415034198 | 45 | |
| Digixx | 0:83e415034198 | 46 | lcd.locate(10,3); |
| Digixx | 0:83e415034198 | 47 | lcd.printf("S:"); |
| Digixx | 0:83e415034198 | 48 | lcd.printf("%i",sbus.channel(4)); |
| Digixx | 0:83e415034198 | 49 | lcd.printf(" "); |
| Digixx | 0:83e415034198 | 50 | |
| Digixx | 0:83e415034198 | 51 | } |
| Digixx | 0:83e415034198 | 52 | } |