segway_self balancing robot 4180 project

Dependencies:   mbed mbed-rtos LSM9DS1_Library

Revision:
9:28821420f7a4
Parent:
8:2332c4a79276
Child:
10:aafadd98d91c
Child:
11:c669b4dc1f9f
diff -r 2332c4a79276 -r 28821420f7a4 main.cpp
--- a/main.cpp	Sat Apr 18 19:39:10 2020 +0000
+++ b/main.cpp	Sat Apr 18 20:03:58 2020 +0000
@@ -16,9 +16,13 @@
 void bluetooth_update() {
     char bnum=0;
     char bhit=0;
-    if (blue.getc()=='!') {
+    
+    while (blue.getc()!='!') {
+        
+        }
         if (blue.getc()=='B') { //button data packet
             bnum = blue.getc(); //button number
+            pc.printf("%d",bnum);
             bhit = blue.getc(); //1=hit, 0=release
             if (blue.getc()==char(~('!' + 'B' + bnum + bhit))) { //checksum OK?
                 myled = bnum - '0'; //current button number will appear on LEDs
@@ -84,14 +88,15 @@
                 }
             }
         }
-    }
+    //}
 }
 
 int main() {
     pc.printf("this is running");
-    bluetooth.attach(&bluetooth_update, 0.1);
+    //bluetooth.attach(&bluetooth_update, 0.1);
     while(1) {
-        pc.printf("rp: %f, rd: %f, ri: %f, desired_angle: %f", rp, rd, ri, desired_angle);
+        bluetooth_update();
+        pc.printf("rp: %f, rd: %f, ri: %f, desired_angle: %f\n", rp, rd, ri, desired_angle);
         wait(0.1);
     }
 }