AP_Mount: Change from sqrt to safe_sqrt

This commit is contained in:
murata 2018-11-02 21:47:03 +09:00 committed by Randy Mackay
parent 49ce9d02b1
commit 998dd7207f

View File

@ -658,7 +658,7 @@ void SoloGimbalEKF::fuseVelocity()
} }
// calculate tilt component of angle correction // 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 // check for new magnetometer data and update store measurements if available