dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

calibration_routines: use PX4_ISFINITE() instead of isnan()

This commit is contained in:
pixhawk 2017-01-27 10:59:06 +01:00 committed by Lorenz Meier
parent 1da934049c
commit fded02220b
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
src/modules/commander/calibration_routines.cpp
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--------------------------------//
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];