SITL: use sinf() and cosf()

for some strange reason the double precision functions can crash
11 years ago · 9e3bf685c2
1 changed files with 3 additions and 3 deletions
--- a/libraries/SITL/SITL.cpp
+++ b/libraries/SITL/SITL.cpp
@ -132,8 +132,8 @@ void SITL::convert_body_frame(double rollDeg, double pitchDeg,
 	thetaDot = ToRad(pitchRate);
 	psiDot = ToRad(yawRate);
-	*p = phiDot - psiDot*sin(theta);
+	*p = phiDot - psiDot*sinf(theta);
-	*q = cos(phi)*thetaDot + sin(phi)*psiDot*cos(theta);
+	*q = cosf(phi)*thetaDot + sinf(phi)*psiDot*cosf(theta);
-	*r = cos(phi)*psiDot*cos(theta) - sin(phi)*thetaDot;    
+	*r = cosf(phi)*psiDot*cosf(theta) - sinf(phi)*thetaDot;    
 }