SwitchMode

Dependencies:   BEAR_Protocol InverseLeg iSerial mbed

Fork of SwitchMode by Arsapol Manamunchaiyaporn

Revision:
5:1e868598c7db
Parent:
4:16cadf26dbab
Child:
6:4afac9a87b60
--- a/main.cpp	Sat Jan 23 03:29:55 2016 +0000
+++ b/main.cpp	Sat Jan 23 03:36:48 2016 +0000
@@ -448,6 +448,9 @@
                 Right.set_Link_Knee(RLink1);
                 Right.set_Zeta_Hip(RHipAngle);
                 Right.set_Zeta_Knee(RKneeAngle);
+                
+                Left.ForwardKinematicCalculation();
+                Right.ForwardKinematicCalculation();
 
                 float offset_Y,offset_Z;
                 float y1,y2,z1,z2;