fixed wrong type conversion

This commit is contained in:
Roman 2015-12-22 11:23:18 +01:00
parent c3c6a0a9df
commit cc1658db15

View File

@ -54,7 +54,7 @@ public:
phi() = (Type)0.0;
psi() = (Type)atan2(dcm(1,2) - dcm(0,1), dcm(0,2) + dcm(1,1)) + theta();
} else if (fabs(theta() + (Type)M_PI_2) < (Type)1.0e-3) {
} else if ((Type)fabs(theta() + (Type)M_PI_2) < (Type)1.0e-3) {
phi() = (Type)0.0;
psi() = (Type)atan2(dcm(1,2) - dcm(0,1), dcm(0,2) + dcm(1,1)) - theta();