Zürcher Eliteeinheit / Mbed 2 deprecated ROME2_P6

rome2_p6 imported

Dependencies:   mbed

Diff: Main.cpp

Revision:
5:957580f33e52
Parent:
4:1c821a19876f
--- a/Main.cpp	Fri May 18 13:40:59 2018 +0000
+++ b/Main.cpp	Fri May 18 13:54:25 2018 +0000
@@ -13,7 +13,7 @@
 #include "Controller.h"
 #include "StateMachine.h"
 #include "SerialServer.h"
-#define TOLERANCE 0.1f
+#define TOLERANCE 0.25f
 
 int main() {
     
@@ -114,8 +114,8 @@
         //relatives cord
         if(dist!=0)
         {
-            x_measured_r = distance*cos(angle);
-            y_measured_r = distance*cos(angle);
+            x_measured_r = dist*cos(angle);
+            y_measured_r = dist*cos(angle);
             //global cord
             angle_pos = controller.getAlpha();
             x= controller.getX();