mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-29 16:23:34 +08:00
ekf2: use fmaxf instead of fmax
This commit is contained in:
@@ -1181,7 +1181,7 @@ void Ekf2::run()
|
|||||||
|
|
||||||
// orientation measurement error from parameters
|
// orientation measurement error from parameters
|
||||||
if (!PX4_ISFINITE(ev_odom.pose_covariance[0])) {
|
if (!PX4_ISFINITE(ev_odom.pose_covariance[0])) {
|
||||||
ev_data.angErr = fmaxf(_ev_ang_noise.get(), sqrtf(fmaxf(ev_odom.pose_covariance[15], fmax(ev_odom.pose_covariance[18],
|
ev_data.angErr = fmaxf(_ev_ang_noise.get(), sqrtf(fmaxf(ev_odom.pose_covariance[15], fmaxf(ev_odom.pose_covariance[18],
|
||||||
ev_odom.pose_covariance[20]))));
|
ev_odom.pose_covariance[20]))));
|
||||||
|
|
||||||
} else {
|
} else {
|
||||||
|
|||||||
Reference in New Issue
Block a user