New reference frame: y=0 is now at table height.

Dependencies:   HIDScope MODSERIAL QEI biquadFilter mbed

Fork of prog_forwardkin_feedback_copy by Elfi Hofmeijer

Revision:
42:a080925eabf8
Parent:
41:68b170829965
--- a/main.cpp	Thu Nov 03 18:56:09 2016 +0000
+++ b/main.cpp	Fri Nov 04 08:32:27 2016 +0000
@@ -525,8 +525,8 @@
     // a Feedback controller. This is called from a Ticker.
     FilteredSample(T, envelopeL, envelopeR);
     GetReferenceKinematics1(q1, q2, q1_ref, q2_ref);
-    FeedbackControl1( q1_ref, q2_ref, q1, q2, motorValue1, motorValue2);
-    SetMotor1(motorValue1, motorValue2);
+    //FeedbackControl1( q1_ref, q2_ref, q1, q2, motorValue1, motorValue2);
+    //SetMotor1(motorValue1, motorValue2);
 }
 
 void TimeTrackerF(){