Added BNO080Wheelchair.h
Dependents: BNO080_program wheelchaircontrol8 Version1-9 BNO080_program
Diff: BNO080.cpp
- Revision:
- 10:9275e6f7bf1b
- Parent:
- 7:050dc348e690
- Child:
- 11:dbe6d8d0ceb1
--- a/BNO080.cpp Mon Jul 29 18:24:40 2019 +0000 +++ b/BNO080.cpp Tue Jul 30 18:33:45 2019 +0000 @@ -605,10 +605,15 @@ case SENSOR_REPORTID_GYROSCOPE_CALIBRATED: - gyroRotation = TVector3( - qToFloat(data1, GYRO_Q_POINT), - qToFloat(data2, GYRO_Q_POINT), - qToFloat(data3, GYRO_Q_POINT)); + // gyroRotation = TVector3( +// qToFloat(data1, GYRO_Q_POINT), +// qToFloat(data2, GYRO_Q_POINT), +// qToFloat(data3, GYRO_Q_POINT)); + + + gyroRotation[0] = qToFloat(data1, GYRO_Q_POINT); + gyroRotation[1] = qToFloat(data2, GYRO_Q_POINT); + gyroRotation[2] = qToFloat(data3, GYRO_Q_POINT); currReportOffset += SIZEOF_GYROSCOPE_CALIBRATED; break;