BMT Module 9 Group 4 / Mbed 2 deprecated DemoState

DemoState with IK and MotorControl and input vx_des and vy_des with potmeter1 and button2

Dependencies:   FastPWM MODSERIAL Matrix MatrixMath mbed QEI

Diff: main.cpp

Revision:
3:d16182dd3a2a
Parent:
2:638c6155d0af
Child:
4:854aa2e7eeb2
--- a/main.cpp	Thu Nov 01 19:50:29 2018 +0000
+++ b/main.cpp	Thu Nov 01 20:15:22 2018 +0000
@@ -289,6 +289,7 @@
         pc.printf("vx_des = %f \t vy_des = %f \r\n", vx_des, vy_des);
         pc.printf("Error IK1 = %f \t Error IK2 = %f \r\n", errorIK1, errorIK2);
         pc.printf("MotorValue 1 = %f \t MotorValue 2 = %f \r\n", motorValue1, motorValue2);
+        pc.printf("q1 Qset = %f \t q2 Qset = %f \r\n", Q_set(1,1), Q_set(2,1));
         wait(0.01);
     }
 }
\ No newline at end of file