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

AP_Periph: fixed airspeed update rate

This commit is contained in:
Andrew Tridgell 2019-10-19 14:49:41 +11:00
parent d0ff2089c4
commit 5b699fc65d
1 changed files with 6 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

11
Tools/AP_Periph/can.cpp
View File

@ -1138,19 +1138,20 @@ void AP_Periph_FW::can_airspeed_update(void)
{
#ifdef HAL_PERIPH_ENABLE_AIRSPEED
if (!airspeed.healthy()) {
static uint32_t last_probe_ms;
uint32_t now = AP_HAL::millis();
static uint32_t last_probe_ms;
if (now - last_probe_ms >= 1000) {
last_probe_ms = now;
airspeed.init();
}
}
airspeed.update(false);
if (last_airspeed_update_ms == airspeed.last_update_ms()) {
uint32_t now = AP_HAL::millis();
if (now - last_airspeed_update_ms < 50) {
// max 20Hz data
return;
}
last_airspeed_update_ms = airspeed.last_update_ms();
last_airspeed_update_ms = now;
airspeed.update(false);
if (!airspeed.healthy()) {
// don't send any data
return;