mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-11-08 07:01:35 +08:00
EKF2: Bug fixes.
Signed-off-by: Daniel M. Sahu <danielmohansahu@gmail.com>
This commit is contained in:
@@ -102,6 +102,7 @@ px4_add_module(
|
||||
EKF/gps_checks.cpp
|
||||
EKF/gps_control.cpp
|
||||
EKF/gps_yaw_fusion.cpp
|
||||
EKF/gravity_fusion.cpp
|
||||
EKF/height_control.cpp
|
||||
EKF/imu_down_sampler.cpp
|
||||
EKF/mag_control.cpp
|
||||
|
||||
@@ -56,7 +56,7 @@ void Ekf::fuseGravity()
|
||||
Vector3f innovation_variance;
|
||||
|
||||
// calculate kalman gains and innovation variances
|
||||
sym::ComputyGravityInnovVarAndKAndH(
|
||||
sym::ComputeGravityInnovVarAndKAndH(
|
||||
getStateAtFusionHorizonAsVector(), P, measurement, acc_measurement_noise, FLT_EPSILON,
|
||||
&_gravity_innov, &innovation_variance, &Kx, &Ky, &Kz);
|
||||
|
||||
|
||||
Reference in New Issue
Block a user