mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-05-16 13:07:34 +08:00
EKF: Update comments
This commit is contained in:
@@ -337,9 +337,10 @@ public:
|
||||
*time_us = _imu_time_last;
|
||||
}
|
||||
|
||||
uint64_t _last_gps_origin_time_us = 0;
|
||||
struct map_projection_reference_s _posRef = {};
|
||||
float _gps_alt_ref = 0.0f;
|
||||
// Variables used to publish the WGS-84 location of the EKF local NED origin
|
||||
uint64_t _last_gps_origin_time_us = 0; // time the origin was last set (uSec)
|
||||
struct map_projection_reference_s _posRef = {}; // Contains WGS-84 position latitude and longitude (radians)
|
||||
float _gps_alt_ref = 0.0f; // WGS-84 height (m)
|
||||
|
||||
bool _vehicleArmed = false; // vehicle arm status used to turn off funtionality used on the ground
|
||||
|
||||
|
||||
+1
-1
@@ -88,7 +88,7 @@ bool EstimatorBase::gps_is_good(struct gps_message *gps)
|
||||
_gps_alt_ref = gps->alt * 1e-3f;
|
||||
}
|
||||
|
||||
// Calculate time lapsesd since last update, limit to prevent numerical errors and calculate the lowpass filter coefficient
|
||||
// Calculate time lapsed since last update, limit to prevent numerical errors and calculate the lowpass filter coefficient
|
||||
const float filtTimeConst = 10.0f;
|
||||
float dt = fminf(fmaxf(float(_time_last_imu - _last_gps_origin_time_us)*1e-6f,0.001f),filtTimeConst);
|
||||
float filterCoef = dt/filtTimeConst;
|
||||
|
||||
Reference in New Issue
Block a user