23 #include "mbsim/element.h"
27 extern const PlotFeatureEnum generalizedPosition, generalizedVelocity, derivativeOfGeneralizedPosition, generalizedAcceleration;
50 virtual void calcSize() { }
51 int getGeneralizedPositionSize() {
if(updSize) calcSize();
return nq; }
52 int getGeneralizedVelocitySize() {
if(updSize) calcSize();
return nu; }
54 virtual void updateT() { }
55 virtual void updateh(
int j=0) { }
56 virtual void updateM() { }
57 virtual void updatedhdz();
58 virtual void updatedq();
59 virtual void updatedu();
60 virtual void updateud();
61 virtual void updateqd();
62 virtual void sethSize(
int hSize_,
int i=0);
63 virtual int gethSize(
int i=0)
const {
return hSize[i]; }
64 virtual int getqSize()
const {
return qSize; }
65 virtual int getuSize(
int i=0)
const {
return uSize[i]; }
66 virtual void calcqSize() { }
67 virtual void calcuSize(
int j) { }
68 virtual int getuInd(
int i=0) {
return uInd[i]; }
69 virtual void setqInd(
int qInd_) {
qInd = qInd_; }
70 virtual void setuInd(
int uInd_,
int i=0) { uInd[i] = uInd_; }
190 void init(
InitStage stage,
const InitConfigSet &config)
override;
195 virtual void initz();
229 void setqSize(
int qSize_) {
qSize = qSize_; }
230 void setuSize(
int uSize_,
int i=0) {
uSize[i] = uSize_; }
231 int getzSize()
const {
return qSize +
uSize[0]; }
233 virtual void sethInd(
int hInd_,
int i=0);
234 int gethInd(
int i=0) {
return hInd[i]; }
238 const fmatvec::Vec& geth(
int i=0,
bool check=
true)
const;
262 void resetUpToDate()
override { updq =
true; updu =
true; updqd =
true; updud =
true; }
264 virtual void updateGeneralizedPositions();
265 virtual void updateGeneralizedVelocities();
266 virtual void updateGeneralizedAccelerations();
267 virtual void updateDerivativeOfGeneralizedPositions();
269 const fmatvec::VecV& evalGeneralizedPosition() {
if(updq) updateGeneralizedPositions();
return qRel; }
270 const fmatvec::VecV& evalGeneralizedVelocity() {
if(updu) updateGeneralizedVelocities();
return uRel; }
271 const fmatvec::VecV& evalDerivativeOfGeneralizedPosition() {
if(updqd) updateDerivativeOfGeneralizedPositions();
return qdRel; }
272 const fmatvec::VecV& evalGeneralizedAcceleration() {
if(updud) updateGeneralizedAccelerations();
return udRel; }
273 fmatvec::VecV& getGeneralizedPosition(
bool check=
true) { assert((not check) or (not updq));
return qRel; }
274 fmatvec::VecV& getGeneralizedVelocity(
bool check=
true) { assert((not check) or (not updu));
return uRel; }
275 fmatvec::VecV& getDerivativeOfGeneralizedPosition(
bool check=
true) { assert((not check) or (not updqd));
return qdRel; }
276 fmatvec::VecV& getGeneralizedAcceleration(
bool check=
true) { assert((not check) or (not updud));
return udRel; }
281 bool hasNonCostantMassMatrix() {
return nonConstantMassMatrix; }
284 void initializeUsingXML(xercesc::DOMElement *element)
override;
353 fmatvec::VecV qRel, uRel, qdRel, udRel;
355 bool updSize, updq, updu, updqd, updud;
357 bool nonConstantMassMatrix{
true};
int qInd
indices of positions, velocities, right hand side
Definition: object.h:307
Object(const std::string &name)
constructor
Definition: object.cc:43
virtual void updateudallRef(const fmatvec::Vec &udallRef)
references to differentiated velocities of dynamic system parent
Definition: object.cc:157
virtual void updatedqRef(const fmatvec::Vec &dqRef)
references to differentiated positions of dynamic system parent
Definition: object.cc:137
virtual void updateTRef(const fmatvec::Mat &ref)
references to linear transformation matrix between differentiated positions and velocities of dynamic...
Definition: object.cc:185
virtual void updateLLM()
perform Cholesky decomposition of mass martix
Definition: object.h:210
virtual void updatedhdqRef(const fmatvec::Mat &dhdqRef, int i=0)
references to object Jacobian for implicit integration of dynamic system parent regarding positions ...
Definition: object.cc:165
fmatvec::Mat T
linear relation matrix of differentiated position and velocity parameters
Definition: object.h:341
virtual void updateudRef(const fmatvec::Vec &udRef)
references to differentiated velocities of dynamic system parent
Definition: object.cc:149
int qSize
size of object positions
Definition: object.h:292
void plot() override
plots time dependent data
Definition: object.cc:100
virtual void initz()
Definition: object.cc:232
fmatvec::Vec q
positions, velocities
Definition: object.h:312
basic class of MBSim mainly for plotting
Definition: element.h:56
virtual void writez(H5::GroupBase *group)
writes its z-Vector to a subgroup of the given group
Definition: object.cc:247
int hSize[2]
size of object h-vector (columns of J)
Definition: object.h:302
fmatvec::SymMat LLM
LU-decomposition of mass matrix.
Definition: object.h:351
virtual void updatedhduRef(const fmatvec::SqrMat &dhduRef, int i=0)
references to object Jacobian for implicit integration of dynamic system parent regarding velocities ...
Definition: object.cc:169
void init(InitStage stage, const InitConfigSet &config) override
initialize object at start of simulation with respect to contours and frames
Definition: object.cc:197
InitStage
The stages of the initialization.
Definition: element.h:62
virtual void updatedhdtRef(const fmatvec::Vec &dhdtRef, int i=0)
references to object Jacobian for implicit integration of dynamic system parent regarding time ...
Definition: object.cc:173
std::string name
name of element
Definition: element.h:235
virtual void updateuRef(const fmatvec::Vec &uRef)
references to velocities of dynamic system parent
Definition: object.cc:141
fmatvec::Mat dhdq
Jacobians of h.
Definition: object.h:334
virtual double evalKineticEnergy()
Definition: object.h:215
virtual void updateqRef(const fmatvec::Vec &qRef)
references to positions of dynamic system parent
Definition: object.cc:129
virtual void updateMRef(const fmatvec::SymMat &ref)
references to mass matrix of dynamic system parent
Definition: object.cc:189
int uSize[2]
size of object velocities
Definition: object.h:297
virtual void updatehRef(const fmatvec::Vec &hRef, int i=0)
references to smooth force vector of dynamic system parent
Definition: object.cc:161
virtual void updateLLMRef(const fmatvec::SymMat &ref)
references to Cholesky decomposition of dynamic system parent
Definition: object.cc:193
virtual void readz0(H5::GroupBase *group)
reads the z-Vector of a subgroup of the given group
Definition: object.cc:253
fmatvec::Vec h[2]
complete and object smooth and nonsmooth right hand side
Definition: object.h:327
H5::GroupBase * plotGroup
associated plot group
Definition: element.h:272
virtual void updaterdtRef(const fmatvec::Vec &ref)
references to nonsmooth force vector of dynamic system parent
Definition: object.cc:181
virtual void updateduRef(const fmatvec::Vec &duRef)
references to differentiated velocities of dynamic system parent
Definition: object.cc:153
virtual void updateuallRef(const fmatvec::Vec &uallRef)
references to velocities of dynamic system parent
Definition: object.cc:145
virtual void updaterRef(const fmatvec::Vec &ref, int i=0)
references to nonsmooth force vector of dynamic system parent
Definition: object.cc:177
virtual void updateqdRef(const fmatvec::Vec &qdRef)
references to differentiated positions of dynamic system parent
Definition: object.cc:133
fmatvec::SymMat M
mass matrix
Definition: object.h:346
fmatvec::Vec qd
differentiated positions, velocities
Definition: object.h:322
class for all objects having own dynamics and mass
Definition: object.h:43
fmatvec::Vec q0
initial position, velocity
Definition: object.h:317
virtual void setUpInverseKinetics()
TODO.
Definition: object.h:225
virtual double evalPotentialEnergy()
Definition: object.h:220