Diff: main.cpp

Revision:

3:c58eb4be51de

Parent:

1:8966a48ce8d5

Child:

4:d70375cfa533

--- a/main.cpp	Wed Mar 02 07:21:05 2016 +0000
+++ b/main.cpp	Thu Mar 03 01:00:32 2016 +0000
@@ -17,17 +17,6 @@
 DigitalOut led3(LED3);
 DigitalOut led4(LED4);
 
-int range_px=-1;
-int range_py=-1;
-int range_x=-1;
-int range_y=-1;
-int p_x=-1;
-int p_y=-1;
-int p_angle=0;
-int err=-1;
-int range_jmps_y=RANGE_JMPS;
-int range_jmps_x=RANGE_JMPS;
-
 int main()
 {
     pc.baud(9600);
@@ -36,27 +25,7 @@
         //loc.get_angle(&xya);
         loc.get_xy(&xya);
         pc.printf("X: %3d\tY: %3d\tP: %3d\n",xya.x,xya.y,xya.a);
+        pc.printf("X: %3d\tY: %3d\tP: %3d\n",xya.x,xya.y,xya.a);
+        //pc.printf("%c%c%c%c\n",xya.x,xya.y,xya.a/10,xya.a%10);
     }
-    /*if (imu.chip_ready()==0) {
-        //pc.printf("BNO055 is NOT available!\n");
-    }*/
-    //imu.set_mounting_position(MT_P0);
-    //imu.change_fusion_mode(MODE_IMU);
-    //p_x=location.x;
-//    while(1) {
-//        char data[]= {0,0,0};
-//        i2c1.read(RANGE_ADDR<<1, data, 3);
-//        wait(0.05);
-//        range_y=data[1];
-//        i2c2.read(RANGE_ADDR<<1, data, 3);
-//        wait(0.05);
-//        //imu.get_linear_accel(&accel);
-//        range_x=data[1];
-//        //p_angle=get_angle();
-//        //jump();
-//        //x_y();
-//        //pc.printf("X: %3d\tY: %3d\tP: %3d\tERROR:%3d\n",p_x,p_y,p_angle,err);
-//        pc.printf("%c%c%c%c\n",p_x,p_y,p_angle/10,p_angle%10);
-//        wait(0.5);
-//    }
 }