Good Jacobian and code Not been tested

Dependencies:   MODSERIAL biquadFilter mbed

Fork of Kinematics by Ramon Waninge

Revision:
22:31ec06a15ea5
Parent:
17:e5ca1f228fc5
Child:
23:062c9867738c
--- a/main.cpp	Wed Oct 31 18:01:43 2018 +0000
+++ b/main.cpp	Wed Oct 31 20:59:43 2018 +0000
@@ -26,11 +26,11 @@
 float prefy;
 float deltat = 0.01;
 //Joe dit zijn de constantes
-float ll = 200.0;
-float lu = 170.0;
-float lb = 10.0;
+float ll = 230;
+float lu = 198;
+float lb = 50;
 float le = 79.0;
-float xbase = 340;
+float xbase = 450-lb;
 
 
 //forward kinematics, Check mathematica! Omdat mbed in paniek raakt met meerdere wortels, hebben we de vergelijking opgedeeld in 3 stukken