From 9a274ba56584416281c47863f7e30fb3452b3f08 Mon Sep 17 00:00:00 2001
From: Josh Henderson <hendjoshsr71@gmail.com>
Date: Fri, 9 Jul 2021 00:01:32 -0400
Subject: [PATCH] AP_NavEKF2: initialize stateStruct.quat to unit length

---
 libraries/AP_NavEKF2/AP_NavEKF2_core.cpp | 1 +
 1 file changed, 1 insertion(+)

diff --git a/libraries/AP_NavEKF2/AP_NavEKF2_core.cpp b/libraries/AP_NavEKF2/AP_NavEKF2_core.cpp
index 94765ea2dd..9be77903f7 100644
--- a/libraries/AP_NavEKF2/AP_NavEKF2_core.cpp
+++ b/libraries/AP_NavEKF2/AP_NavEKF2_core.cpp
@@ -238,6 +238,7 @@ void NavEKF2_core::InitialiseVariables()
     runUpdates = false;
     framesSincePredict = 0;
     gpsYawResetRequest = false;
+    stateStruct.quat.initialise();
     quatAtLastMagReset = stateStruct.quat;
     delAngBiasLearned = false;
     memset(&filterStatus, 0, sizeof(filterStatus));