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

AP_Airspeed: Health: use reading from correct airspeed sensor

This commit is contained in:
Iampete1 2022-03-01 17:38:29 +00:00 committed by Andrew Tridgell
parent 587254e5a5
commit 9c4188d730
1 changed files with 2 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
libraries/AP_Airspeed/AP_Airspeed_Health.cpp
View File

@ -28,8 +28,7 @@ void AP_Airspeed::check_sensor_ahrs_wind_max_failures(uint8_t i)
return;
}
const float aspeed = get_airspeed();
if (aspeed <= 0) {
if (state[i].airspeed <= 0) {
// invalid estimate
return;
}
@ -44,7 +43,7 @@ void AP_Airspeed::check_sensor_ahrs_wind_max_failures(uint8_t i)
}
return;
}
const float speed_diff = fabsf(aspeed-gps.ground_speed());
const float speed_diff = fabsf(state[i].airspeed-gps.ground_speed());
// update health_probability with LowPassFilter
if (speed_diff > _wind_max) {