mirror of
https://gitee.com/xiaohuolufeihua/bizhang_-obav.git
synced 2026-05-22 01:12:31 +00:00
ekf2: reduce GPS initialization time for SITL from 10s to 0.5s
Speeds up SITL startup.
This commit is contained in:
@@ -116,6 +116,8 @@ then
|
|||||||
param set EKF2_ANGERR_INIT 0.01
|
param set EKF2_ANGERR_INIT 0.01
|
||||||
param set EKF2_HGT_MODE 0
|
param set EKF2_HGT_MODE 0
|
||||||
param set EKF2_GBIAS_INIT 0.01
|
param set EKF2_GBIAS_INIT 0.01
|
||||||
|
# Speedup SITL startup
|
||||||
|
param set EKF2_REQ_GPS_H 0.5
|
||||||
|
|
||||||
# LPE: GPS only mode
|
# LPE: GPS only mode
|
||||||
param set LPE_FUSION 145
|
param set LPE_FUSION 145
|
||||||
|
|||||||
Submodule src/lib/ecl updated: a27a43eafa...54ac147ae8
@@ -521,7 +521,9 @@ private:
|
|||||||
|
|
||||||
// Test used to determine if the vehicle is static or moving
|
// Test used to determine if the vehicle is static or moving
|
||||||
(ParamExtFloat<px4::params::EKF2_MOVE_TEST>)
|
(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
|
// initialise parameter cache
|
||||||
updateParams();
|
updateParams();
|
||||||
|
|
||||||
|
_ekf.set_min_required_gps_health_time(_param_ekf2_req_gps_h.get() * 1_s);
|
||||||
}
|
}
|
||||||
|
|
||||||
Ekf2::~Ekf2()
|
Ekf2::~Ekf2()
|
||||||
|
|||||||
@@ -1355,3 +1355,17 @@ PARAM_DEFINE_FLOAT(EKF2_GPS_TAU, 10.0f);
|
|||||||
* @decimal 1
|
* @decimal 1
|
||||||
*/
|
*/
|
||||||
PARAM_DEFINE_FLOAT(EKF2_MOVE_TEST, 1.0f);
|
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