23 #include "mbsim/element.h"
55 virtual void updateT(
double t) {};
56 virtual void updateh(
double t,
int j=0) {};
57 virtual void updateh0Fromh1(
double t);
58 virtual void updateW0FromW1(
double t);
59 virtual void updateV0FromV1(
double t);
60 virtual void updateM(
double t,
int i=0) {};
61 virtual void updatedhdz(
double t);
62 virtual void updatedq(
double t,
double dt);
63 virtual void updatedu(
double t,
double dt);
64 virtual void updateud(
double t,
int i=0);
65 virtual void updateqd(
double t);
66 virtual void updatezd(
double t);
67 virtual void sethSize(
int hSize_,
int i=0);
68 virtual int gethSize(
int i=0)
const {
return hSize[i]; }
69 virtual int getqSize()
const {
return qSize; }
70 virtual int getuSize(
int i=0)
const {
return uSize[i]; }
71 virtual void calcqSize() {};
72 virtual void calcuSize(
int j) {};
74 virtual int getuInd(
int i=0) {
return uInd[i]; }
76 virtual void setqInd(
int qInd_) {
qInd = qInd_; }
77 virtual void setuInd(
int uInd_,
int i=0) { uInd[i] = uInd_; }
79 virtual const fmatvec::Vec& getq()
const {
return q; };
80 virtual const fmatvec::Vec& getu()
const {
return u; };
84 virtual void updateStateDependentVariables(
double t) = 0;
85 virtual void updateStateDerivativeDependentVariables(
double t) {};
86 virtual void updateJacobians(
double t,
int j=0) = 0;
87 virtual void updatehInverseKinetics(
double t,
int i=0) {};
91 virtual void plot(
double t,
double dt = 1);
93 virtual std::string
getType()
const {
return "Object"; }
101 virtual void updateqRef(
const fmatvec::Vec& qRef);
107 virtual void updateqdRef(
const fmatvec::Vec& qdRef);
113 virtual void updateuRef(
const fmatvec::Vec& uRef);
125 virtual void updateudRef(
const fmatvec::Vec& udRef,
int i=0);
131 virtual void updateudallRef(
const fmatvec::Vec& udallRef,
int i=0);
138 virtual void updatehRef(
const fmatvec::Vec& hRef,
int i=0);
140 virtual void updateWRef(
const fmatvec::Mat& WRef,
int i=0);
141 virtual void updateVRef(
const fmatvec::Mat& VRef,
int i=0);
148 virtual void updatedhdqRef(
const fmatvec::Mat& dhdqRef,
int i=0);
155 virtual void updatedhduRef(
const fmatvec::SqrMat& dhduRef,
int i=0);
162 virtual void updatedhdtRef(
const fmatvec::Vec& dhdtRef,
int i=0);
168 virtual void updaterRef(
const fmatvec::Vec& ref,
int i=0);
174 virtual void updateTRef(
const fmatvec::Mat &ref);
181 virtual void updateMRef(
const fmatvec::SymMat &ref,
int i=0);
188 virtual void updateLLMRef(
const fmatvec::SymMat &ref,
int i=0);
198 virtual void initz();
203 virtual void facLLM(
int i=0);
244 void setqSize(
int qSize_) {
qSize = qSize_; }
245 void setuSize(
int uSize_,
int i=0) {
uSize[i] = uSize_; }
246 int getzSize()
const {
return qSize +
uSize[0]; }
248 virtual void sethInd(
int hInd_,
int i=0);
249 int gethInd(
int i=0) {
return hInd[i]; }
251 const fmatvec::Vec& geth(
int i=0)
const {
return h[i]; };
252 fmatvec::Vec& geth(
int i=0) {
return h[i]; };
253 const fmatvec::Vec& getr(
int i=0)
const {
return r[i]; };
254 fmatvec::Vec& getr(
int i=0) {
return r[i]; };
255 const fmatvec::SymMat& getM(
int i=0)
const {
return M[i]; };
256 fmatvec::SymMat& getM(
int i=0) {
return M[i]; };
257 const fmatvec::Mat& getT()
const {
return T; };
258 fmatvec::Mat& getT() {
return T; };
259 const fmatvec::SymMat& getLLM(
int i=0)
const {
return LLM[i]; };
260 fmatvec::SymMat& getLLM(
int i=0) {
return LLM[i]; };
262 fmatvec::Vec& getq() {
return q; };
263 fmatvec::Vec& getu() {
return u; };
265 const fmatvec::Vec& getq0()
const {
return q0; };
266 const fmatvec::Vec& getu0()
const {
return u0; };
267 fmatvec::Vec& getq0() {
return q0; };
268 fmatvec::Vec& getu0() {
return u0; };
270 const fmatvec::Vec& getqd()
const {
return qd; };
271 const fmatvec::Vec& getud(
int i=0)
const {
return ud[i]; };
272 fmatvec::Vec& getqd() {
return qd; };
273 fmatvec::Vec& getud(
int i=0) {
return ud[i]; };
275 void setq(
const fmatvec::Vec &q_) {
q = q_; }
276 void setu(
const fmatvec::Vec &u_) { u = u_; }
278 void setInitialGeneralizedPosition(
const fmatvec::Vec &q0_) {
q0 = q0_; }
279 void setInitialGeneralizedVelocity(
const fmatvec::Vec &u0_) { u0 = u0_; }
280 void setInitialGeneralizedPosition(
double q0_) {
q0 = fmatvec::Vec(1,fmatvec::INIT,q0_); }
281 void setInitialGeneralizedVelocity(
double u0_) { u0 = fmatvec::Vec(1,fmatvec::INIT,u0_); }
285 virtual void initializeUsingXML(TiXmlElement *element);
313 fmatvec::Vec
q, u, uall;
323 fmatvec::Vec
qd, ud[2], udall[2];
328 fmatvec::Vec
h[2], r[2];
330 fmatvec::Mat W[2], V[2];
336 fmatvec::SqrMat dhdu;
347 fmatvec::SymMat
M[2];