mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-15 02:03:33 +08:00
ekf: use std::isfinite instead of isnan
This commit is contained in:
+2
-2
@@ -337,8 +337,8 @@ bool Ekf::update()
|
||||
// the output observer always runs
|
||||
calculateOutputStates();
|
||||
|
||||
// check for NaN on attitude states
|
||||
if (isnan(_state.quat_nominal(0)) || isnan(_output_new.quat_nominal(0))) {
|
||||
// check for NaN or inf on attitude states
|
||||
if (!std::isfinite(_state.quat_nominal(0)) || !std::isfinite(_output_new.quat_nominal(0))) {
|
||||
return false;
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user