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

ArduPlane: altitude: rangefinder correction should be relative to the altitude source being used for navigation. This avoid applying it twice when there is an existing correction saved.

This commit is contained in:
Samuel Tabor 2021-07-06 21:34:14 +01:00 committed by Andrew Tridgell
parent ab74913c83
commit 0de9ebe77d
1 changed files with 1 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
ArduPlane/altitude.cpp
View File

@ -687,7 +687,7 @@ void Plane::rangefinder_height_update(void)
if (rangefinder_state.in_range) { if (rangefinder_state.in_range) {
// base correction is the difference between baro altitude and // base correction is the difference between baro altitude and
// rangefinder estimate // rangefinder estimate
float correction = relative_altitude - rangefinder_state.height_estimate; float correction = adjusted_relative_altitude_cm()*0.01 - rangefinder_state.height_estimate;
#if AP_TERRAIN_AVAILABLE #if AP_TERRAIN_AVAILABLE
// if we are terrain following then correction is based on terrain data // if we are terrain following then correction is based on terrain data