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
}
}
