Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

EKF3: correct acos to acosf

This commit is contained in:
Pierre Kancir 2018-02-12 12:29:10 +01:00 committed by Randy Mackay
parent 48c5a9b9c5
commit 44a21bc8ac
1 changed files with 1 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
libraries/AP_NavEKF3/AP_NavEKF3_core.cpp
View File

@ -1630,7 +1630,7 @@ Vector3f NavEKF3_core::calcRotVecVariances()
q3 = -q3;
}
float t2 = q0*q0;
float t3 = acos(q0);
float t3 = acosf(q0);
float t4 = -t2+1.0f;
float t5 = t2-1.0f;
if ((t4 > 1e-9f) && (t5 < -1e-9f)) {