23 #include "utils/function.h"
39 #ifdef HAVE_OPENMBVCPPINTERFACE
40 virtual OpenMBV::Group* getOpenMBVGrp() {
return 0;}
55 void addDependency(
RigidBody* body_,
double ratio1,
double ratio2=0);
56 void setFrame(
Frame* frame_) {frame = frame_;}
60 void setReferenceBody(
RigidBody* body_) {bd=body_; }
62 void updateStateDependentVariables(
double t);
63 void updateJacobians(
double t,
int j=0);
66 void initializeUsingXML(TiXmlElement * element);
69 std::vector<RigidBody*> bi;
71 std::vector<double> ratio[2];
74 std::string saved_ReferenceBody;
75 std::vector<std::string> saved_DependencyBodies;
76 std::vector<double> saved_ratio;
91 void updateStateDependentVariables(
double t);
92 void updateJacobians(
double t,
int j=0);
109 void setDependentBodiesFirstSide(std::vector<RigidBody*> bd);
110 void setDependentBodiesSecondSide(std::vector<RigidBody*> bd);
114 void setForceDirection(
const fmatvec::Mat& d_) {dT = d_;}
115 void setMomentDirection(
const fmatvec::Mat& d_) {dR = d_;}
116 void setq0(
const fmatvec::Vec& q0_) {
q0 = q0_;}
118 fmatvec::Vec res(
const fmatvec::Vec&
q,
const double& t);
119 void updateStateDependentVariables(
double t);
120 void updateJacobians(
double t,
int j=0);
121 virtual void initializeUsingXML(TiXmlElement *element);
126 std::vector<RigidBody*> body1, body2;
128 Frame *frame1, *frame2;
130 std::vector<int> i1,i2;
132 Residuum(std::vector<RigidBody*> body1_, std::vector<RigidBody*> body2_,
const fmatvec::Mat &dT_,
const fmatvec::Mat &dR_,
Frame *frame1_,
Frame *frame2_,
double t_,std::vector<int> i1_, std::vector<int> i2_);
133 fmatvec::Vec
operator()(
const fmatvec::Vec &x,
const void * =NULL);
135 std::vector<RigidBody*> bd1;
136 std::vector<RigidBody*> bd2;
138 std::vector<int> if1;
139 std::vector<int> if2;
141 Frame *frame1,*frame2;
146 std::vector<fmatvec::Index> Iq1, Iq2, Iu1, Iu2, Ih1, Ih2;
154 std::string saved_ref1, saved_ref2;
155 std::vector<std::string> saved_RigidBodyFirstSide, saved_RigidBodySecondSide;
156 std::string saved_IndependentBody;