mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-01-08 17:08:28 -04:00
SITL: fixed build warnings
This commit is contained in:
parent
d5da9fcca6
commit
b541bfb739
@ -138,9 +138,9 @@ void SITL::convert_body_frame(double rollDeg, double pitchDeg,
|
||||
thetaDot = ToRad(pitchRate);
|
||||
psiDot = ToRad(yawRate);
|
||||
|
||||
*p = phiDot - psiDot*sinf(theta);
|
||||
*q = cosf(phi)*thetaDot + sinf(phi)*psiDot*cosf(theta);
|
||||
*r = cosf(phi)*psiDot*cosf(theta) - sinf(phi)*thetaDot;
|
||||
*p = phiDot - psiDot*sin(theta);
|
||||
*q = cos(phi)*thetaDot + sin(phi)*psiDot*cos(theta);
|
||||
*r = cos(phi)*psiDot*cos(theta) - sin(phi)*thetaDot;
|
||||
}
|
||||
|
||||
|
||||
|
Loading…
Reference in New Issue
Block a user