Kan kaart oppakken, maar duurt wel lang.

Dependencies:   Encoder HIDScope MODSERIAL mbed

Fork of week6ordenenscript by Projectgroep 20 Biorobotics

Revision:
16:4bfcc154bba0
Parent:
15:0cbbf84528bd
Child:
17:767cacdd0b1d
Child:
18:05ff73b29654
--- a/main.cpp	Fri Nov 03 01:04:34 2017 +0000
+++ b/main.cpp	Fri Nov 03 01:14:58 2017 +0000
@@ -80,7 +80,7 @@
     
     int maxwaarde = 4096;                   // = 64x64
     refP = (((0.5*pi) - q1)/(2*pi))*maxwaarde;
-    refP2 = (((0.5*pi) + q1 - q2)/(2*pi))*maxwaarde;    //Get reference positions
+    refP2 = (((-pi) + q1 - q2)/(2*pi))*maxwaarde;    //Get reference positions was eerst 0.5*pi
 }
 
 void SetpointRobot()