Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_InertialSensor: cleanup NAMED_VALUE_FLOAT for fifo error

This commit is contained in:
Andrew Tridgell 2023-01-19 10:07:20 +11:00 committed by Randy Mackay
parent c89d5448b2
commit 9032a91b1e
1 changed files with 5 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

13
libraries/AP_InertialSensor/AP_InertialSensor_Invensense.cpp
View File

@ -458,14 +458,11 @@ bool AP_InertialSensor_Invensense::update() /* front end */
// check if we have reported in the last 1 seconds or
// fast_reset_count changed
#if HAL_GCS_ENABLED && BOARD_FLASH_SIZE > 1024
if (AP_HAL::millis() - last_fast_reset_count_report_ms > 1000) {
last_fast_reset_count_report_ms = AP_HAL::millis();
char param_name[sizeof("IMUx_RST")];
if (_gyro_instance <= 9) {
snprintf(param_name, sizeof(param_name), "IMU%u_RST", _gyro_instance);
} else {
snprintf(param_name, sizeof(param_name), "IMUx_RST");
}
const uint32_t now = AP_HAL::millis();
if (now - last_fast_reset_count_report_ms > 5000U) {
last_fast_reset_count_report_ms = now;
char param_name[sizeof("IMUxx_RST")];
snprintf(param_name, sizeof(param_name), "IMU%u_RST", MIN(_gyro_instance,9));
gcs().send_named_float(param_name, fast_reset_count);
}
#endif