initialise output height with baro

2026-07-14 09:00:35 +08:00 · 2016-01-08 06:48:48 +01:00
parent a41f75ffb1
commit 2af5856361
1 changed files with 1 additions and 0 deletions
@@ -189,6 +189,7 @@ bool Ekf::initialiseFilter(void)
 	}

 	_state.pos(2) = -baro_init.hgt;
+	_output_new.pos(2) = -baro_init.hgt;

 	initialiseCovariance();