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 ee571ed0ff
commit 32966a3430
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
+8 -4
View File
@@ -82,13 +82,17 @@ class IMU : public SensorBase<IMUAnglesMsg> {
_msg.temperature = _imu.getTemperature();
#endif
#if FT_ENABLED(USE_ICM20948)
#ifndef ICM20948_GET_AGMT_UPDATED_ONCE_PER_LOOP
#define ICM20948_GET_AGMT_UPDATED_ONCE_PER_LOOP
if (_imu->dataReady())
{
{
_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
#if FT_ENABLED(USE_BNO055)
#endif
esp32/include/peripherals/magnetometer.h
+10 -5
View File
@@ -43,11 +43,16 @@ class Magnetometer : public SensorBase<MagnetometerMsg> {
bool update() override {
if (!_msg.success) return false;
#if FT_ENABLED(USE_ICM20948)
_mag->getAGMT();
if (_mag->status != ICM_20948_Stat_Ok){ return false; }
_msg.rpy[0] = _mag->magX();
_msg.rpy[1] = _mag->magY();
_msg.rpy[2] = _mag->magZ();
#ifndef ICM20948_GET_AGMT_UPDATED_ONCE_PER_LOOP
#define ICM20948_GET_AGMT_UPDATED_ONCE_PER_LOOP
if (_imu->dataReady())
{
_imu->getAGMT();
}
#endif
_msg.rpy[0] = _mag->magX();
_msg.rpy[1] = _mag->magY();
_msg.rpy[2] = _mag->magZ();
#elif FT_ENABLED(USE_HMC5883)
sensors_event_t event;