From f8878d41dc14ee27225cae800eaf250480278d08 Mon Sep 17 00:00:00 2001 From: CarlOlsson Date: Fri, 11 Mar 2016 12:54:33 +0100 Subject: [PATCH] adopted ekf_helper.cpp --- EKF/ekf_helper.cpp | 12 ++++++++++++ 1 file changed, 12 insertions(+) diff --git a/EKF/ekf_helper.cpp b/EKF/ekf_helper.cpp index f74fb7392d..371366a731 100644 --- a/EKF/ekf_helper.cpp +++ b/EKF/ekf_helper.cpp @@ -267,6 +267,12 @@ void Ekf::get_mag_innov(float mag_innov[3]) memcpy(mag_innov, _mag_innov, 3 * sizeof(float)); } +// gets the innovations of the airspeed measnurement +void Ekf::get_airspeed_innov(float *airspeed_innov) +{ + memcpy(airspeed_innov,&_airspeed_innov, sizeof(float)); +} + // gets the innovations of the heading measurement void Ekf::get_heading_innov(float *heading_innov) { @@ -286,6 +292,12 @@ void Ekf::get_mag_innov_var(float mag_innov_var[3]) memcpy(mag_innov_var, _mag_innov_var, sizeof(float) * 3); } +// gest the innovation variance of the airspeed measurement +void Ekf::get_airspeed_innov_var(float *airspeed_innov_var) +{ + memcpy(airspeed_innov_var, &_airspeed_innov_var, sizeof(float)); +} + // gets the innovation variance of the heading measurement void Ekf::get_heading_innov_var(float *heading_innov_var) {