From 81ca167da888476e0a2da7a16c975adddd39fde7 Mon Sep 17 00:00:00 2001
From: Paul Riseborough <p_riseborough@live.com.au>
Date: Mon, 23 May 2016 20:50:58 +1000
Subject: [PATCH] EKF: align output observer to EKF states on startup

---
 EKF/ekf.cpp | 3 +++
 1 file changed, 3 insertions(+)

diff --git a/EKF/ekf.cpp b/EKF/ekf.cpp
index 61d2a57be0..35488673d1 100644
--- a/EKF/ekf.cpp
+++ b/EKF/ekf.cpp
@@ -567,6 +567,9 @@ bool Ekf::initialiseFilter(void)
 		_time_last_hagl_fuse = _time_last_imu;
 		_time_last_of_fuse = _time_last_imu;
 
+		// reset the output predictor state history to match the EKF initial values
+		alignOutputFilter();
+
 		return true;
 	}
 }