diff --git a/src/shared/algorithms/NAS/StateInitializer.cpp b/src/shared/algorithms/NAS/StateInitializer.cpp index 528f5be25f36d2126d7474822b907a9eba8deb9a..902379061a0f763c777e99f2d60dd8d3b978fbe9 100644 --- a/src/shared/algorithms/NAS/StateInitializer.cpp +++ b/src/shared/algorithms/NAS/StateInitializer.cpp @@ -78,7 +78,7 @@ void StateInitializer::triad(const Vector3f& acc, const Vector3f& mag, m << r1, r2, r3; // Compute the rotation matrix and the corresponding quaternion - Matrix3f A = M * m.transpose(); + Matrix3f A = m * M.transpose(); Vector4f q = SkyQuaternion::rotationMatrix2quat(A); // Save the orientation in the state