mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-15 23:23:33 +08:00
ekf2: reduce GPS initialization time for SITL from 10s to 0.5s
Speeds up SITL startup.
This commit is contained in:
@@ -521,7 +521,9 @@ private:
|
||||
|
||||
// Test used to determine if the vehicle is static or moving
|
||||
(ParamExtFloat<px4::params::EKF2_MOVE_TEST>)
|
||||
_param_ekf2_move_test ///< scaling applied to IMU data thresholds used to determine if the vehicle is static or moving.
|
||||
_param_ekf2_move_test, ///< scaling applied to IMU data thresholds used to determine if the vehicle is static or moving.
|
||||
|
||||
(ParamFloat<px4::params::EKF2_REQ_GPS_H>) _param_ekf2_req_gps_h ///< Required GPS health time
|
||||
|
||||
)
|
||||
|
||||
@@ -651,6 +653,8 @@ Ekf2::Ekf2():
|
||||
|
||||
// initialise parameter cache
|
||||
updateParams();
|
||||
|
||||
_ekf.set_min_required_gps_health_time(_param_ekf2_req_gps_h.get() * 1_s);
|
||||
}
|
||||
|
||||
Ekf2::~Ekf2()
|
||||
|
||||
@@ -1355,3 +1355,17 @@ PARAM_DEFINE_FLOAT(EKF2_GPS_TAU, 10.0f);
|
||||
* @decimal 1
|
||||
*/
|
||||
PARAM_DEFINE_FLOAT(EKF2_MOVE_TEST, 1.0f);
|
||||
|
||||
/**
|
||||
* Required GPS health time on startup
|
||||
*
|
||||
* Minimum continuous period without GPS failure required to mark a healthy GPS status.
|
||||
* It can be reduced to speed up initialization, but it's recommended to keep this unchanged for a vehicle.
|
||||
*
|
||||
* @group EKF2
|
||||
* @min 0.1
|
||||
* @decimal 1
|
||||
* @unit s
|
||||
* @reboot_required true
|
||||
*/
|
||||
PARAM_DEFINE_FLOAT(EKF2_REQ_GPS_H, 10.0f);
|
||||
|
||||
Reference in New Issue
Block a user