🐛 Fixes imu handling
This commit is contained in:
@@ -49,17 +49,17 @@ class IMU {
|
|||||||
bool initialize() {
|
bool initialize() {
|
||||||
#if FT_ENABLED(USE_MPU6050)
|
#if FT_ENABLED(USE_MPU6050)
|
||||||
_imu.initialize();
|
_imu.initialize();
|
||||||
imu_success = _imu.testConnection();
|
imuMsg.success = _imu.testConnection();
|
||||||
devStatus = _imu.dmpInitialize();
|
devStatus = _imu.dmpInitialize();
|
||||||
if (!imu_success) return false;
|
if (!imuMsg.success) return false;
|
||||||
_imu.setDMPEnabled(true);
|
_imu.setDMPEnabled(true);
|
||||||
_imu.setI2CMasterModeEnabled(false);
|
_imu.setI2CMasterModeEnabled(false);
|
||||||
_imu.setI2CBypassEnabled(true);
|
_imu.setI2CBypassEnabled(true);
|
||||||
_imu.setSleepEnabled(false);
|
_imu.setSleepEnabled(false);
|
||||||
#endif
|
#endif
|
||||||
#if FT_ENABLED(USE_BNO055)
|
#if FT_ENABLED(USE_BNO055)
|
||||||
imu_success = _imu.begin();
|
imuMsg.success = _imu.begin();
|
||||||
if (!imu_success) {
|
if (!imuMsg.success) {
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
_imu.setExtCrystalUse(true);
|
_imu.setExtCrystalUse(true);
|
||||||
|
|||||||
Reference in New Issue
Block a user