Dependencies:   MODSERIAL biquadFilter mbed

Fork of Kinematics by Ramon Waninge

Revision:
11:256e84fea925
Parent:
10:2b965defcde5
Child:
12:8d3bc1fa2321
--- a/main.cpp	Wed Oct 31 09:09:43 2018 +0000
+++ b/main.cpp	Wed Oct 31 09:18:25 2018 +0000
@@ -76,7 +76,7 @@
     yendsqrt2 = sqrt(pow((-xbase/ll + cos(theta1)+ cos(theta4)),2)+ pow((sin(theta1)-sin(theta4)),2));
     yend = (yendsum + yendsqrt1/yendsqrt2);
     
-    if (xend !=xend){
+        
         
         
         
@@ -151,9 +151,10 @@
     pc.printf("%f", theta10);
     while(true){
         
-        //if (button1 == 0){
+        
            pc.printf("\n\r %f %f \n\r %f %f", theta4,theta1, xend, yend);
            wait(0.5);
-        //}
+           
+    
     }
 }
\ No newline at end of file