Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-01 13:38:38 -04:00
Code Issues Packages Projects Releases Wiki Activity

SITL: use sinf() and cosf()

Browse Source 
for some strange reason the double precision functions can crash
This commit is contained in:
Andrew Tridgell 2014-01-04 17:45:20 +11:00
parent bb0eed5c14
commit 9e3bf685c2
1 changed files with 3 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
libraries/SITL/SITL.cpp
View File

@ -132,8 +132,8 @@ void SITL::convert_body_frame(double rollDeg, double pitchDeg,
thetaDot = ToRad(pitchRate);
psiDot = ToRad(yawRate);
*p = phiDot - psiDot*sin(theta);
*q = cos(phi)*thetaDot + sin(phi)*psiDot*cos(theta);
*r = cos(phi)*psiDot*cos(theta) - sin(phi)*thetaDot;
*p = phiDot - psiDot*sinf(theta);
*q = cosf(phi)*thetaDot + sinf(phi)*psiDot*cosf(theta);
*r = cosf(phi)*psiDot*cosf(theta) - sinf(phi)*thetaDot;
}