Alexander Saad-Falcon / Mbed 2 deprecated m3pi_BT

An m3pi demo program for Bluetooth control.

Dependencies:   X_NUCLEO_53L0A1 m3pi mbed

Fork of m3pi_LIDAR by Alexander Saad-Falcon

main.cpp@2:2d0d003ca3b8, 2017-04-30 (annotated)

Committer:
alexsaadfalcon
Date:
Sun Apr 30 23:08:34 2017 +0000
Revision:
2:2d0d003ca3b8
Parent:
0:b7ef99889b44
Child:
3:d5da5e6bc16f
First commit

Who changed what in which revision?

UserRevisionLine numberNew contents of line
alexsaadfalcon 0:b7ef99889b44 1 #include "mbed.h"
alexsaadfalcon 0:b7ef99889b44 2 #include "m3pi.h"
alexsaadfalcon 0:b7ef99889b44 3
alexsaadfalcon 0:b7ef99889b44 4 m3pi m3pi;
alexsaadfalcon 2:2d0d003ca3b8 5 DigitalOut led(LED1);
alexsaadfalcon 2:2d0d003ca3b8 6 Serial bt(p13, p14); //TX, RX
alexsaadfalcon 0:b7ef99889b44 7
alexsaadfalcon 0:b7ef99889b44 8 int main() {
alexsaadfalcon 2:2d0d003ca3b8 9 m3pi.locate(0,5);
alexsaadfalcon 0:b7ef99889b44 10 m3pi.printf("YO");
alexsaadfalcon 0:b7ef99889b44 11
alexsaadfalcon 2:2d0d003ca3b8 12 bt.baud(9600); //make sure the baud rate is 9600
alexsaadfalcon 2:2d0d003ca3b8 13 while (!bt.readable()) { } //wait until the bt is ready
alexsaadfalcon 2:2d0d003ca3b8 14
alexsaadfalcon 0:b7ef99889b44 15 while(1) {
alexsaadfalcon 2:2d0d003ca3b8 16 if (bt.getc()=='F') {
alexsaadfalcon 2:2d0d003ca3b8 17 m3pi.forward(.25);
alexsaadfalcon 2:2d0d003ca3b8 18 }
alexsaadfalcon 2:2d0d003ca3b8 19 if (bt.getc()=='B') {
alexsaadfalcon 2:2d0d003ca3b8 20 m3pi.backward(.25);
alexsaadfalcon 2:2d0d003ca3b8 21 }
alexsaadfalcon 2:2d0d003ca3b8 22 if (bt.getc()=='L') {
alexsaadfalcon 2:2d0d003ca3b8 23 m3pi.left(.25);
alexsaadfalcon 2:2d0d003ca3b8 24 }
alexsaadfalcon 2:2d0d003ca3b8 25 if (bt.getc()=='R') {
alexsaadfalcon 2:2d0d003ca3b8 26 m3pi.right(.25);
alexsaadfalcon 2:2d0d003ca3b8 27 }
alexsaadfalcon 2:2d0d003ca3b8 28 if (bt.getc()=='S') {
alexsaadfalcon 2:2d0d003ca3b8 29 m3pi.stop();
alexsaadfalcon 2:2d0d003ca3b8 30 }
alexsaadfalcon 2:2d0d003ca3b8 31 if (bt.getc()=='X') {
alexsaadfalcon 2:2d0d003ca3b8 32 //launch
alexsaadfalcon 2:2d0d003ca3b8 33 }
alexsaadfalcon 2:2d0d003ca3b8 34 }
alexsaadfalcon 0:b7ef99889b44 35 }