drive down

Dependencies:   BMP280 BNO055_fusion PowerControl mbed

Fork of TEAM_G_FLOW_RIDA by Edwin Cho

Revision:
28:65daccc10f31
Parent:
27:fb1298d35bd1
Child:
30:116cd143fdf7
--- a/main.cpp	Wed Apr 13 03:14:43 2016 +0000
+++ b/main.cpp	Wed Apr 13 07:19:18 2016 +0000
@@ -76,8 +76,9 @@
     led4=0;
     while(1) {
         suction.pulsewidth_us(1600);
-        loc.get_angle(&xya);
-        motion.setAngle(90,xya.a,angle_error,ANGLE_TURN);
+        //loc.get_angle(&xya);
+        loc.get_xy(&xya);
+        //motion.setAngle(90,xya.a,angle_error,ANGLE_TURN);
         //motion.moveF(xya.a);
         /*if(abs(xya.a-180)<90)
             motion.moveB();