version2
Dependencies: BNO055_fusion mbed
Fork of DEMO2 by
Diff: main.cpp
- Revision:
- 3:c58eb4be51de
- Parent:
- 1:8966a48ce8d5
- Child:
- 4:d70375cfa533
diff -r 634c1adf89b2 -r c58eb4be51de main.cpp --- 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); -// } }