Dependencies: MODSERIAL biquadFilter mbed
Fork of Kinematics by
Diff: main.cpp
- 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