mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-11-05 03:41:37 +08:00
EKF: align output observer to EKF states on startup
This commit is contained in:
@@ -567,6 +567,9 @@ bool Ekf::initialiseFilter(void)
|
|||||||
_time_last_hagl_fuse = _time_last_imu;
|
_time_last_hagl_fuse = _time_last_imu;
|
||||||
_time_last_of_fuse = _time_last_imu;
|
_time_last_of_fuse = _time_last_imu;
|
||||||
|
|
||||||
|
// reset the output predictor state history to match the EKF initial values
|
||||||
|
alignOutputFilter();
|
||||||
|
|
||||||
return true;
|
return true;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user