23 #include <gsl/gsl_multifit_nlinear.h>
24 #include <gsl/gsl_blas.h>
35 return std::make_shared<GSLEngine>(max_iterations);
41 m_itmax{itmax}, m_xtol{xtol}, m_gtol{gtol}, m_ftol{ftol}, m_delta{delta} {
43 gsl_set_error_handler_off();
70 return gsl_vector_get(
m_v,
m_i);
74 return *gsl_vector_ptr(
m_v,
m_i);
81 const gsl_vector *
m_v;
102 return gsl_vector_get(
m_v,
m_i);
121 auto adata =
std::tie(parameter_manager, residual_estimator);
124 const gsl_multifit_nlinear_type *type = gsl_multifit_nlinear_trust;
129 gsl_multifit_nlinear_parameters params = gsl_multifit_nlinear_default_parameters();
133 params.trs = gsl_multifit_nlinear_trs_lm;
136 params.scale = gsl_multifit_nlinear_scale_levenberg;
138 params.solver = gsl_multifit_nlinear_solver_cholesky;
140 params.fdtype = GSL_MULTIFIT_NLINEAR_FWDIFF;
145 gsl_multifit_nlinear_workspace *workspace = gsl_multifit_nlinear_alloc(
149 if (workspace ==
nullptr) {
156 gsl_vector_view gsl_param_view = gsl_vector_view_array(param_values.
data(), param_values.
size());
159 auto function = [](
const gsl_vector *
x,
void *extra, gsl_vector *f) ->
int {
160 auto *extra_ptr = (decltype(adata) *) extra;
167 gsl_multifit_nlinear_fdf fdf;
176 gsl_multifit_nlinear_init(&gsl_param_view.vector, &fdf, workspace);
180 gsl_vector *residual = gsl_multifit_nlinear_residual(workspace);
181 gsl_blas_ddot(residual, residual, &chisq0);
185 int ret = gsl_multifit_nlinear_driver(
198 gsl_blas_ddot(residual, residual, &chisq);
207 summary.
iteration_no = gsl_multifit_nlinear_niter(workspace);
211 gsl_matrix *J = gsl_multifit_nlinear_jac(workspace);
212 gsl_matrix_view covar = gsl_matrix_view_array(covariance_matrix.
data(), parameter_manager.
numberOfParameters(),
214 gsl_multifit_nlinear_covar(J, 0.0, &covar.matrix);
220 for (
size_t i = 0; i < residual->size; ++i) {
221 auto v = gsl_vector_get(residual, i);
224 sigma2 /= (fdf.n - fdf.p);
226 for (
auto ci = covariance_matrix.
begin(); ci != covariance_matrix.
end(); ++ci) {
236 int levmar_reason = 0;
237 if (ret == GSL_SUCCESS) {
238 levmar_reason = (info == 1) ? 2 : 1;
240 else if (ret == GSL_EMAXITER) {
247 gsl_blas_dnrm2(workspace->g),
248 gsl_blas_dnrm2(workspace->dx),
251 static_cast<double>(levmar_reason),
252 static_cast<double>(fdf.nevalf),
253 static_cast<double>(fdf.nevaldf),
258 gsl_multifit_nlinear_free(workspace);