AP_Mount: Change from sqrt to safe_sqrt

2018-11-02 21:47:03 +09:00 · 2018-11-02 21:47:03 +09:00 · 998dd7207f
parent 49ce9d02b1
commit 998dd7207f
1 changed files with 1 additions and 1 deletions
--- a/libraries/AP_Mount/SoloGimbalEKF.cpp
+++ b/libraries/AP_Mount/SoloGimbalEKF.cpp
@ -658,7 +658,7 @@ void SoloGimbalEKF::fuseVelocity()
    }

    // calculate tilt component of angle correction
-    TiltCorrection = sqrtf(sq(angErrVec.x) + sq(angErrVec.y));
+    TiltCorrection = safe_sqrt(sq(angErrVec.x) + sq(angErrVec.y));
 }

 // check for new magnetometer data and update store measurements if available