Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-15 12:25:20 +03:00
Code Issues Wiki Activity

remove abrupt switch to GPS with negative Baro signal

Browse source
This commit is contained in:
ctzsnooze 2022-09-15 11:29:15 +10:00
parent a930481dc3
commit 0766d93f72
1 changed files with 3 additions and 1 deletions
Download patch file Download diff file Expand all files Collapse all files

4
src/main/flight/position.c
View file

@ -179,7 +179,9 @@ void calculateEstimatedAltitude()
// favour GPS if Baro reads negative, this happens due to ground effects // favour GPS if Baro reads negative, this happens due to ground effects
float gpsTrustModifier = gpsTrust; float gpsTrustModifier = gpsTrust;
const float absDifferenceM = fabsf(altitudeToFilterCm - baroAltCm) * positionConfig()->altitude_prefer_baro / 10000.0f; const float absDifferenceM = fabsf(altitudeToFilterCm - baroAltCm) * positionConfig()->altitude_prefer_baro / 10000.0f;
if (absDifferenceM > 1.0f && baroAltCm > -100.0f) { // significant difference, and baro altitude not negative if (absDifferenceM > 1.0f) { // when there is a large difference, favour Baro
// warning: "ground effect" in last 10cm of descent causes abrupt increase in pressure
// this is interpreted as an abrupt fall in altitude and could cause motors to increase just as we hit ground, leading to bouncing
gpsTrustModifier /= absDifferenceM; gpsTrustModifier /= absDifferenceM;
} }
// eg if discrepancy is 3m and GPS trust was 0.9, it would now be 0.3 // eg if discrepancy is 3m and GPS trust was 0.9, it would now be 0.3