self-balancing-robot
Dependencies: mbed mbed-rtos Motor
Diff: main.cpp
- 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();