Darkages/SpotMicroESP32-Leika
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Make sure that ICM20948 is only updated once per loop when needed

Browse Source
This commit is contained in:
Niklas Jensen
2025-12-26 22:33:16 +01:00
parent 9b4b939b1b
commit da87d12588
2 changed files with 18 additions and 9 deletions
Download Patch File Download Diff File Expand all files Collapse all files
esp32/include/peripherals/imu.h
+7 -3
View File
@@ -138,13 +138,17 @@ class IMU : public SensorBase<IMUAnglesMsg> {
return false; return false;
#endif #endif
#if FT_ENABLED(USE_ICM20948) #if FT_ENABLED(USE_ICM20948)
#ifndef ICM20948_GET_AGMT_UPDATED_ONCE_PER_LOOP
#define ICM20948_GET_AGMT_UPDATED_ONCE_PER_LOOP
if (_imu->dataReady()) if (_imu->dataReady())
{ {
_imu->getAGMT(); _imu->getAGMT();
_msg.rpy[0] = _imu->gyrX();
_msg.rpy[1] = _imu->gyrY();
_msg.rpy[2] = _imu->gyrZ();
} }
#endif
_msg.rpy[0] = _imu->accX();
_msg.rpy[1] = _imu->accY();
_msg.rpy[2] = _imu->accZ();
#endif #endif
#if FT_ENABLED(USE_BNO055) #if FT_ENABLED(USE_BNO055)
sensors_event_t event; sensors_event_t event;
esp32/include/peripherals/magnetometer.h
+10 -5
View File
@@ -70,11 +70,16 @@ class Magnetometer : public SensorBase<MagnetometerMsg> {
bool update() override { bool update() override {
if (!_msg.success) return false; if (!_msg.success) return false;
#if FT_ENABLED(USE_ICM20948) #if FT_ENABLED(USE_ICM20948)
_mag->getAGMT(); #ifndef ICM20948_GET_AGMT_UPDATED_ONCE_PER_LOOP
if (_mag->status != ICM_20948_Stat_Ok){ return false; } #define ICM20948_GET_AGMT_UPDATED_ONCE_PER_LOOP
_msg.rpy[0] = _mag->magX(); if (_imu->dataReady())
_msg.rpy[1] = _mag->magY(); {
_msg.rpy[2] = _mag->magZ(); _imu->getAGMT();
}
#endif
_msg.rpy[0] = _mag->magX();
_msg.rpy[1] = _mag->magY();
_msg.rpy[2] = _mag->magZ();
#elif FT_ENABLED(USE_HMC5883) #elif FT_ENABLED(USE_HMC5883)
sensors_event_t event; sensors_event_t event;