From fded02220bb17e69c69cda0dd3e2bfea638aaaec Mon Sep 17 00:00:00 2001 From: pixhawk Date: Fri, 27 Jan 2017 10:59:06 +0100 Subject: [PATCH] calibration_routines: use PX4_ISFINITE() instead of isnan() --- src/modules/commander/calibration_routines.cpp | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/src/modules/commander/calibration_routines.cpp b/src/modules/commander/calibration_routines.cpp index a63890ccc4..75f938acf2 100644 --- a/src/modules/commander/calibration_routines.cpp +++ b/src/modules/commander/calibration_routines.cpp @@ -372,7 +372,7 @@ int run_lm_sphere_fit(const float x[], const float y[], const float z[], float & //--------------------Levenberg-Marquardt-part-ends-here--------------------------------// - if (!isnan(fitness) && fitness < _fitness) { + if (PX4_ISFINITE(fitness) && fitness < _fitness) { _fitness = fitness; *sphere_radius = fit1_params[0]; *offset_x = fit1_params[1]; @@ -507,7 +507,7 @@ int run_lm_ellipsoid_fit(const float x[], const float y[], const float z[], floa } //--------------------Levenberg-Marquardt-part-ends-here--------------------------------// - if (!isnan(fitness) && fitness < _fitness) { + if (PX4_ISFINITE(fitness) && fitness < _fitness) { _fitness = fitness; *offset_x = fit1_params[0]; *offset_y = fit1_params[1];