DERPS

Dependencies:   BMP280 BNO055_fusion PowerControl mbed

Fork of STRAIGHT_DRIVE_NO_SEP by Antoine Laurens

Revision:
40:9a97c4403c0a
Parent:
38:16208e003dc9
--- a/main.cpp	Wed Apr 27 04:24:11 2016 +0000
+++ b/main.cpp	Tue May 03 19:17:04 2016 +0000
@@ -93,7 +93,7 @@
     while(1) {
         suction.pulsewidth_us(1285);
         //uncomment this part if you want the robot to just drive down the window with no separtor
-        if (xya.y>FRAME_H*0.65) {
+        if (xya.y>FRAME_H*0.82) {
             while(1)
             {
                 suction.pulsewidth_us(1285);
@@ -103,13 +103,13 @@
             //continue;
         }
         loc.get_xy(&xya);
-        xGood=motion.setXPos(xTarget,xya.x,2,0);
+        /*xGood=motion.setXPos(xTarget,xya.x,2,0);
         if(!xGood)
             motion.setAngle(angleTarget,xya.a,angle_error,ANGLE_BIAS);
         else {
             xTarget=(xTarget==FRAME_W)?0:FRAME_W;
             angleTarget=(angleTarget==5)?-5:5;
-        }
+        }*/
             //motion.setYBias(0,xya.y,2,angleTarget);
             //loc.get_xy(&xya);5
 #if defined(PC_MODE)