Fixed euler wrapping.

2026-10-31 06:51:35 +08:00 · 2016-01-25 13:40:51 -05:00
parent a92d5c1338
commit 1778ac199c
2 changed files with 2 additions and 4 deletions
@@ -61,8 +61,6 @@ public:
            psi_val = Type(atan2(-dcm(1,2), -dcm(0,2)));
        }

-        if (psi_val < 0) psi_val += 2*pi;
-
        phi() = phi_val;
        theta() = theta_val;
        psi() = psi_val;