🐛 Fixes imu handling

This commit is contained in:
Rune Harlyk
2025-09-06 19:55:57 +02:00
parent 7de5a1aa7c
commit bd8c8fd988
+4 -4
View File
@@ -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);