mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-05-02 05:04:08 +08:00
fixed wrong type conversion
This commit is contained in:
parent
c3c6a0a9df
commit
cc1658db15
@ -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();
|
||||
|
||||
|
||||
Loading…
x
Reference in New Issue
Block a user