1 #ifndef _FMATVEC_CHECKDERIVATIVE_H_ 2 #define _FMATVEC_CHECKDERIVATIVE_H_ 8 #include <fmatvec/linear_algebra.h> 12 #define FMATVEC_CHECKDERIVATIVE_MEMBERFUNC(func, anaDiff, value, ...) \ 13 fmatvec::checkDerivative(this, std::string(__FILE__)+":"+std::to_string(__LINE__)+":"+#anaDiff, func, anaDiff, value, __VA_ARGS__) 14 #define FMATVEC_CHECKDERIVATIVE_GLOBALFUNC(func, anaDiff, value, ...) \ 15 fmatvec::checkDerivative(nullptr, std::string(__FILE__)+":"+std::to_string(__LINE__)+":"+#anaDiff, func, anaDiff, value, __VA_ARGS__) 27 void checkDerivative(
const void *idPtr,
const std::string &idName,
const std::function<
void(
double)> &func,
const Value &anaDiff,
const Value &value,
double indep,
double eps=1e-6,
double delta=1e-8) {
29 #error "fmatvec::checkDerivative should not be active for release builds" 32 static int distributedCount = 0;
33 static std::map<std::pair<const void*, std::string>, std::pair<bool, Value>> ele;
35 auto &[disturbed, disturbedValue] = ele.emplace(std::make_pair(idPtr, idName), std::make_pair(
false, Value())).first->second;
39 disturbedValue = value;
41 else if(distributedCount == 0) {
42 std::array<Value, 2> disturbedValueRightLeft;
50 if constexpr (std::is_same_v<Value, double>)
51 disturbedValueRightLeft[0] = disturbedValue;
53 disturbedValueRightLeft[0] <<= disturbedValue;
57 if constexpr (std::is_same_v<Value, double>)
58 disturbedValueRightLeft[1] = disturbedValue;
60 disturbedValueRightLeft[1] <<= disturbedValue;
68 std::array<double, 2> dist;
69 std::array<Value, 2> finiteDiffRightLeft;
70 for(
int i=0; i<2; ++i) {
71 finiteDiffRightLeft[i] = (i==0?1.0:-1.0) * (disturbedValueRightLeft[i] - value)/delta;
73 if constexpr (std::is_same_v<Value, double>)
74 dist[i] = std::abs(finiteDiffRightLeft[i] - anaDiff);
75 else if constexpr (Value::isVector)
79 for(
int c=0; c<anaDiff.cols(); c++)
80 dist[i] = std::max(dist[i], fmatvec::nrm2(finiteDiffRightLeft[i].col(c) - anaDiff.col(c)));
85 double dist0 = dist[0];
86 double dist1 = dist[1];
87 if(dist0 > eps && dist1 > eps) {
88 std::stringstream str;
89 str<<
"checkDerivative failed in "<<idPtr<<
": ID = "<<idName<<
":"<<std::endl
90 <<
"- anaDiff = "<<anaDiff<<std::endl
91 <<
"- finiteDiffRight = "<<finiteDiffRightLeft[0]<<std::endl
92 <<
"- finiteDiffLeft = "<<finiteDiffRightLeft[1]<<std::endl
93 <<
"- indep = "<<indep<<std::endl
94 <<
"- nrmInf (right/left) = "<<dist[0]<<
" "<<dist[1];
96 std::cerr<<str.str()<<std::endl;
98 throw std::runtime_error(str.str());
double nrmInf(const Matrix< Symmetric, Ref, Ref, double > &A)
Infinity-norm.
Definition: linear_algebra_double.cc:820
Namespace fmatvec.
Definition: _memory.cc:28