marijn peters / Mbed 2 deprecated emg2position2angles

hoeken aan de hand van positie bepalen

Dependencies:   HIDScope mbed

Fork of test_HIDScope by marijn peters

Files at this revision

API Documentation at this revision

Revision 4:833948d12d78, committed 2015-10-16

Comitter:
marijnstudent
Date:
Fri Oct 16 10:52:36 2015 +0000
Parent:
3:c1d11616f252
Commit message:
testfunctie hoeken bepalen als je alleen in x en y wil bewegen.

Changed in this revision

main.cpp Show annotated file Show diff for this revision Revisions of this file 
diff -r c1d11616f252 -r 833948d12d78 main.cpp
--- a/main.cpp	Fri Oct 16 10:50:13 2015 +0000
+++ b/main.cpp	Fri Oct 16 10:52:36 2015 +0000
@@ -100,6 +100,7 @@
     // verzenden van de verstuurde signalen
     //scope.send();
 
+    // xx en yy zijn de gewenste x en y waardes, de hoeken theta 1 en 2 worden berekend
     double xx = 7*50*y5;
     double yy = 7*50*y5t;
     double r = sqrt(pow(xx,2)+pow(yy,2)); // vector naar end effector
@@ -108,6 +109,8 @@
     // hoeken berekenen
     theta_one = atan2(yy,xx)+beta;
     theta_two = pi + alfa;
+    
+    // testen van de functie
     scope.set(0,xx);
     scope.set(1,yy);
     double xt = L*cos(theta_one)+L*cos(theta_one+theta_two);