20 #ifndef NUMERICSLCPREFORMULATEDFUNCTION_H_
21 #define NUMERICSLCPREFORMULATEDFUNCTION_H_
23 #include <mbsim/utils/function.h>
25 #include <mbsim/numerics/functions/newton_method_jacobian_functions.h>
41 LCPReformulationFunction(
const fmatvec::Vec &q_,
const fmatvec::SqrMat &M_,
const double &r_ = 10,
const unsigned int & DEBUGLEVEL_ = 0);
53 virtual fmatvec::Vec
operator()(
const fmatvec::Vec &
q,
const void * = NULL) = 0;
60 void setSystem(
const fmatvec::SqrMat & M_,
const fmatvec::Vec & q_) {
63 assert(
M.rows() ==
q.rows());
66 fmatvec::SqrMat getM(
void) {
72 void setr(
const double & r_) {
128 fmatvec::Vec
operator()(
const fmatvec::Vec &
q,
const void * = NULL);
159 fmatvec::Vec
operator()(
const fmatvec::Vec &
q,
const void * = NULL);
175 virtual fmatvec::SqrMat
operator ()(
const fmatvec::Vec & x,
const void* = NULL);
179 void updateJacobian(
const fmatvec::Vec & x);
189 #endif //NUMERICSLCPREFORMULATEDFUNCTION_H_