diff --git a/libraries/AP_Math/quaternion.cpp b/libraries/AP_Math/quaternion.cpp index 014662a632..4bfa09e018 100644 --- a/libraries/AP_Math/quaternion.cpp +++ b/libraries/AP_Math/quaternion.cpp @@ -22,14 +22,14 @@ // return the rotation matrix equivalent for this quaternion void Quaternion::rotation_matrix(Matrix3f &m) { - float q3q3 = q3 * q3; - float q3q4 = q3 * q4; - float q2q2 = q2 * q2; - float q2q3 = q2 * q3; - float q2q4 = q2 * q4; - float q1q2 = q1 * q2; - float q1q3 = q1 * q3; - float q1q4 = q1 * q4; + float q3q3 = q3 * q3; + float q3q4 = q3 * q4; + float q2q2 = q2 * q2; + float q2q3 = q2 * q3; + float q2q4 = q2 * q4; + float q1q2 = q1 * q2; + float q1q3 = q1 * q3; + float q1q4 = q1 * q4; float q4q4 = q4 * q4; m.a.x = 1-2*(q3q3 + q4q4);