An m3pi demo program for Bluetooth control.

Dependencies:   X_NUCLEO_53L0A1 m3pi mbed

Fork of m3pi_BT by Alexander Saad-Falcon

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