DataFlash: log tracking error for active instance of EKF2

This commit is contained in:
priseborough 2016-07-03 18:47:30 +10:00 committed by Andrew Tridgell
parent 927186339c
commit 772c719df3
1 changed files with 1 additions and 1 deletions

View File

@ -1424,7 +1424,7 @@ void DataFlash_Class::Log_Write_EKF2(AP_AHRS_NavEKF &ahrs, bool optFlowEnabled)
float gndOffsetErr=0; // filter ground offset state error
Vector3f predictorErrors; // output predictor angle, velocity and position tracking error
ahrs.get_NavEKF2().getFlowDebug(-1,normInnov, gndOffset, flowInnovX, flowInnovY, auxFlowInnov, HAGL, rngInnov, range, gndOffsetErr);
ahrs.get_NavEKF2().getOutputTrackingError(0,predictorErrors);
ahrs.get_NavEKF2().getOutputTrackingError(-1,predictorErrors);
struct log_EKF5 pkt5 = {
LOG_PACKET_HEADER_INIT(LOG_NKF5_MSG),
time_us : time_us,