Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-05-29 03:36:07 +08:00
Code Issues Actions 10 Packages Projects Releases Wiki Activity

icm42688p: only check configured registers periodically (as intended)

Browse Source
This commit is contained in:
Daniel Agar
2022-05-23 10:16:55 -04:00
parent c57c575cfe
commit d25a784a3a
1 changed files with 15 additions and 13 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/imu/invensense/icm42688p/ICM42688P.cpp
+15 -13
View File
@@ -274,20 +274,22 @@ void ICM42688P::RunImpl()
} }
} }
// check configuration registers periodically or immediately following any failure if (!success || hrt_elapsed_time(&_last_config_check_timestamp) > 100_ms) {
if (RegisterCheck(_register_bank0_cfg[_checked_register_bank0]) // check configuration registers periodically or immediately following any failure
&& RegisterCheck(_register_bank1_cfg[_checked_register_bank1]) if (RegisterCheck(_register_bank0_cfg[_checked_register_bank0])
&& RegisterCheck(_register_bank2_cfg[_checked_register_bank2]) && RegisterCheck(_register_bank1_cfg[_checked_register_bank1])
) { && RegisterCheck(_register_bank2_cfg[_checked_register_bank2])
_last_config_check_timestamp = now; ) {
_checked_register_bank0 = (_checked_register_bank0 + 1) % size_register_bank0_cfg; _last_config_check_timestamp = now;
_checked_register_bank1 = (_checked_register_bank1 + 1) % size_register_bank1_cfg; _checked_register_bank0 = (_checked_register_bank0 + 1) % size_register_bank0_cfg;
_checked_register_bank2 = (_checked_register_bank2 + 1) % size_register_bank2_cfg; _checked_register_bank1 = (_checked_register_bank1 + 1) % size_register_bank1_cfg;
_checked_register_bank2 = (_checked_register_bank2 + 1) % size_register_bank2_cfg;
} else { } else {
// register check failed, force reset // register check failed, force reset
perf_count(_bad_register_perf); perf_count(_bad_register_perf);
Reset(); Reset();
}
} }
} }