Browse Source

AP_NavEKF: Report correct horiz vel sol'n status during optical flow nav

master
priseborough 10 years ago committed by Andrew Tridgell
parent
commit
e6474d676e
  1. 2
      libraries/AP_NavEKF/AP_NavEKF.cpp

2
libraries/AP_NavEKF/AP_NavEKF.cpp

@ -4517,7 +4517,7 @@ void NavEKF::getFilterStatus(uint8_t &status) const @@ -4517,7 +4517,7 @@ void NavEKF::getFilterStatus(uint8_t &status) const
bool doingNormalGpsNav = !posTimeout && (PV_AidingMode == AID_ABSOLUTE);
bool notDeadReckoning = !constVelMode && !constPosMode;
bool someVertRefData = (!velTimeout && (_fusionModeGPS == 0)) || !hgtTimeout;
bool someHorizRefData = !(velTimeout && posTimeout && tasTimeout);
bool someHorizRefData = !(velTimeout && posTimeout && tasTimeout) || doingFlowNav;
status = (!state.quat.is_nan()<<0 | // attitude valid (we need a better check)
(someHorizRefData && notDeadReckoning)<<1 | // horizontal velocity estimate valid
someVertRefData<<2 | // vertical velocity estimate valid

Loading…
Cancel
Save