Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

SITL: fixed build warnings

This commit is contained in:
Andrew Tridgell 2015-05-30 22:51:38 +10:00
parent d5da9fcca6
commit b541bfb739
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

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