Fix typo.

This commit is contained in:
James Goppert
2016-01-24 02:30:54 -05:00
parent d8e397c010
commit e639a3612f
+1 -1
View File
@@ -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)));
}