An m3pi demo program for Bluetooth control.
Dependencies: X_NUCLEO_53L0A1 m3pi mbed
Fork of m3pi_BT by
main.cpp
- Committer:
- xmanwms95
- Date:
- 2017-05-03
- Revision:
- 4:e2ab59ab0c80
- Parent:
- 3:d5da5e6bc16f
File content as of revision 4:e2ab59ab0c80:
#include "mbed.h" #include "m3pi.h" m3pi m3pi; DigitalOut led(LED1); DigitalOut pong(p20); Serial bt(p13, p14); //TX, RX int main() { m3pi.locate(0,1); m3pi.printf("YO"); while (!bt.readable()) { } //wait until the bt is ready ///////LED change will register if the command was recieved or not while(1) { 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 } }