Biorobotics / Robot-Software

Dependencies:   HIDScope MODSERIAL QEI biquadFilter mbed Servo

Revision:
20:31876566d70f
Parent:
19:e1e18746d98d
Child:
22:31065a83d9e8
--- a/help_functions/kinematics.h	Fri Oct 26 11:04:30 2018 +0000
+++ b/help_functions/kinematics.h	Fri Oct 26 12:59:52 2018 +0000
@@ -8,8 +8,8 @@
 void forwardkinematics_function(double q1, double q2) {
     // input are joint angles, output are x and y position of end effector
     
-    double x = x01 + L_ua * cos(q1) - L_la * cos(q2);
-    double y = y01 + L_ua * sin(q1) - L_la * sin(q2);   
+    double robot_end_x = x01 + L_ua * cos(q1) - L_la * cos(q2);
+    double robot_end_y = y01 + L_ua * sin(q1) - L_la * sin(q2);   
      
 }