From 2af5856361adf7ede444cc7f3fd6cf725dfa0213 Mon Sep 17 00:00:00 2001
From: Roman <bapstr@ethz.ch>
Date: Fri, 8 Jan 2016 06:48:48 +0100
Subject: [PATCH] initialise output height with baro

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

diff --git a/EKF/ekf.cpp b/EKF/ekf.cpp
index 58d76c0554..7d666873dd 100644
--- a/EKF/ekf.cpp
+++ b/EKF/ekf.cpp
@@ -189,6 +189,7 @@ bool Ekf::initialiseFilter(void)
 	}
 
 	_state.pos(2) = -baro_init.hgt;
+	_output_new.pos(2) = -baro_init.hgt;
 
 	initialiseCovariance();