blue mbed code for the BNO055 imu from adafruit
Dependencies: BNO055 MODSERIAL mbed
Fork of bmbed_lidar_belt by
Diff: main.cpp
- Revision:
- 2:ec53792aef80
- Parent:
- 1:5b1d88d69aa2
- Child:
- 3:a0ccaf565e8d
--- a/main.cpp Thu Sep 24 18:08:53 2015 +0000 +++ b/main.cpp Fri Sep 25 00:53:29 2015 +0000 @@ -78,7 +78,7 @@ } //write ---> 0 on success, 1 on failure i = 0; - while(sensor.read(addresses[k], receiveData, 3) || i < 10) { + while(sensor.read(addresses[k], receiveData, 3) && i < 10) { i++; //pc.printf("reading from sensor %d failed\n",k); } @@ -112,7 +112,7 @@ char receiveData2[3] = {0}; sensor.write(addresses[5], sendData, 1); i = 0; - while(sensor.read(addresses[5]+1, receiveData2, 3) || i < 10){ + while(sensor.read(addresses[5]+1, receiveData2, 3) && i < 10){ i++;} int distance2 = (receiveData2[0]<<8 )+ receiveData2[1]; if(distance2 >= 500 && distance2 < 1000) { @@ -125,8 +125,9 @@ //find DOWN distance char receiveData3[3] = {0}; + i = 0; sensor.write(addresses[6], sendData, 1); - while(sensor.read(addresses[6]+1, receiveData3, 3) || i < 10){ + while(sensor.read(addresses[6]+1, receiveData3, 3) && i < 10){ i++;} int distance3 = (receiveData3[0]<<8 )+ receiveData3[1]; if(count > 400) {