22numericalJacobian(
const std::function<Eigen::VectorXd(
const Eigen::VectorXd&)>& func,
23 const Eigen::VectorXd& x,
int outputDim);
A collection of utility functions and classes with common use-cases.
Definition SwerveController.cpp:145
Eigen::MatrixXd numericalJacobian(const std::function< Eigen::VectorXd(const Eigen::VectorXd &)> &func, const Eigen::VectorXd &x, int outputDim)
Estimate the jacobian of a multivariate function using finite differences.
Definition math.cpp:6
constexpr double epsilon
A small positive value, near zero.
Definition math.h:10