![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
An m3pi demo program for Bluetooth control.
Dependencies: X_NUCLEO_53L0A1 m3pi mbed
Fork of m3pi_BT by
Diff: main.cpp
- Revision:
- 4:e2ab59ab0c80
- Parent:
- 3:d5da5e6bc16f
--- a/main.cpp Mon May 01 02:11:02 2017 +0000 +++ b/main.cpp Wed May 03 03:43:44 2017 +0000 @@ -11,34 +11,36 @@ m3pi.locate(0,1); m3pi.printf("YO"); - bt.baud(9600); //make sure the baud rate is 9600 while (!bt.readable()) { } //wait until the bt is ready +///////LED change will register if the command was recieved or not while(1) { - led = !led; - if (bt.getc() == '!') { - if (bt.getc() == 'O') { - if (bt.getc()=='F') { - m3pi.forward(.25); - } - if (bt.getc()=='B') { - m3pi.backward(.25); - } - if (bt.getc()=='L') { - m3pi.left(.25); - } - if (bt.getc()=='R') { - m3pi.right(.25); - } - if (bt.getc()=='S') { - m3pi.stop(); - } - if (bt.getc()=='X') { - pong = 1; - wait(.001); - pong = 0; - } - } + + if (bt.getc()=='F') { + m3pi.forward(.25); + led = !led; + } + if (bt.getc()=='B') { + m3pi.backward(.25); + led = !led; + } + if (bt.getc()=='L') { + m3pi.left(.25); + led = !led; + } + if (bt.getc()=='R') { + m3pi.right(.25); + led = !led; + } + if (bt.getc()=='S') { + m3pi.stop(); + led = !led; + } + if (bt.getc()=='X') { + pong = 1; + led = !led; + wait(.001); + pong = 0; } while (bt.readable()) char temp = bt.getc(); //flush buffer }