19 #ifndef _DYNAMIC_SYSTEM_H_
20 #define _DYNAMIC_SYSTEM_H_
22 #include "mbsim/element.h"
23 #include "mbsim/mbsim_event.h"
31 class FixedRelativeFrame;
37 class ModellingInterface;
71 virtual void updateT();
72 virtual void updateh(
int k=0);
73 virtual void updateM();
74 virtual void updateLLM();
75 virtual void updatedq();
76 virtual void updatedu();
77 virtual void updatedx();
78 virtual void updatezd();
79 virtual void updatewb();
80 virtual void updateW(
int j=0);
81 virtual void updateV(
int j=0);
82 virtual void updater(
int j=0);
83 virtual void updateJrla(
int j=0);
84 virtual void updateg();
85 virtual void updategd();
86 virtual void updateStopVector();
87 virtual void updateStopVectorParameters();
88 virtual void updateLinkStatus();
89 virtual void updateLinkStatusReg();
90 virtual void updateWInverseKinetics();
91 virtual void updatebInverseKinetics();
92 virtual void sethSize(
int hSize_,
int j=0);
93 virtual int gethSize(
int i=0)
const {
return hSize[i]; }
94 virtual int getqSize()
const {
return qSize; }
95 virtual int getuSize(
int i=0)
const {
return uSize[i]; }
96 virtual void calcqSize();
97 virtual void calcuSize(
int j=0);
98 virtual int getuInd(
int i=0) {
return uInd[i]; }
99 virtual void setqInd(
int qInd_);
100 virtual void setuInd(
int uInd_,
int j=0);
101 virtual void sethInd(
int hInd_,
int j=0);
102 virtual void setxInd(
int xInd_);
103 virtual const fmatvec::Vec& getq()
const {
return q; };
104 virtual fmatvec::Vec& getq() {
return q; };
105 virtual const fmatvec::Vec& getu()
const {
return u; };
106 virtual fmatvec::Vec& getu() {
return u; };
107 void setq(
const fmatvec::Vec& q_) {
q = q_; }
108 void setu(
const fmatvec::Vec& u_) {
u = u_; }
109 void setx(
const fmatvec::Vec& x_) {
x = x_; }
110 void setjsv(
const fmatvec::VecInt& jsv_) {
jsv = jsv_; }
111 void setInternalState(
const fmatvec::Vec& internalState) { curis = internalState; nextis = internalState; }
113 std::shared_ptr<OpenMBV::Group> getOpenMBVGrp()
override {
return openMBVGrp; }
114 std::shared_ptr<OpenMBV::Group> getFramesOpenMBVGrp()
override {
return framesOpenMBVGrp; }
115 std::shared_ptr<OpenMBV::Group> getContoursOpenMBVGrp()
override {
return contoursOpenMBVGrp; }
116 std::shared_ptr<OpenMBV::Group> getGroupsOpenMBVGrp()
override {
return groupsOpenMBVGrp; }
117 std::shared_ptr<OpenMBV::Group> getObjectsOpenMBVGrp()
override {
return objectsOpenMBVGrp; }
118 std::shared_ptr<OpenMBV::Group> getLinksOpenMBVGrp()
override {
return linksOpenMBVGrp; }
119 std::shared_ptr<OpenMBV::Group> getConstraintsOpenMBVGrp()
override {
return constraintsOpenMBVGrp; }
120 std::shared_ptr<OpenMBV::Group> getObserversOpenMBVGrp()
override {
return observersOpenMBVGrp; }
122 virtual void calcxSize();
123 const fmatvec::Vec& getx()
const {
return x; };
124 fmatvec::Vec& getx() {
return x; };
125 int getxSize()
const {
return xSize; }
126 void updatexRef(fmatvec::Vec &xParent);
127 void updatexdRef(fmatvec::Vec &xdParent);
128 void updatedxRef(fmatvec::Vec &dxParent);
129 void init(
InitStage stage,
const InitConfigSet &config)
override;
130 virtual void initz();
138 void plot()
override;
211 virtual Frame*
getFrame(
const std::string &name,
bool check=
true)
const;
223 const Frame* getFrameOfReference()
const {
return R; };
225 const fmatvec::Mat& getT(
bool check=
true)
const;
226 const fmatvec::Vec& geth(
int i=0,
bool check=
true)
const;
227 const fmatvec::SymMat& getM(
bool check=
true)
const;
228 const fmatvec::SymMat& getLLM(
bool check=
true)
const;
229 const fmatvec::Vec& getdq(
bool check=
true)
const;
230 const fmatvec::Vec& getdu(
bool check=
true)
const;
231 const fmatvec::Vec& getdx(
bool check=
true)
const;
232 const fmatvec::Mat& getW(
int i=0,
bool check=
true)
const;
233 const fmatvec::Mat& getV(
int i=0,
bool check=
true)
const;
234 const fmatvec::Vec& getla(
bool check=
true)
const;
235 const fmatvec::Vec& getLa(
bool check=
true)
const;
236 const fmatvec::Vec& getg(
bool check=
true)
const;
237 const fmatvec::Vec& getgd(
bool check=
true)
const;
238 fmatvec::Vec& getla(
bool check=
true);
239 fmatvec::Vec& getLa(
bool check=
true);
240 void setla(
const fmatvec::Vec &la_) {
la = la_; }
241 void setLa(
const fmatvec::Vec &La_) { La = La_; }
242 fmatvec::VecInt& getjsv() {
return jsv; }
243 const fmatvec::VecInt& getjsv()
const {
return jsv; }
244 fmatvec::Mat& getW(
int i=0,
bool check=
true);
245 fmatvec::SymMat& getLLM(
bool check=
true);
246 fmatvec::Vec& getdq(
bool check=
true);
247 fmatvec::Vec& getdu(
bool check=
true);
248 fmatvec::Vec& getdx(
bool check=
true);
250 fmatvec::VecInt& getLinkStatus() {
return LinkStatus; }
251 fmatvec::VecInt& getLinkStatusReg() {
return LinkStatusReg; }
252 const fmatvec::VecInt& getLinkStatus()
const {
return LinkStatus; }
253 const fmatvec::VecInt& getLinkStatusReg()
const {
return LinkStatusReg; }
255 const fmatvec::Mat& evalT();
256 const fmatvec::Vec& evalh(
int i=0);
257 const fmatvec::SymMat& evalM();
258 const fmatvec::SymMat& evalLLM();
259 const fmatvec::Mat& evalW(
int i=0);
260 const fmatvec::Mat& evalV(
int i=0);
261 const fmatvec::Vec& evalwb();
262 const fmatvec::Vec& evalr(
int i=0);
263 const fmatvec::Mat& evalJrla(
int i=0);
264 const fmatvec::Vec& evalrdt();
265 const fmatvec::Vec& evalg();
266 const fmatvec::Vec& evalgd();
267 const fmatvec::Mat& evalWInverseKinetics();
268 const fmatvec::Mat& evalbInverseKinetics();
270 void setqd(
const fmatvec::Vec& qd_) { qd = qd_; }
271 void setud(
const fmatvec::Vec& ud_) { ud = ud_; }
272 void setxd(
const fmatvec::Vec& xd_) { xd = xd_; }
274 int getxInd() {
return xInd; }
275 int getlaInd()
const {
return laInd; }
277 int gethInd(
int i=0) {
return hInd[i]; }
278 void setlaInd(
int ind) { laInd = ind; }
279 void setisInd(
int ind) { isInd = ind; }
280 void setgInd(
int ind) { gInd = ind; }
281 void setgdInd(
int ind) { gdInd = ind; }
282 void setrFactorInd(
int ind) { rFactorInd = ind; }
283 virtual void setsvInd(
int svInd_);
284 void setLinkStatusInd(
int LinkStatusInd_) {LinkStatusInd = LinkStatusInd_;};
285 void setLinkStatusRegInd(
int LinkStatusRegInd_) {LinkStatusRegInd = LinkStatusRegInd_;};
287 void setqSize(
int qSize_) {
qSize = qSize_; }
288 void setuSize(
int uSize_,
int i=0) {
uSize[i] = uSize_; }
289 void setxSize(
int xSize_) {
xSize = xSize_; }
291 int getisSize()
const {
return isSize; }
292 int getlaSize()
const {
return laSize; }
293 int getgSize()
const {
return gSize; }
294 int getgdSize()
const {
return gdSize; }
296 int getsvSize()
const {
return svSize; }
301 const std::vector<Object*>& getObjects()
const {
return object; }
302 const std::vector<Link*>& getLinks()
const {
return link; }
303 const std::vector<DynamicSystem*>& getDynamicSystems()
const {
return dynamicsystem; }
304 const std::vector<Frame*>& getFrames()
const {
return frame; }
305 const std::vector<Contour*>& getContours()
const {
return contour; }
306 const std::vector<Link*>& getSetValuedLinks()
const {
return linkSetValued; }
320 void updatedqRef(fmatvec::Vec &dqParent);
340 void updateduRef(fmatvec::Vec &duParent);
355 void updatehRef(fmatvec::Vec &hParent,
int j=0);
361 void updaterRef(fmatvec::Vec &rParent,
int j=0);
363 void updateJrlaRef(fmatvec::Mat &rParent,
int j=0);
400 virtual void updategRef(fmatvec::Vec &gParent);
420 void updatelaInverseKineticsRef(fmatvec::Vec &laParent);
421 void updatebInverseKineticsRef(fmatvec::Mat &bParent);
434 virtual void updateWRef(fmatvec::Mat &WParent,
int j=0);
448 virtual void updateVRef(fmatvec::Mat &VParent,
int j=0);
486 void clearElementLists();
606 virtual void postprocessing();
744 Observer* getObserver(
const std::string &name,
bool check=
true)
const;
752 Link*
getLink(
const std::string &name,
bool check=
true)
const;
778 virtual void updatecorr(
int j);
779 void updatecorrRef(fmatvec::Vec &ref);
780 void calccorrSize(
int j);
784 void resetUpToDate()
override;
786 void updateStateTable();
788 H5::GroupBase *getFramesPlotGroup()
override {
return framesPlotGroup; }
789 H5::GroupBase *getContoursPlotGroup()
override {
return contoursPlotGroup; }
790 H5::GroupBase *getGroupsPlotGroup()
override {
return groupsPlotGroup; }
791 H5::GroupBase *getObjectsPlotGroup()
override {
return objectsPlotGroup; }
792 H5::GroupBase *getLinksPlotGroup()
override {
return linksPlotGroup; }
793 H5::GroupBase *getConstraintsPlotGroup()
override {
return constraintsPlotGroup; }
794 H5::GroupBase *getObserversPlotGroup()
override {
return observersPlotGroup; }
797 friend class DynamicSystemSolver;
798 void addFrame(Frame *frame_);
799 void addContour(Contour *contour_);
811 std::vector<Object*> objectWithNonConstantMassMatrix;
812 std::vector<Link*> link;
813 std::vector<Link*> linkSingleValued;
814 std::vector<Link*> linkSetValued;
815 std::vector<Link*> linkSetValuedActive;
816 std::vector<Link*> linkWithStopVector;
817 std::vector<ModellingInterface*> model;
818 std::vector<DynamicSystem*> dynamicsystem;
819 std::vector<Link*> inverseKineticsLink;
820 std::vector<Observer*> observer;
821 std::vector<Constraint*> constraint;
841 fmatvec::Vec
q, qd, dq;
846 fmatvec::Vec
u, ud, du;
851 fmatvec::Vec
x, xd, dx;
856 fmatvec::Vec
h[2], r[2], rdt;
866 fmatvec::Mat W[2], V[2];
873 fmatvec::Vec curis, nextis;
976 std::vector<Contour*> contour;
978 std::shared_ptr<OpenMBV::Group> openMBVGrp;
979 std::shared_ptr<OpenMBV::Group> framesOpenMBVGrp;
980 std::shared_ptr<OpenMBV::Group> contoursOpenMBVGrp;
981 std::shared_ptr<OpenMBV::Group> groupsOpenMBVGrp;
982 std::shared_ptr<OpenMBV::Group> objectsOpenMBVGrp;
983 std::shared_ptr<OpenMBV::Group> linksOpenMBVGrp;
984 std::shared_ptr<OpenMBV::Group> constraintsOpenMBVGrp;
985 std::shared_ptr<OpenMBV::Group> observersOpenMBVGrp;
986 std::shared_ptr<H5::File> hdf5File;
996 fmatvec::Mat WInverseKinetics, bInverseKinetics;
997 fmatvec::Vec laInverseKinetics;
999 int corrSize, corrInd;
1002 std::string saved_frameOfReference;
int rFactorSize
size and local start index of rfactors relative to parent
Definition: dynamic_system.h:955
void addConstraint(Constraint *crt)
Definition: dynamic_system.cc:1470
void setDynamicSystemSolver(DynamicSystemSolver *sys) override
Definition: dynamic_system.cc:317
bool gActiveChangedReg()
Definition: dynamic_system.cc:1095
virtual void setGeneralizedRelativeAccelerationTolerance(double tol)
Definition: dynamic_system.cc:1350
void updateLaRef(fmatvec::Vec &LaParent)
references to contact impulses of dynamic system parent
Definition: dynamic_system.cc:815
fmatvec::Vec q
positions, differentiated positions, initial positions
Definition: dynamic_system.h:841
virtual int jacobianConstraints()
compute JACOBIAN of contact equations
Definition: dynamic_system.cc:524
basic class for rigid contours
Definition: rigid_contour.h:37
int laInverseKineticsSize
size of contact force parameters of special links relative to parent
Definition: dynamic_system.h:994
Link * getLink(const std::string &name, bool check=true) const
Definition: dynamic_system.cc:1487
general link to one or more objects
Definition: link.h:48
int laSize
size and local start index of contact force parameters relative to parent
Definition: dynamic_system.h:950
solver interface for modelling and simulation of dynamic systems
Definition: dynamic_system_solver.h:61
virtual void updateVRef(fmatvec::Mat &VParent, int j=0)
references to condensed contact force direction matrix of dynamic system parent
Definition: dynamic_system.cc:857
void updateWInverseKineticsRef(fmatvec::Mat &WParent)
references to contact force direction matrix of dynamic system parent
Definition: dynamic_system.cc:843
void setUpObjectsWithNonConstantMassMatrix()
rearrange vector of active setvalued links
Definition: dynamic_system.cc:1312
virtual int solveImpactsRootFinding()
solve impact equations with Newton scheme on velocity level
Definition: dynamic_system.cc:516
Frame * getFrameI()
Definition: dynamic_system.h:774
void buildListOfObjects(std::vector< Object * > &obj)
build flat list of objects
Definition: dynamic_system.cc:981
fmatvec::SymMat LLM
Cholesky decomposition of mass matrix.
Definition: dynamic_system.h:836
void updateuRef(fmatvec::Vec &uParent)
references to velocities of dynamic system parent
Definition: dynamic_system.cc:616
void buildListOfContours(std::vector< Contour * > &cnt)
build flat list of contours
Definition: dynamic_system.cc:1017
fmatvec::Mat T
linear relation matrix of position and velocity parameters
Definition: dynamic_system.h:826
int frameIndex(const Frame *frame_) const
Definition: dynamic_system.cc:1422
void updateLinkStatusRegRef(fmatvec::VecInt &LinkStatusRegParent)
references to status vector of single valued links
Definition: dynamic_system.cc:908
fmatvec::VecInt LinkStatus
status of set-valued links
Definition: dynamic_system.h:908
void setUpLinks()
distribute links to set- and single valued container
Definition: dynamic_system.cc:1064
fmatvec::Vec u
velocities, differentiated velocities, initial velocities
Definition: dynamic_system.h:846
virtual void updaterFactors()
update relaxation factors for contact equations
Definition: dynamic_system.cc:552
int uSize[2]
size and local start index of velocities relative to parent
Definition: dynamic_system.h:923
fmatvec::Vec x
order one parameters, differentiated order one parameters, initial order one parameters ...
Definition: dynamic_system.h:851
cartesian frame on rigid bodies
Definition: fixed_relative_frame.h:31
virtual void checkImpactsForTermination()
validate force laws concerning given tolerances on velocity level
Definition: dynamic_system.cc:546
bool detectImpact()
Definition: dynamic_system.cc:1105
virtual void updatewbRef(fmatvec::Vec &wbParent)
references to TODO of dynamic system parent
Definition: dynamic_system.cc:829
virtual void setGeneralizedForceTolerance(double tol)
Definition: dynamic_system.cc:1357
virtual int solveConstraintsRootFinding()
solve contact equations with Newton scheme
Definition: dynamic_system.cc:508
void init(InitStage stage, const InitConfigSet &config) override
plots time series header
Definition: dynamic_system.cc:382
void buildListOfInverseKineticsLinks(std::vector< Link * > &iklnk)
build flat list of inverse kinetics links
Definition: dynamic_system.cc:1035
void updateresRef(fmatvec::Vec &resParent)
references to residuum of contact equations of dynamic system parent
Definition: dynamic_system.cc:884
virtual void setGeneralizedRelativePositionCorrectionValue(double corr)
Definition: dynamic_system.cc:1371
int LinkStatusSize
size and local start index of set-valued link status vector relative to parent
Definition: dynamic_system.h:965
Element * getChildByContainerAndName(const std::string &container, const std::string &name) const override
Get the Element named name in the container named container.
Definition: dynamic_system.cc:1562
basic class for contour definition for rigid (which do not know about their shape) and flexible (they...
Definition: contour.h:40
basic class of MBSim mainly for plotting
Definition: element.h:56
void updaterFactorRef(fmatvec::Vec &rFactorParent)
references to relaxation factors for contact equations of dynamic system parent
Definition: dynamic_system.cc:891
void addObject(Object *obj)
Definition: dynamic_system.cc:1551
int gSize
size and local start index of relative distances relative to parent
Definition: dynamic_system.h:940
void addInverseKineticsLink(Link *lnk)
Definition: dynamic_system.cc:1482
virtual Contour * getContour(const std::string &name, bool check=true) const
Definition: dynamic_system.cc:572
virtual void updateInternalStateRef(fmatvec::Vec &curisParent, fmatvec::Vec &nextisParent)
references to internal state of dynamic system parent
Definition: dynamic_system.cc:777
void buildListOfConstraints(std::vector< Constraint * > &crt)
build flat list of all constraints
Definition: dynamic_system.cc:999
int gdSize
size and local start index of relative velocities relative to parent
Definition: dynamic_system.h:945
virtual void updateWRef(fmatvec::Mat &WParent, int j=0)
references to contact force direction matrix of dynamic system parent
Definition: dynamic_system.cc:836
void plotAtSpecialEvent() override
plots time dependent data at special events
Definition: dynamic_system.cc:363
fmatvec::Vec h[2]
smooth, smooth with respect to objects, smooth with respect to links and nonsmooth ...
Definition: dynamic_system.h:856
void calcrFactorSize(int j)
calculates size of relaxation factors for contact equations
Definition: dynamic_system.cc:1302
void calcbInverseKineticsSize()
calculates size of contact force parameters
Definition: dynamic_system.cc:1216
virtual void setGeneralizedImpulseTolerance(double tol)
Definition: dynamic_system.cc:1364
std::vector< Frame * > frame
vector of frames and contours
Definition: dynamic_system.h:975
void updaterRef(fmatvec::Vec &rParent, int j=0)
references to nonsmooth right hand side of dynamic system parent
Definition: dynamic_system.cc:714
fmatvec::Vec res
residuum of nonlinear contact equations for Newton scheme
Definition: dynamic_system.h:888
void updatelaRef(fmatvec::Vec &laParent)
references to contact forces of dynamic system parent
Definition: dynamic_system.cc:808
void updateLLMRef(fmatvec::SymMat &LLMParent)
references to Cholesky decomposition of dynamic system parent
Definition: dynamic_system.cc:767
virtual void setGeneralizedRelativePositionTolerance(double tol)
Definition: dynamic_system.cc:1336
void buildListOfFrames(std::vector< Frame * > &frm)
build flat list of frames
Definition: dynamic_system.cc:1008
dynamic system as topmost hierarchical level
Definition: dynamic_system.h:58
void buildListOfObservers(std::vector< Observer * > &obsrv)
build flat list of observers
Definition: dynamic_system.cc:1044
Frame * I
Definition: dynamic_system.h:989
Frame * R
parent frame
Definition: dynamic_system.h:805
void calclaInverseKineticsSize()
calculates size of contact force parameters
Definition: dynamic_system.cc:1206
void calcLinkStatusSize()
calculates size of set-valued link status vector
Definition: dynamic_system.cc:1153
virtual int solveImpactsGaussSeidel()
solve impact equations with Gauss-Seidel scheme on velocity level
Definition: dynamic_system.cc:500
Constraint * getConstraint(const std::string &name, bool check=true) const
Definition: dynamic_system.cc:1501
void plot() override
plots time dependent data
Definition: dynamic_system.cc:344
fmatvec::VecInt LinkStatusReg
status of single-valued links
Definition: dynamic_system.h:913
void checkActive(int j)
check if set-valued contacts are active and set corresponding attributes
Definition: dynamic_system.cc:1330
InitStage
The stages of the initialization.
Definition: element.h:62
void updatejsvRef(fmatvec::VecInt &jsvParent)
references to boolean evaluation of stopvector concerning roots of dynamic system parent ...
Definition: dynamic_system.cc:874
int qSize
size and local start index of positions relative to parent
Definition: dynamic_system.h:918
virtual int solveConstraintsGaussSeidel()
solve contact equations with Gauss-Seidel scheme
Definition: dynamic_system.cc:492
DynamicSystem(const std::string &name)
constructor
Definition: dynamic_system.cc:45
void setUpActiveLinks()
rearrange vector of active setvalued links
Definition: dynamic_system.cc:1320
void addModel(ModellingInterface *model_)
Definition: dynamic_system.cc:1515
void buildListOfModels(std::vector< ModellingInterface * > &modelList)
build flat list of models
Definition: dynamic_system.cc:1026
void buildListOfLinks(std::vector< Link * > &lnk)
build flat list of links
Definition: dynamic_system.cc:990
Object * getObject(const std::string &name, bool check=true) const
Definition: dynamic_system.cc:1444
void updateuallRef(fmatvec::Vec &uParent)
references to velocities of dynamic system parent
Definition: dynamic_system.cc:626
void setrMax(double rMax)
Definition: dynamic_system.cc:1385
std::string name
name of element
Definition: element.h:260
void updateqdRef(fmatvec::Vec &qdParent)
references to differentiated positions of dynamic system parent
Definition: dynamic_system.cc:596
void updatehRef(fmatvec::Vec &hParent, int j=0)
references to smooth right hand side of dynamic system parent
Definition: dynamic_system.cc:701
void updatesvRef(fmatvec::Vec &svParent)
references to stopvector (rootfunction for event driven integrator) of dynamic system parent ...
Definition: dynamic_system.cc:864
int LinkStatusRegSize
size and local start index of single-valued link status vector relative to parent ...
Definition: dynamic_system.h:970
DynamicSystem * getGroup(const std::string &name, bool check=true) const
Definition: dynamic_system.cc:1430
void calcgdSize(int j)
calculates size of gap velocities
Definition: dynamic_system.cc:1292
ModellingInterface * getModel(const std::string &name, bool check=true) const
Definition: dynamic_system.cc:1526
fmatvec::Vec wb
TODO.
Definition: dynamic_system.h:883
Class for constraints between generalized coordinates of objects.
Definition: constraint.h:30
virtual void checkConstraintsForTermination()
validate force laws concerning given tolerances
Definition: dynamic_system.cc:540
int svSize
size and local start index of stop vector relative to parent
Definition: dynamic_system.h:960
cartesian frame on bodies used for application of e.g. links and loads
Definition: frame.h:39
Interface for models of arbitrary domains, e.g. electrical components.
Definition: modelling_interface.h:35
fmatvec::Vec rFactor
rfactors for relaxation nonlinear contact equations
Definition: dynamic_system.h:893
void calcgSize(int j)
calculates size of relative distances
Definition: dynamic_system.cc:1282
fmatvec::Vec sv
stop vector (root functions for event driven integration
Definition: dynamic_system.h:898
void updateudRef(fmatvec::Vec &udParent)
references to differentiated velocities of dynamic system parent
Definition: dynamic_system.cc:634
virtual int solveImpactsFixpointSingle()
solve impact equations with single step fixed point scheme on velocity level
Definition: dynamic_system.cc:484
void updateTRef(fmatvec::Mat &TParent)
references to linear transformation matrix between differentiated positions and velocities of dynamic...
Definition: dynamic_system.cc:747
fmatvec::Vec g
relative distances and velocities
Definition: dynamic_system.h:878
void calcLinkStatusRegSize()
calculates size of single-valued link status vector
Definition: dynamic_system.cc:1168
bool gActiveChanged()
Definition: dynamic_system.cc:1085
virtual void setGeneralizedRelativeVelocityCorrectionValue(double corr)
Definition: dynamic_system.cc:1378
void updateqRef(fmatvec::Vec &qParent)
references to positions of dynamic system parent
Definition: dynamic_system.cc:586
virtual void updategRef(fmatvec::Vec &gParent)
references to relative distances of dynamic system parent
Definition: dynamic_system.cc:794
H5::GroupBase * plotGroup
associated plot group
Definition: element.h:297
void calcsvSize()
calculates size of stop vector
Definition: dynamic_system.cc:1183
virtual void setGeneralizedRelativeVelocityTolerance(double tol)
Definition: dynamic_system.cc:1343
~DynamicSystem() override
destructor
Definition: dynamic_system.cc:61
std::vector< Object * > object
container for possible ingredients
Definition: dynamic_system.h:810
fmatvec::Vec la
contact force parameters
Definition: dynamic_system.h:871
void updateLinkStatusRef(fmatvec::VecInt &LinkStatusParent)
references to status vector of set valued links with piecewise link equations (which piece is valid) ...
Definition: dynamic_system.cc:898
Definition: observer.h:26
void updateMRef(fmatvec::SymMat &MParent)
references to mass matrix of dynamic system parent
Definition: dynamic_system.cc:757
void setUpInverseKinetics()
analyse constraints of dynamic systems for usage in inverse kinetics
Definition: dynamic_system.cc:1053
int hSize[2]
size and local start index of order smooth right hand side relative to parent
Definition: dynamic_system.h:933
void updaterdtRef(fmatvec::Vec &rdtParent)
references to nonsmooth right hand side of dynamic system parent
Definition: dynamic_system.cc:737
virtual Frame * getFrame(const std::string &name, bool check=true) const
Definition: dynamic_system.cc:558
int xSize
size and local start index of order one parameters relative to parent
Definition: dynamic_system.h:928
void calclaSize(int j)
calculates size of contact force parameters
Definition: dynamic_system.cc:1196
fmatvec::VecInt jsv
boolean evaluation of stop vector concerning roots
Definition: dynamic_system.h:903
virtual int solveConstraintsFixpointSingle()
solve contact equations with single step fixed point scheme
Definition: dynamic_system.cc:476
virtual int jacobianImpacts()
compute JACOBIAN of contact equations on velocity level
Definition: dynamic_system.cc:532
void addLink(Link *lnk)
Definition: dynamic_system.cc:1458
virtual void aboutToUpdateInternalState()
Definition: dynamic_system.cc:1254
fmatvec::SymMat M
mass matrix
Definition: dynamic_system.h:831
fmatvec::Mat Jrla[2]
Jacobian dr/dla.
Definition: dynamic_system.h:861
void buildListOfDynamicSystems(std::vector< DynamicSystem * > &sys)
build flat list of dynamic systems
Definition: dynamic_system.cc:972
void updateudallRef(fmatvec::Vec &udParent)
references to velocities of dynamic system parent
Definition: dynamic_system.cc:654
void addGroup(DynamicSystem *sys)
Definition: dynamic_system.cc:1540
virtual void updategdRef(fmatvec::Vec &gdParent)
references to relative velocities of dynamic system parent
Definition: dynamic_system.cc:801
class for all objects having own dynamics and mass
Definition: object.h:42