mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-28 13:13:34 +08:00
avoid changing the reset logic
This commit is contained in:
@@ -1221,7 +1221,12 @@ FixedwingEstimator::task_main()
|
|||||||
|
|
||||||
// We're apparently initialized in this case now
|
// We're apparently initialized in this case now
|
||||||
// check (and reset the filter as needed)
|
// check (and reset the filter as needed)
|
||||||
(void)check_filter_state();
|
int check = check_filter_state();
|
||||||
|
|
||||||
|
if (check) {
|
||||||
|
// Let the system re-initialize itself
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
|
||||||
// Run the strapdown INS equations every IMU update
|
// Run the strapdown INS equations every IMU update
|
||||||
_ekf->UpdateStrapdownEquationsNED();
|
_ekf->UpdateStrapdownEquationsNED();
|
||||||
|
|||||||
Reference in New Issue
Block a user