self-balancing-robot

Dependencies:   mbed mbed-rtos Motor

Revision:
29:ed9f7144a6a7
Parent:
28:31ae3dd720e1
Child:
30:b1718c4edcd7
--- a/main.cpp	Thu Apr 23 19:36:08 2020 +0000
+++ b/main.cpp	Thu Apr 23 20:14:44 2020 +0000
@@ -203,15 +203,17 @@
     
     //bluetooth.attach(&bluetooth_update, 0.1);
     while (1) {
-        
+        leftWheel=1;
+        rightWheel=1;
+        Thread::wait(10000);
         //bluetooth_update();
         //parametersmutex.lock();
 //        pc.printf("rp: %f, rd: %f, ri: %f, desired_angle: %f\n", rp, rd, ri, desired_angle);
 //        parametersmutex.unlock();
         
         angleMutex.lock();
-        pc.printf("pAngle: %f\n\r", pAngle);
-        pc.printf("speed: %f\n\r", speed);
+        pc.printf("pAngle: %f", pAngle/70);
+        pc.printf("    speed: %f\n\r", speed);
         angleMutex.unlock();