Localization

Dependencies:   BNO055_fusion mbed

Revision:
14:4839989ae907
Parent:
13:c62f975dfcfe
Child:
15:7729da55873a
--- a/main.cpp	Wed Mar 23 18:12:47 2016 +0000
+++ b/main.cpp	Thu Mar 24 03:54:29 2016 +0000
@@ -3,8 +3,8 @@
 #include "WATCHDOG.h"
 
 
-#define SPEED_TURN_MIN  0.30
-#define SPEED_TURN_MAX  0.45
+#define SPEED_TURN_MIN  0.15
+#define SPEED_TURN_MAX  0.35
 #define SPEED_FB_MIN    0.15
 #define SPEED_FB_MAX    0.50
 
@@ -49,7 +49,7 @@
         //loc.get_angle(&xya);
         loc.get_xy(&xya);
         //pc.printf("X: %3d\tY: %3d\tP: %3d\n",xya.x,xya.y,xya.a);
-        //setAngle(0);
+        setAngle(0);
         wdt.kick();
     }
 }