From 848c1c2552996281685d2691c1b394f25a4391b3 Mon Sep 17 00:00:00 2001
From: Lorenz Meier <lm@inf.ethz.ch>
Date: Tue, 29 Apr 2014 21:42:58 +0200
Subject: [PATCH] ekf: More complete re-initialization

---
 src/modules/ekf_att_pos_estimator/estimator.cpp | 2 ++
 1 file changed, 2 insertions(+)

diff --git a/src/modules/ekf_att_pos_estimator/estimator.cpp b/src/modules/ekf_att_pos_estimator/estimator.cpp
index 1ca34ec307..e1ffc15d3b 100644
--- a/src/modules/ekf_att_pos_estimator/estimator.cpp
+++ b/src/modules/ekf_att_pos_estimator/estimator.cpp
@@ -2536,6 +2536,8 @@ void AttPosEKF::ZeroVariables()
     correctedDelAng.zero();
     summedDelAng.zero();
     summedDelVel.zero();
+    magBias.zero();
+    magState.zero();
 
     for (unsigned i = 0; i < data_buffer_size; i++) {