Tommie Verouden / Mbed 2 deprecated StateMachine

Dependencies:   biquadFilter FastPWM MODSERIAL QEI mbed

Revision:
54:31957e8d6a73
Parent:
53:75076f9705dc
Child:
55:b297e064ebd9
--- a/main.cpp	Thu Nov 01 21:35:38 2018 +0000
+++ b/main.cpp	Thu Nov 01 21:51:20 2018 +0000
@@ -346,7 +346,7 @@
     //the iJ values are defined in the "kinematics" function
 
     //Calling the forward kinematics, to calculate xend and yend
-    kinematicsForward(xend,yend,theta1,theta4);
+    kinematicsForward(xend,yend,angleCurrent(countsL),angleCurrent(countsR));
 
 }