///////////////////////////////////////////////////////////////////////////////// // // Levenberg - Marquardt non-linear minimization algorithm // Copyright (C) 2004 Manolis Lourakis (lourakis at ics forth gr) // Institute of Computer Science, Foundation for Research & Technology - Hellas // Heraklion, Crete, Greece. // // This program is free software; you can redistribute it and/or modify // it under the terms of the GNU General Public License as published by // the Free Software Foundation; either version 2 of the License, or // (at your option) any later version. // // This program is distributed in the hope that it will be useful, // but WITHOUT ANY WARRANTY; without even the implied warranty of // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the // GNU General Public License for more details. // ///////////////////////////////////////////////////////////////////////////////// /******************************************************************************** * Levenberg-Marquardt nonlinear minimization. The same core code is used with * appropriate #defines to derive single and double precision versions, see * also lm_core.c ********************************************************************************/ #include #include #include #include #include "levmar.h" #include "compiler.h" #include "misc.h" #define EPSILON 1E-12 #define ONE_THIRD 0.3333333334 /* 1.0/3.0 */ #if !defined(LM_DBL_PREC) && !defined(LM_SNGL_PREC) #error At least one of LM_DBL_PREC, LM_SNGL_PREC should be defined! #endif #ifdef LM_SNGL_PREC /* single precision (float) definitions */ #define LM_REAL float #define LM_PREFIX s #define LM_REAL_MAX FLT_MAX #define LM_REAL_MIN -FLT_MAX #define LM_REAL_EPSILON FLT_EPSILON #define __SUBCNST(x) x##F #define LM_CNST(x) __SUBCNST(x) // force substitution #include "lm_core.c" // read in core code #undef LM_REAL #undef LM_PREFIX #undef LM_REAL_MAX #undef LM_REAL_EPSILON #undef LM_REAL_MIN #undef __SUBCNST #undef LM_CNST #endif /* LM_SNGL_PREC */ #ifdef LM_DBL_PREC /* double precision definitions */ #define LM_REAL double #define LM_PREFIX d #define LM_REAL_MAX DBL_MAX #define LM_REAL_MIN -DBL_MAX #define LM_REAL_EPSILON DBL_EPSILON #define LM_CNST(x) (x) #include "lm_core.c" // read in core code #undef LM_REAL #undef LM_PREFIX #undef LM_REAL_MAX #undef LM_REAL_EPSILON #undef LM_REAL_MIN #undef LM_CNST #endif /* LM_DBL_PREC */