demo demo
/
BluetoothSumo
main.cpp@0:41f85a3f645d, 2009-09-19 (annotated)
- Committer:
- demo
- Date:
- Sat Sep 19 18:32:13 2009 +0000
- Revision:
- 0:41f85a3f645d
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
demo | 0:41f85a3f645d | 1 | // Sumo Robot control via Bluetooth/Nokia Presenter |
demo | 0:41f85a3f645d | 2 | // Copyright (c) 2009 sford |
demo | 0:41f85a3f645d | 3 | // Released under the MIT License: http://mbed.org/license/mit |
demo | 0:41f85a3f645d | 4 | |
demo | 0:41f85a3f645d | 5 | #include "mbed.h" |
demo | 0:41f85a3f645d | 6 | #include "Motor.h" |
demo | 0:41f85a3f645d | 7 | #include "NokiaPresenter.h" |
demo | 0:41f85a3f645d | 8 | |
demo | 0:41f85a3f645d | 9 | Motor left(p23, p6, p5); // pwm, fwd, rev |
demo | 0:41f85a3f645d | 10 | Motor right(p24, p8, p7); // pwm, fwd, rev |
demo | 0:41f85a3f645d | 11 | |
demo | 0:41f85a3f645d | 12 | BusOut leds(LED1, LED2, LED3, LED4); |
demo | 0:41f85a3f645d | 13 | |
demo | 0:41f85a3f645d | 14 | int main() { |
demo | 0:41f85a3f645d | 15 | leds = 1; |
demo | 0:41f85a3f645d | 16 | NokiaPresenter nokia(p28, p27, p29); // tx, rx, rst |
demo | 0:41f85a3f645d | 17 | leds = 2; |
demo | 0:41f85a3f645d | 18 | |
demo | 0:41f85a3f645d | 19 | while(1) { |
demo | 0:41f85a3f645d | 20 | switch(nokia.key()) { |
demo | 0:41f85a3f645d | 21 | case 0: |
demo | 0:41f85a3f645d | 22 | left.speed(0.0); |
demo | 0:41f85a3f645d | 23 | right.speed(0.0); |
demo | 0:41f85a3f645d | 24 | leds = 0; |
demo | 0:41f85a3f645d | 25 | break; |
demo | 0:41f85a3f645d | 26 | case 'U': |
demo | 0:41f85a3f645d | 27 | left.speed(1.0); |
demo | 0:41f85a3f645d | 28 | right.speed(1.0); |
demo | 0:41f85a3f645d | 29 | leds = 1 << 0 | 1 << 2; |
demo | 0:41f85a3f645d | 30 | break; |
demo | 0:41f85a3f645d | 31 | case 'D': |
demo | 0:41f85a3f645d | 32 | left.speed(-1.0); |
demo | 0:41f85a3f645d | 33 | right.speed(-1.0); |
demo | 0:41f85a3f645d | 34 | leds = 1 << 1 | 1 << 3; |
demo | 0:41f85a3f645d | 35 | break; |
demo | 0:41f85a3f645d | 36 | case 'L': |
demo | 0:41f85a3f645d | 37 | left.speed(-1.0); |
demo | 0:41f85a3f645d | 38 | right.speed(1.0); |
demo | 0:41f85a3f645d | 39 | leds = 1 << 1 | 1 << 2; |
demo | 0:41f85a3f645d | 40 | break; |
demo | 0:41f85a3f645d | 41 | case 'R': |
demo | 0:41f85a3f645d | 42 | left.speed(1.0); |
demo | 0:41f85a3f645d | 43 | right.speed(-1.0); |
demo | 0:41f85a3f645d | 44 | leds = 1 << 0 | 1 << 3; |
demo | 0:41f85a3f645d | 45 | break; |
demo | 0:41f85a3f645d | 46 | } |
demo | 0:41f85a3f645d | 47 | } |
demo | 0:41f85a3f645d | 48 | } |