mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-04-14 10:07:39 +08:00
ekf2: reset the timeout timer in the reset function directly
This commit is contained in:
parent
0d874cf00a
commit
5e790da634
@ -734,8 +734,6 @@ void Ekf::controlHeightSensorTimeouts()
|
||||
// Reset vertical position and velocity states to the last measurement
|
||||
if (request_height_reset) {
|
||||
resetHeight();
|
||||
// Reset the timout timer
|
||||
_time_last_hgt_fuse = _time_last_imu;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
@ -345,6 +345,9 @@ void Ekf::resetHeight()
|
||||
// that does not destabilise the filter
|
||||
P.uncorrelateCovarianceSetVariance<1>(6, 10.0f);
|
||||
}
|
||||
|
||||
// Reset the timout timer
|
||||
_time_last_hgt_fuse = _time_last_imu;
|
||||
}
|
||||
|
||||
// align output filter states to match EKF states at the fusion time horizon
|
||||
|
||||
Loading…
x
Reference in New Issue
Block a user