36class NumericalDiff :
public Functor_ {
38 using Functor = Functor_;
39 using Scalar =
typename Functor::Scalar;
40 using InputType =
typename Functor::InputType;
41 using ValueType =
typename Functor::ValueType;
42 using JacobianType =
typename Functor::JacobianType;
46 static Scalar defaultRelTol() {
51 NumericalDiff(Scalar epsfcn = 0.)
57 NumericalDiff(
const Functor& f, Scalar epsfcn = 0.)
65 template <typename T0, std::enable_if_t<std::is_constructible<Functor, const T0&>::value,
int> = 0>
66 NumericalDiff(
const T0& a0) : Functor(a0), rel_tol(defaultRelTol()), abs_tol(defaultRelTol()) {}
68 template <
typename T0,
typename T1,
69 std::enable_if_t<std::is_constructible<Functor, const T0&, const T1&>::value,
int> = 0>
70 NumericalDiff(
const T0& a0,
const T1& a1) : Functor(a0, a1), rel_tol(defaultRelTol()), abs_tol(defaultRelTol()) {}
72 template <
typename T0,
typename T1,
typename T2,
73 std::enable_if_t<std::is_constructible<Functor, const T0&, const T1&, const T2&>::value,
int> = 0>
74 NumericalDiff(
const T0& a0,
const T1& a1,
const T2& a2)
75 : Functor(a0, a1, a2), rel_tol(defaultRelTol()), abs_tol(defaultRelTol()) {}
78 void setRelTol(Scalar _rel_tol) {
82 void setAbsTol(Scalar _abs_tol) {
83 eigen_assert(_abs_tol > 0);
86 Scalar relTol()
const {
return rel_tol; }
87 Scalar absTol()
const {
return abs_tol; }
89 enum { InputsAtCompileTime = Functor::InputsAtCompileTime, ValuesAtCompileTime = Functor::ValuesAtCompileTime };
103 int df(
const InputType& _x, JacobianType& jac)
const {
108 const typename InputType::Index n = _x.size();
109 ValueType val1, val2;
112 val1.resize(Functor::values());
113 val2.resize(Functor::values());
119 Functor::operator()(x, val1);
130 for (
int j = 0; j < n; ++j) {
131 const Scalar x_abs = abs(x[j]);
132 h = numext::maxi(x_abs * rel_tol, abs_tol);
136 Scalar x_plus = _x[j] + h;
138 internal::pbarrier(x_plus);
143 Functor::operator()(x, val2);
146 jac.col(j) = (val2 - val1) / h;
150 Functor::operator()(x, val2);
154 Scalar x_minus = _x[j] - h;
155 internal::pbarrier(x_minus);
157 Functor::operator()(x, val1);
160 jac.col(j) = (val2 - val1) / (x_plus - x_minus);