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

AP_NavEKF: Use baro data during launch transients whilst in static mode 

Baro data can be used as it will still be valid during the launch and
is not a synthesised measurement.
This commit is contained in:
priseborough 2014-04-29 12:59:19 +10:00 committed by Andrew Tridgell
parent a38e00c048
commit 3026ccee13
1 changed files with 5 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

11
libraries/AP_NavEKF/AP_NavEKF.cpp
View File

@ -686,17 +686,16 @@ void NavEKF::SelectVelPosFusion()
}
} else {
// in static mode we only fuse position and height to improve long term numerical stability
// and only when the rate of change of velocity is less than 0.5g. This prevents attitude errors
// due to launch acceleration. position is assumed to be zero.
fuseVelData = false;
// in static mode use synthetic position measurements set to zero
// only fuse synthetic measurements when rate of change of velocity is less than 0.5g to reduce attitude errors due to launch acceleration
// do not use velocity fusion to reduce the effect of movement on attitude
if (accNavMag < 4.9f) {
fusePosData = true;
fuseHgtData = true;
} else {
fusePosData = false;
fuseHgtData = false;
}
fuseVelData = false;
fuseHgtData = true;
}
// check for and read new height data