diff options
author | Lorenz Meier <lm@inf.ethz.ch> | 2014-07-13 14:55:23 +0200 |
---|---|---|
committer | Lorenz Meier <lm@inf.ethz.ch> | 2014-07-13 14:55:23 +0200 |
commit | c610050dc305884a704b51c00cfff5f2f9984bcb (patch) | |
tree | cc74195fa935954583f1f94f5315bc37f5599d36 /src/modules | |
parent | cdfbe9bcc41a6e8e8b2a6f95bd69283ee5176966 (diff) | |
download | px4-firmware-c610050dc305884a704b51c00cfff5f2f9984bcb.tar.gz px4-firmware-c610050dc305884a704b51c00cfff5f2f9984bcb.tar.bz2 px4-firmware-c610050dc305884a704b51c00cfff5f2f9984bcb.zip |
EKF hotfix: Add missing vector zero calls
Diffstat (limited to 'src/modules')
-rw-r--r-- | src/modules/ekf_att_pos_estimator/estimator_23states.cpp | 4 |
1 files changed, 3 insertions, 1 deletions
diff --git a/src/modules/ekf_att_pos_estimator/estimator_23states.cpp b/src/modules/ekf_att_pos_estimator/estimator_23states.cpp index f33a1d780..3da92b264 100644 --- a/src/modules/ekf_att_pos_estimator/estimator_23states.cpp +++ b/src/modules/ekf_att_pos_estimator/estimator_23states.cpp @@ -2280,7 +2280,7 @@ float AttPosEKF::ConstrainFloat(float val, float min, float max) } if (!isfinite(val)) { - ekf_debug("constrain: non-finite!"); + //ekf_debug("constrain: non-finite!"); } return ret; @@ -2920,6 +2920,8 @@ void AttPosEKF::ZeroVariables() correctedDelAng.zero(); summedDelAng.zero(); summedDelVel.zero(); + dAngIMU.zero(); + dVelIMU.zero(); lastGyroOffset.zero(); for (unsigned i = 0; i < data_buffer_size; i++) { |