diff --git a/src/Utils/Quaternion.cpp b/src/Utils/Quaternion.cpp index 8a87f8b2..413a2323 100644 --- a/src/Utils/Quaternion.cpp +++ b/src/Utils/Quaternion.cpp @@ -366,8 +366,8 @@ utils::Vector3d utils::Quaternion::omegaToEulerDot( const utils::Vector3d &w, const utils::String& seq) { - utils:Matrix3d velocityMatrix = utils::Rotation::fromEulerAngles(euler, seq).inverse(); - utils::Vector3d eulerDot = velocityMatrix * w; + utils:Matrix3d velocity_matrix = velocityMatrix(euler, seq).inverse(); + utils::Vector3d eulerDot = velocity_matrix * w; return eulerDot; }