Fix initialization of position variable

This commit is contained in:
Lorenz Meier 2014-06-03 17:55:33 +02:00
parent 0ff1195c36
commit ed65d1748e

View File

@ -2537,6 +2537,8 @@ void AttPosEKF::InitialiseFilter(float (&initvelNED)[3], double referenceLat, do
// we are at reference altitude, so measurement must be zero
hgtMea = 0.0f;
posNE[0] = 0.0f;
posNE[1] = 0.0f;
// the baro offset must be this difference now
baroHgtOffset = baroHgt - referenceHgt;