diff --git a/matrix/Euler.hpp b/matrix/Euler.hpp index 23c970b375..41d34d0a0e 100644 --- a/matrix/Euler.hpp +++ b/matrix/Euler.hpp @@ -56,7 +56,7 @@ public: if (fabs(theta_val - pi/2) < 1.0e-3) { phi_val = Type(0.0); psi_val = Type(atan2(dcm(1,2), dcm(0,2))); - } else if (Type(fabs(theta_val + pi/2) < Type(1.0e-3))) { + } else if (Type(fabs(theta_val + pi/2)) < Type(1.0e-3)) { phi_val = Type(0.0); psi_val = Type(atan2(-dcm(1,2), -dcm(0,2))); }