fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-19 15:13:33 +08:00
Code Issues Packages Projects Releases Wiki Activity

calibration_routines: use PX4_ISFINITE() instead of isnan()

Browse Source
This commit is contained in:
pixhawk
2017-02-01 08:38:26 +01:00
committed by Lorenz Meier
parent 1da934049c
commit fded02220b
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/commander/calibration_routines.cpp
+2 -2
View File
@@ -372,7 +372,7 @@ int run_lm_sphere_fit(const float x[], const float y[], const float z[], float &
//--------------------Levenberg-Marquardt-part-ends-here--------------------------------// //--------------------Levenberg-Marquardt-part-ends-here--------------------------------//
if (!isnan(fitness) && fitness < _fitness) { if (PX4_ISFINITE(fitness) && fitness < _fitness) {
_fitness = fitness; _fitness = fitness;
*sphere_radius = fit1_params[0]; *sphere_radius = fit1_params[0];
*offset_x = fit1_params[1]; *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--------------------------------// //--------------------Levenberg-Marquardt-part-ends-here--------------------------------//
if (!isnan(fitness) && fitness < _fitness) { if (PX4_ISFINITE(fitness) && fitness < _fitness) {
_fitness = fitness; _fitness = fitness;
*offset_x = fit1_params[0]; *offset_x = fit1_params[0];
*offset_y = fit1_params[1]; *offset_y = fit1_params[1];