ラジコン用プログラムです。
Dependencies: mbed ATP3012 a HMC US015_2 getGPS
main.cpp@0:149a860cbcb9, 2021-12-10 (annotated)
- Committer:
- ushiroji
- Date:
- Fri Dec 10 03:58:41 2021 +0000
- Revision:
- 0:149a860cbcb9
- Child:
- 1:6ff5fbdf32bb
first version
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
ushiroji | 0:149a860cbcb9 | 1 | #include "mbed.h" |
ushiroji | 0:149a860cbcb9 | 2 | #include "Function.h" |
ushiroji | 0:149a860cbcb9 | 3 | |
ushiroji | 0:149a860cbcb9 | 4 | int main() |
ushiroji | 0:149a860cbcb9 | 5 | { |
ushiroji | 0:149a860cbcb9 | 6 | xbee.printf("XBee Connected\r\n"); |
ushiroji | 0:149a860cbcb9 | 7 | xbee.printf("Please enter the following number:"); |
ushiroji | 0:149a860cbcb9 | 8 | xbee.printf("\'1\':Stop\r\n\ |
ushiroji | 0:149a860cbcb9 | 9 | \'2\':Go straight\r\n\ |
ushiroji | 0:149a860cbcb9 | 10 | \'3\':Go back\r\n\ |
ushiroji | 0:149a860cbcb9 | 11 | \'4\':Turn right\r\n\ |
ushiroji | 0:149a860cbcb9 | 12 | \'5\':Turn left\r\n"); |
ushiroji | 0:149a860cbcb9 | 13 | |
ushiroji | 0:149a860cbcb9 | 14 | char num = '1'; |
ushiroji | 0:149a860cbcb9 | 15 | float spd = 0; |
ushiroji | 0:149a860cbcb9 | 16 | |
ushiroji | 0:149a860cbcb9 | 17 | while(1) { |
ushiroji | 0:149a860cbcb9 | 18 | while(xbee.readable()) { |
ushiroji | 0:149a860cbcb9 | 19 | xbee.printf("\r\nNumber:"); |
ushiroji | 0:149a860cbcb9 | 20 | num = getchar(); //stanby |
ushiroji | 0:149a860cbcb9 | 21 | xbee.printf("\r\nSpeed:"); |
ushiroji | 0:149a860cbcb9 | 22 | xbee.scanf("%lf", spd); |
ushiroji | 0:149a860cbcb9 | 23 | Move(num, spd); |
ushiroji | 0:149a860cbcb9 | 24 | |
ushiroji | 0:149a860cbcb9 | 25 | if(FrontGet()) { |
ushiroji | 0:149a860cbcb9 | 26 | Move('1', 0); |
ushiroji | 0:149a860cbcb9 | 27 | } |
ushiroji | 0:149a860cbcb9 | 28 | } |
ushiroji | 0:149a860cbcb9 | 29 | |
ushiroji | 0:149a860cbcb9 | 30 | Move('1', 0); |
ushiroji | 0:149a860cbcb9 | 31 | } |
ushiroji | 0:149a860cbcb9 | 32 | } |