15#ifndef EIGEN_LMONESTEP_H
16#define EIGEN_LMONESTEP_H
19#include "./InternalHeaderCheck.h"
23template <
typename FunctorType>
24LevenbergMarquardtSpace::Status LevenbergMarquardt<FunctorType>::minimizeOneStep(FVectorType &x) {
27 RealScalar temp, temp1, temp2;
29 RealScalar pnorm, xnorm, fnorm1, actred, dirder, prered;
30 eigen_assert(x.size() == n);
34 xnorm = m_iter > 1 ? m_diag.cwiseProduct(x).stableNorm() : RealScalar(0);
36 Index df_ret = m_functor.df(x, m_fjac);
37 if (df_ret < 0)
return LevenbergMarquardtSpace::UserAsked;
45 for (
int j = 0; j < x.size(); ++j) m_wa2(j) = m_fjac.col(j).blueNorm();
46 QRSolver qrfac(m_fjac);
49 return LevenbergMarquardtSpace::ImproperInputParameters;
52 m_rfactor = qrfac.matrixR();
53 m_permutation = (qrfac.colsPermutation());
58 if (!m_useExternalScaling)
59 for (Index j = 0; j < n; ++j) m_diag[j] = (m_wa2[j] == 0.) ? 1. : m_wa2[j];
63 xnorm = m_diag.cwiseProduct(x).stableNorm();
64 m_delta = m_factor * xnorm;
65 if (m_delta == 0.) m_delta = m_factor;
71 m_wa4 = qrfac.matrixQ().adjoint() * m_fvec;
72 m_qtf = m_wa4.head(n);
77 for (Index j = 0; j < n; ++j)
78 if (m_wa2[m_permutation.indices()[j]] != 0.)
79 m_gnorm = (std::max)(m_gnorm, abs(m_rfactor.col(j).head(j + 1).dot(m_qtf.head(j + 1) / m_fnorm) /
80 m_wa2[m_permutation.indices()[j]]));
83 if (m_gnorm <= m_gtol) {
85 return LevenbergMarquardtSpace::CosinusTooSmall;
89 if (!m_useExternalScaling) m_diag = m_diag.cwiseMax(m_wa2);
93 internal::lmpar2(qrfac, m_diag, m_qtf, m_delta, m_par, m_wa1);
98 pnorm = m_diag.cwiseProduct(m_wa1).stableNorm();
101 if (m_iter == 1) m_delta = (std::min)(m_delta, pnorm);
104 if (m_functor(m_wa2, m_wa4) < 0)
return LevenbergMarquardtSpace::UserAsked;
106 fnorm1 = m_wa4.stableNorm();
110 if (Scalar(.1) * fnorm1 < m_fnorm) actred = 1. - numext::abs2(fnorm1 / m_fnorm);
114 m_wa3.noalias() = m_rfactor.template triangularView<Upper>() * (m_permutation.inverse() * m_wa1);
115 temp1 = numext::abs2(m_wa3.stableNorm() / m_fnorm);
116 temp2 = numext::abs2(sqrt(m_par) * pnorm / m_fnorm);
117 prered = temp1 + temp2 / Scalar(.5);
118 dirder = -(temp1 + temp2);
123 if (prered != 0.) ratio = actred / prered;
126 if (ratio <= Scalar(.25)) {
127 if (actred >= 0.) temp = RealScalar(.5);
128 if (actred < 0.) temp = RealScalar(.5) * dirder / (dirder + RealScalar(.5) * actred);
129 if (RealScalar(.1) * fnorm1 >= m_fnorm || temp < RealScalar(.1)) temp = Scalar(.1);
131 m_delta = temp * (std::min)(m_delta, pnorm / RealScalar(.1));
133 }
else if (!(m_par != 0. && ratio < RealScalar(.75))) {
134 m_delta = pnorm / RealScalar(.5);
135 m_par = RealScalar(.5) * m_par;
139 if (ratio >= RealScalar(1e-4)) {
142 m_wa2 = m_diag.cwiseProduct(x);
144 xnorm = m_wa2.stableNorm();
150 if (abs(actred) <= m_ftol && prered <= m_ftol && Scalar(.5) * ratio <= 1. && m_delta <= m_xtol * xnorm) {
152 return LevenbergMarquardtSpace::RelativeErrorAndReductionTooSmall;
154 if (abs(actred) <= m_ftol && prered <= m_ftol && Scalar(.5) * ratio <= 1.) {
156 return LevenbergMarquardtSpace::RelativeReductionTooSmall;
158 if (m_delta <= m_xtol * xnorm) {
160 return LevenbergMarquardtSpace::RelativeErrorTooSmall;
164 if (m_nfev >= m_maxfev) {
166 return LevenbergMarquardtSpace::TooManyFunctionEvaluation;
169 Scalar(.5) * ratio <= 1.) {
171 return LevenbergMarquardtSpace::FtolTooSmall;
175 return LevenbergMarquardtSpace::XtolTooSmall;
179 return LevenbergMarquardtSpace::GtolTooSmall;
182 }
while (ratio < Scalar(1e-4));
184 return LevenbergMarquardtSpace::Running;
Namespace containing all symbols from the Eigen library.