EKF2: Bug fixes.

Signed-off-by: Daniel M. Sahu <danielmohansahu@gmail.com>
This commit is contained in:
Daniel M. Sahu
2023-02-01 10:08:15 -05:00
parent c6e5d516f9
commit 3e09d9b678
2 changed files with 2 additions and 1 deletions
+1
View File
@@ -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
+1 -1
View File
@@ -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);