Browse Source

SITL: fixed build warnings

mission-4.1.18
Andrew Tridgell 10 years ago
parent
commit
b541bfb739
  1. 6
      libraries/SITL/SITL.cpp

6
libraries/SITL/SITL.cpp

@ -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;
} }

Loading…
Cancel
Save