mbsim  4.0.0
MBSim Kernel
dynamic_system.h
1 /* Copyright (C) 2004-2014 MBSim Development Team
2  * This library is free software; you can redistribute it and/or
3  * modify it under the terms of the GNU Lesser General Public
4  * License as published by the Free Software Foundation; either
5  * version 2.1 of the License, or (at your option) any later version.
6  *
7  * This library is distributed in the hope that it will be useful,
8  * but WITHOUT ANY WARRANTY; without even the implied warranty of
9  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
10  * Lesser General Public License for more details.
11  *
12  * You should have received a copy of the GNU Lesser General Public
13  * License along with this library; if not, write to the Free Software
14  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
15  *
16  * Contact: martin.o.foerg@googlemail.com
17  */
18 
19 #ifndef _DYNAMIC_SYSTEM_H_
20 #define _DYNAMIC_SYSTEM_H_
21 
22 #include "mbsim/element.h"
23 #include "mbsim/mbsim_event.h"
24 
25 namespace H5 {
26  class Group;
27 }
28 
29 namespace MBSim {
30  class Frame;
31  class FixedRelativeFrame;
32  class Contour;
33  class RigidContour;
34  class Object;
35  class Link;
36  class Constraint;
37  class ModellingInterface;
38  class Contact;
39  class Observer;
40 
58  class DynamicSystem : public Element {
59  public:
63  DynamicSystem(const std::string &name);
64 
68  ~DynamicSystem() override;
69 
70  /* INTERFACE FOR DERIVED CLASSES */
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 updateg();
83  virtual void updategd();
84  virtual void updateStopVector();
85  virtual void updateStopVectorParameters();
86  virtual void updateLinkStatus();
87  virtual void updateLinkStatusReg();
88  virtual void updateWInverseKinetics();
89  virtual void updatebInverseKinetics();
90  virtual void sethSize(int hSize_, int j=0);
91  virtual int gethSize(int i=0) const { return hSize[i]; }
92  virtual int getqSize() const { return qSize; }
93  virtual int getuSize(int i=0) const { return uSize[i]; }
94  virtual void calcqSize();
95  virtual void calcuSize(int j=0);
96  virtual int getuInd(int i=0) { return uInd[i]; }
97  virtual void setqInd(int qInd_);
98  virtual void setuInd(int uInd_, int j=0);
99  virtual void sethInd(int hInd_, int j=0);
100  virtual void setxInd(int xInd_);
101  virtual const fmatvec::Vec& getq() const { return q; };
102  virtual fmatvec::Vec& getq() { return q; };
103  virtual const fmatvec::Vec& getu() const { return u; };
104  virtual fmatvec::Vec& getu() { return u; };
105  void setq(const fmatvec::Vec& q_) { q = q_;}
106  void setu(const fmatvec::Vec& u_) { u = u_;}
107  void setx(const fmatvec::Vec& x_) { x = x_; }
108  void setjsv(const fmatvec::VecInt& jsv_) { jsv = jsv_;}
109  void setcuris(const fmatvec::Vec& curis_) { curis = curis_;}
110  virtual H5::GroupBase *getPlotGroup() { return plotGroup; }
111  std::shared_ptr<OpenMBV::Group> getOpenMBVGrp() override { return openMBVGrp; }
112  std::shared_ptr<OpenMBV::Group> getFramesOpenMBVGrp() override { return framesOpenMBVGrp; }
113  std::shared_ptr<OpenMBV::Group> getContoursOpenMBVGrp() override { return contoursOpenMBVGrp; }
114  std::shared_ptr<OpenMBV::Group> getGroupsOpenMBVGrp() override { return groupsOpenMBVGrp; }
115  std::shared_ptr<OpenMBV::Group> getObjectsOpenMBVGrp() override { return objectsOpenMBVGrp; }
116  std::shared_ptr<OpenMBV::Group> getLinksOpenMBVGrp() override { return linksOpenMBVGrp; }
117  std::shared_ptr<OpenMBV::Group> getConstraintsOpenMBVGrp() override { return constraintsOpenMBVGrp; }
118  std::shared_ptr<OpenMBV::Group> getObserversOpenMBVGrp() override { return observersOpenMBVGrp; }
119 
120  virtual void calcxSize();
121  const fmatvec::Vec& getx() const { return x; };
122  fmatvec::Vec& getx() { return x; };
123  int getxSize() const { return xSize; }
124  void updatexRef(fmatvec::Vec &xParent);
125  void updatexdRef(fmatvec::Vec &xdParent);
126  void updatedxRef(fmatvec::Vec &dxParent);
127  void init(InitStage stage, const InitConfigSet &config) override;
128  virtual void initz();
129  virtual void writez(H5::GroupBase *parent);
130  virtual void readz0(H5::GroupBase *parent);
131  /*****************************************************/
132 
133  /* INHERITED INTERFACE OF ELEMENT */
135  void setDynamicSystemSolver(DynamicSystemSolver* sys) override;
136  void plot() override;
137  void plotAtSpecialEvent() override;
138  /*****************************************************/
139 
144  virtual int solveConstraintsFixpointSingle();
145 
151  virtual int solveImpactsFixpointSingle();
152 
157  virtual int solveConstraintsGaussSeidel();
158 
164  virtual int solveImpactsGaussSeidel();
165 
170  virtual int solveConstraintsRootFinding();
171 
177  virtual int solveImpactsRootFinding();
178 
182  virtual int jacobianConstraints();
183 
187  virtual int jacobianImpacts();
188 
192  virtual void checkConstraintsForTermination();
193 
197  virtual void checkImpactsForTermination();
198 
202  virtual void updaterFactors();
203 
209  virtual Frame* getFrame(const std::string &name, bool check=true) const;
210 
216  virtual Contour* getContour(const std::string &name, bool check=true) const;
217  /*****************************************************/
218 
219  /* GETTER / SETTER */
220  void setFrameOfReference(Frame *frame) { R = frame; };
221  const Frame* getFrameOfReference() const { return R; };
222 
223  const fmatvec::Mat& getT(bool check=true) const;
224  const fmatvec::Vec& geth(int i=0, bool check=true) const;
225  const fmatvec::SymMat& getM(bool check=true) const;
226  const fmatvec::SymMat& getLLM(bool check=true) const;
227  const fmatvec::Vec& getdq(bool check=true) const;
228  const fmatvec::Vec& getdu(bool check=true) const;
229  const fmatvec::Vec& getdx(bool check=true) const;
230  const fmatvec::Mat& getW(int i=0, bool check=true) const;
231  const fmatvec::Mat& getV(int i=0, bool check=true) const;
232  const fmatvec::Vec& getla(bool check=true) const;
233  const fmatvec::Vec& getLa(bool check=true) const;
234  const fmatvec::Vec& getg(bool check=true) const;
235  const fmatvec::Vec& getgd(bool check=true) const;
236  fmatvec::Vec& getla(bool check=true);
237  fmatvec::Vec& getLa(bool check=true);
238  void setla(const fmatvec::Vec &la_) { la = la_; }
239  void setLa(const fmatvec::Vec &La_) { La = La_; }
240  fmatvec::VecInt& getjsv() { return jsv; }
241  const fmatvec::VecInt& getjsv() const { return jsv; }
242  fmatvec::Mat& getW(int i=0, bool check=true);
243  fmatvec::SymMat& getLLM(bool check=true);
244  fmatvec::Vec& getdq(bool check=true);
245  fmatvec::Vec& getdu(bool check=true);
246  fmatvec::Vec& getdx(bool check=true);
247 
248  fmatvec::VecInt& getLinkStatus() { return LinkStatus; }
249  fmatvec::VecInt& getLinkStatusReg() { return LinkStatusReg; }
250  const fmatvec::VecInt& getLinkStatus() const { return LinkStatus; }
251  const fmatvec::VecInt& getLinkStatusReg() const { return LinkStatusReg; }
252 
253  const fmatvec::Mat& evalT();
254  const fmatvec::Vec& evalh(int i=0);
255  const fmatvec::SymMat& evalM();
256  const fmatvec::SymMat& evalLLM();
257  const fmatvec::Mat& evalW(int i=0);
258  const fmatvec::Mat& evalV(int i=0);
259  const fmatvec::Vec& evalwb();
260  const fmatvec::Vec& evalr(int i=0);
261  const fmatvec::Vec& evalrdt();
262  const fmatvec::Vec& evalg();
263  const fmatvec::Vec& evalgd();
264  const fmatvec::Mat& evalWInverseKinetics();
265  const fmatvec::Mat& evalbInverseKinetics();
266 
267  void setqd(const fmatvec::Vec& qd_) { qd = qd_; }
268  void setud(const fmatvec::Vec& ud_) { ud = ud_; }
269  void setxd(const fmatvec::Vec& xd_) { xd = xd_; }
270 
271  int getxInd() { return xInd; }
272  int getlaInd() const { return laInd; }
273 
274  int gethInd(int i=0) { return hInd[i]; }
275  void setlaInd(int ind) { laInd = ind; }
276  void setisInd(int ind) { isInd = ind; }
277  void setgInd(int ind) { gInd = ind; }
278  void setgdInd(int ind) { gdInd = ind; }
279  void setrFactorInd(int ind) { rFactorInd = ind; }
280  virtual void setsvInd(int svInd_);
281  void setLinkStatusInd(int LinkStatusInd_) {LinkStatusInd = LinkStatusInd_;};
282  void setLinkStatusRegInd(int LinkStatusRegInd_) {LinkStatusRegInd = LinkStatusRegInd_;};
283 
284  void setqSize(int qSize_) { qSize = qSize_; }
285  void setuSize(int uSize_, int i=0) { uSize[i] = uSize_; }
286  void setxSize(int xSize_) { xSize = xSize_; }
287 
288  int getisSize() const { return isSize; }
289  int getlaSize() const { return laSize; }
290  int getgSize() const { return gSize; }
291  int getgdSize() const { return gdSize; }
292  int getrFactorSize() const { return rFactorSize; }
293  int getsvSize() const { return svSize; }
294  int getLinkStatusSize() const { return LinkStatusSize; }
295  int getLinkStatusRegSize() const { return LinkStatusRegSize; }
296  /*****************************************************/
297 
298  const std::vector<Object*>& getObjects() const { return object; }
299  const std::vector<Link*>& getLinks() const { return link; }
300  const std::vector<DynamicSystem*>& getDynamicSystems() const { return dynamicsystem; }
301  const std::vector<Frame*>& getFrames() const { return frame; }
302  const std::vector<Contour*>& getContours() const { return contour; }
303  const std::vector<Link*>& getSetValuedLinks() const { return linkSetValued; }
304 
309  void updateqRef(fmatvec::Vec &qParent);
310 
315  void updateqdRef(fmatvec::Vec &qdParent);
316 
317  void updatedqRef(fmatvec::Vec &dqParent);
318 
323  void updateuRef(fmatvec::Vec &uParent);
324 
329  void updateuallRef(fmatvec::Vec &uParent);
330 
335  void updateudRef(fmatvec::Vec &udParent);
336 
337  void updateduRef(fmatvec::Vec &duParent);
338 
343  void updateudallRef(fmatvec::Vec &udParent);
344 
352  void updatehRef(fmatvec::Vec &hParent, int j=0);
353 
358  void updaterRef(fmatvec::Vec &rParent, int j=0);
359 
364  void updaterdtRef(fmatvec::Vec &rdtParent);
365 
370  void updateTRef(fmatvec::Mat &TParent);
371 
377  void updateMRef(fmatvec::SymMat &MParent);
378 
384  void updateLLMRef(fmatvec::SymMat &LLMParent);
385 
389  virtual void updateInternalStateRef(fmatvec::Vec &curisParent, fmatvec::Vec &nextisParent);
390 
395  virtual void updategRef(fmatvec::Vec &gParent);
396 
401  virtual void updategdRef(fmatvec::Vec &gdParent);
402 
407  void updatelaRef(fmatvec::Vec &laParent);
408 
413  void updateLaRef(fmatvec::Vec &LaParent);
414 
415  void updatelaInverseKineticsRef(fmatvec::Vec &laParent);
416  void updatebInverseKineticsRef(fmatvec::Mat &bParent);
417 
422  virtual void updatewbRef(fmatvec::Vec &wbParent);
423 
429  virtual void updateWRef(fmatvec::Mat &WParent, int j=0);
430 
437 
443  virtual void updateVRef(fmatvec::Mat &VParent, int j=0);
444 
449  void updatesvRef(fmatvec::Vec& svParent);
450 
455  void updatejsvRef(fmatvec::VecInt &jsvParent);
456 
461  void updateLinkStatusRef(fmatvec::VecInt &LinkStatusParent);
462 
467  void updateLinkStatusRegRef(fmatvec::VecInt &LinkStatusRegParent);
468 
473  void updateresRef(fmatvec::Vec &resParent);
474 
479  void updaterFactorRef(fmatvec::Vec &rFactorParent);
480 
481  void clearElementLists();
482 
487  void buildListOfDynamicSystems(std::vector<DynamicSystem*> &sys);
488 
493  void buildListOfObjects(std::vector<Object*> &obj);
494 
499  void buildListOfLinks(std::vector<Link*> &lnk);
500 
505  void buildListOfConstraints(std::vector<Constraint*> &crt);
506 
511  void buildListOfFrames(std::vector<Frame*> &frm);
512 
517  void buildListOfContours(std::vector<Contour*> &cnt);
518 
523  void buildListOfModels(std::vector<ModellingInterface*> &modelList);
524 
529  void buildListOfInverseKineticsLinks(std::vector<Link*> &iklnk);
530 
535  void buildListOfObservers(std::vector<Observer*> &obsrv);
536 
540  void setUpInverseKinetics();
541 
545  void setUpLinks();
546 
550  bool gActiveChanged();
551 
555  bool gActiveChangedReg();
556 
560  bool detectImpact();
561 
565  void calcsvSize();
566 
570  void calclaSize(int j);
571 
575  void calcLinkStatusSize();
576 
580  void calcLinkStatusRegSize();
581 
586 
591 
592  void calcisSize();
593 
597  void calcgSize(int j);
598 
609  void calcgdSize(int j);
610 
614  void calcrFactorSize(int j);
615 
620 
624  void setUpActiveLinks();
625 
640  void checkActive(int j);
641 
645  void checkActiveReg(int j);
646 
650  virtual void setGeneralizedRelativePositionTolerance(double tol);
651 
655  virtual void setGeneralizedRelativeVelocityTolerance(double tol);
656 
660  virtual void setGeneralizedRelativeAccelerationTolerance(double tol);
661 
665  virtual void setGeneralizedForceTolerance(double tol);
666 
670  virtual void setGeneralizedImpulseTolerance(double tol);
671 
674  virtual void setGeneralizedRelativePositionCorrectionValue(double corr);
675 
679  virtual void setGeneralizedRelativeVelocityCorrectionValue(double corr);
680 
684  void setrMax(double rMax);
685 
690  int frameIndex(const Frame *frame_) const;
691 
692  void addFrame(FixedRelativeFrame *frame);
693 
694  void addContour(RigidContour *contour);
695 
699  void addGroup(DynamicSystem *sys);
700 
706  DynamicSystem* getGroup(const std::string &name,bool check=true) const;
707 
711  void addObject(Object *obj);
712 
718  Object* getObject(const std::string &name,bool check=true) const;
719 
723  void addLink(Link *lnk);
724 
728  void addConstraint(Constraint *crt);
729 
733  void addInverseKineticsLink(Link *lnk);
734 
735  Observer* getObserver(const std::string &name,bool check=true) const;
736  void addObserver(Observer *ele);
737 
743  Link* getLink(const std::string &name,bool check=true) const;
744 
750  Constraint* getConstraint(const std::string &name,bool check=true) const;
751 
755  void addModel(ModellingInterface *model_);
756 
762  ModellingInterface* getModel(const std::string &name, bool check=true) const;
763 
765  Frame *getFrameI() { return I; }
766 
767  Element *getChildByContainerAndName(const std::string &container, const std::string &name) const override;
768 
769  virtual void updatecorr(int j);
770  void updatecorrRef(fmatvec::Vec &ref);
771  void calccorrSize(int j);
772 
773  void checkRoot();
774 
775  void resetUpToDate() override;
776 
777  void updateStateTable();
778 
779  H5::GroupBase *getFramesPlotGroup() override { return framesPlotGroup; }
780  H5::GroupBase *getContoursPlotGroup() override { return contoursPlotGroup; }
781  H5::GroupBase *getGroupsPlotGroup() override { return groupsPlotGroup; }
782  H5::GroupBase *getObjectsPlotGroup() override { return objectsPlotGroup; }
783  H5::GroupBase *getLinksPlotGroup() override { return linksPlotGroup; }
784  H5::GroupBase *getConstraintsPlotGroup() override { return constraintsPlotGroup; }
785  H5::GroupBase *getObserversPlotGroup() override { return observersPlotGroup; }
786 
787  private:
788  friend class DynamicSystemSolver;
789  void addFrame(Frame *frame_);
790  void addContour(Contour *contour_);
791 
792  protected:
797 
801  std::vector<Object*> object;
802  std::vector<Object*> objectWithNonConstantMassMatrix;
803  std::vector<Link*> link;
804  std::vector<Link*> linkSingleValued;
805  std::vector<Link*> linkSetValued;
806  std::vector<Link*> linkSetValuedActive;
807  std::vector<ModellingInterface*> model;
808  std::vector<DynamicSystem*> dynamicsystem;
809  std::vector<Link*> inverseKineticsLink;
810  std::vector<Observer*> observer;
811  std::vector<Constraint*> constraint;
812 
817 
822 
827 
831  fmatvec::Vec q, qd, dq;
832 
836  fmatvec::Vec u, ud, du;
837 
841  fmatvec::Vec x, xd, dx;
842 
846  fmatvec::Vec h[2], r[2], rdt;
847 
851  fmatvec::Mat W[2], V[2];
852 
857 
858  fmatvec::Vec curis, nextis;
859 
864 
869 
874 
879 
884 
888  fmatvec::VecInt jsv;
889 
893  fmatvec::VecInt LinkStatus;
894 
898  fmatvec::VecInt LinkStatusReg;
899 
903  int qSize, qInd;
904 
908  int uSize[2], uInd[2];
909 
913  int xSize, xInd;
914 
918  int hSize[2], hInd[2];
919 
920  int isSize, isInd;
921 
925  int gSize, gInd;
926 
930  int gdSize, gdInd;
931 
935  int laSize, laInd;
936 
940  int rFactorSize, rFactorInd;
941 
945  int svSize, svInd;
946 
950  int LinkStatusSize, LinkStatusInd;
951 
955  int LinkStatusRegSize, LinkStatusRegInd;
956 
960  std::vector<Frame*> frame;
961  std::vector<Contour*> contour;
962 
964  std::shared_ptr<OpenMBV::Group> framesOpenMBVGrp;
965  std::shared_ptr<OpenMBV::Group> contoursOpenMBVGrp;
966  std::shared_ptr<OpenMBV::Group> groupsOpenMBVGrp;
967  std::shared_ptr<OpenMBV::Group> objectsOpenMBVGrp;
968  std::shared_ptr<OpenMBV::Group> linksOpenMBVGrp;
969  std::shared_ptr<OpenMBV::Group> constraintsOpenMBVGrp;
970  std::shared_ptr<OpenMBV::Group> observersOpenMBVGrp;
971  std::shared_ptr<H5::File> hdf5File;
972 
975 
979  int laInverseKineticsSize, bInverseKineticsSize;
980 
981  fmatvec::Mat WInverseKinetics, bInverseKinetics;
982  fmatvec::Vec laInverseKinetics;
983 
984  int corrSize, corrInd;
985  fmatvec::Vec corr;
986 
987  std::string saved_frameOfReference;
988 
989  H5::GroupBase *framesPlotGroup;
990  H5::GroupBase *contoursPlotGroup;
991  H5::GroupBase *groupsPlotGroup;
992  H5::GroupBase *objectsPlotGroup;
993  H5::GroupBase *linksPlotGroup;
994  H5::GroupBase *constraintsPlotGroup;
995  H5::GroupBase *observersPlotGroup;
996  };
997 }
998 
999 #endif
1000 
int rFactorSize
size and local start index of rfactors relative to parent
Definition: dynamic_system.h:940
void addConstraint(Constraint *crt)
Definition: dynamic_system.cc:1403
void setDynamicSystemSolver(DynamicSystemSolver *sys) override
Definition: dynamic_system.cc:305
bool gActiveChangedReg()
Definition: dynamic_system.cc:1063
virtual void setGeneralizedRelativeAccelerationTolerance(double tol)
Definition: dynamic_system.cc:1289
void updateLaRef(fmatvec::Vec &LaParent)
references to contact impulses of dynamic system parent
Definition: dynamic_system.cc:786
fmatvec::Vec q
positions, differentiated positions, initial positions
Definition: dynamic_system.h:831
virtual int jacobianConstraints()
compute JACOBIAN of contact equations
Definition: dynamic_system.cc:511
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:979
int laSize
size and local start index of contact force parameters relative to parent
Definition: dynamic_system.h:935
solver interface for modelling and simulation of dynamic systems
Definition: dynamic_system_solver.h:56
virtual void updateVRef(fmatvec::Mat &VParent, int j=0)
references to condensed contact force direction matrix of dynamic system parent
Definition: dynamic_system.cc:828
void updateWInverseKineticsRef(fmatvec::Mat &WParent)
references to contact force direction matrix of dynamic system parent
Definition: dynamic_system.cc:814
void setUpObjectsWithNonConstantMassMatrix()
rearrange vector of active setvalued links
Definition: dynamic_system.cc:1246
Link * getLink(const std::string &name, bool check=true) const
Definition: dynamic_system.cc:1418
virtual int solveImpactsRootFinding()
solve impact equations with Newton scheme on velocity level
Definition: dynamic_system.cc:503
Frame * getFrameI()
Definition: dynamic_system.h:765
void buildListOfObjects(std::vector< Object * > &obj)
build flat list of objects
Definition: dynamic_system.cc:952
fmatvec::SymMat LLM
Cholesky decomposition of mass matrix.
Definition: dynamic_system.h:826
Object * getObject(const std::string &name, bool check=true) const
Definition: dynamic_system.cc:1379
void updateuRef(fmatvec::Vec &uParent)
references to velocities of dynamic system parent
Definition: dynamic_system.cc:603
void buildListOfContours(std::vector< Contour * > &cnt)
build flat list of contours
Definition: dynamic_system.cc:988
fmatvec::Mat T
linear relation matrix of position and velocity parameters
Definition: dynamic_system.h:816
void updateLinkStatusRegRef(fmatvec::VecInt &LinkStatusRegParent)
references to status vector of single valued links
Definition: dynamic_system.cc:879
fmatvec::VecInt LinkStatus
status of set-valued links
Definition: dynamic_system.h:893
void setUpLinks()
distribute links to set- and single valued container
Definition: dynamic_system.cc:1035
fmatvec::Vec u
velocities, differentiated velocities, initial velocities
Definition: dynamic_system.h:836
virtual void updaterFactors()
update relaxation factors for contact equations
Definition: dynamic_system.cc:539
int uSize[2]
size and local start index of velocities relative to parent
Definition: dynamic_system.h:908
fmatvec::Vec x
order one parameters, differentiated order one parameters, initial order one parameters
Definition: dynamic_system.h:841
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:533
bool detectImpact()
Definition: dynamic_system.cc:1073
virtual void updatewbRef(fmatvec::Vec &wbParent)
references to TODO of dynamic system parent
Definition: dynamic_system.cc:800
virtual void setGeneralizedForceTolerance(double tol)
Definition: dynamic_system.cc:1296
virtual int solveConstraintsRootFinding()
solve contact equations with Newton scheme
Definition: dynamic_system.cc:495
void init(InitStage stage, const InitConfigSet &config) override
plots time series header
Definition: dynamic_system.cc:370
void buildListOfInverseKineticsLinks(std::vector< Link * > &iklnk)
build flat list of inverse kinetics links
Definition: dynamic_system.cc:1006
virtual Contour * getContour(const std::string &name, bool check=true) const
Definition: dynamic_system.cc:559
void updateresRef(fmatvec::Vec &resParent)
references to residuum of contact equations of dynamic system parent
Definition: dynamic_system.cc:855
virtual void setGeneralizedRelativePositionCorrectionValue(double corr)
Definition: dynamic_system.cc:1310
int LinkStatusSize
size and local start index of set-valued link status vector relative to parent
Definition: dynamic_system.h:950
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:1487
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:862
void addObject(Object *obj)
Definition: dynamic_system.cc:1478
int gSize
size and local start index of relative distances relative to parent
Definition: dynamic_system.h:925
void addInverseKineticsLink(Link *lnk)
Definition: dynamic_system.cc:1413
virtual void updateInternalStateRef(fmatvec::Vec &curisParent, fmatvec::Vec &nextisParent)
references to internal state of dynamic system parent
Definition: dynamic_system.cc:751
void buildListOfConstraints(std::vector< Constraint * > &crt)
build flat list of all constraints
Definition: dynamic_system.cc:970
int gdSize
size and local start index of relative velocities relative to parent
Definition: dynamic_system.h:930
virtual void updateWRef(fmatvec::Mat &WParent, int j=0)
references to contact force direction matrix of dynamic system parent
Definition: dynamic_system.cc:807
void plotAtSpecialEvent() override
plots time dependent data at special events
Definition: dynamic_system.cc:351
fmatvec::Vec h[2]
smooth, smooth with respect to objects, smooth with respect to links and nonsmooth
Definition: dynamic_system.h:846
void calcrFactorSize(int j)
calculates size of relaxation factors for contact equations
Definition: dynamic_system.cc:1236
void calcbInverseKineticsSize()
calculates size of contact force parameters
Definition: dynamic_system.cc:1184
virtual void setGeneralizedImpulseTolerance(double tol)
Definition: dynamic_system.cc:1303
std::vector< Frame * > frame
vector of frames and contours
Definition: dynamic_system.h:960
void updaterRef(fmatvec::Vec &rParent, int j=0)
references to nonsmooth right hand side of dynamic system parent
Definition: dynamic_system.cc:701
fmatvec::Vec res
residuum of nonlinear contact equations for Newton scheme
Definition: dynamic_system.h:873
void updatelaRef(fmatvec::Vec &laParent)
references to contact forces of dynamic system parent
Definition: dynamic_system.cc:779
void updateLLMRef(fmatvec::SymMat &LLMParent)
references to Cholesky decomposition of dynamic system parent
Definition: dynamic_system.cc:741
virtual void setGeneralizedRelativePositionTolerance(double tol)
Definition: dynamic_system.cc:1275
void buildListOfFrames(std::vector< Frame * > &frm)
build flat list of frames
Definition: dynamic_system.cc:979
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:1015
Frame * I
Definition: dynamic_system.h:974
Frame * R
parent frame
Definition: dynamic_system.h:796
void calclaInverseKineticsSize()
calculates size of contact force parameters
Definition: dynamic_system.cc:1174
void calcLinkStatusSize()
calculates size of set-valued link status vector
Definition: dynamic_system.cc:1121
virtual int solveImpactsGaussSeidel()
solve impact equations with Gauss-Seidel scheme on velocity level
Definition: dynamic_system.cc:487
void plot() override
plots time dependent data
Definition: dynamic_system.cc:332
fmatvec::VecInt LinkStatusReg
status of single-valued links
Definition: dynamic_system.h:898
void checkActive(int j)
check if set-valued contacts are active and set corresponding attributes
Definition: dynamic_system.cc:1264
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:845
int qSize
size and local start index of positions relative to parent
Definition: dynamic_system.h:903
virtual int solveConstraintsGaussSeidel()
solve contact equations with Gauss-Seidel scheme
Definition: dynamic_system.cc:479
DynamicSystem(const std::string &name)
constructor
Definition: dynamic_system.cc:45
ModellingInterface * getModel(const std::string &name, bool check=true) const
Definition: dynamic_system.cc:1455
void setUpActiveLinks()
rearrange vector of active setvalued links
Definition: dynamic_system.cc:1254
void addModel(ModellingInterface *model_)
Definition: dynamic_system.cc:1446
void buildListOfModels(std::vector< ModellingInterface * > &modelList)
build flat list of models
Definition: dynamic_system.cc:997
DynamicSystem * getGroup(const std::string &name, bool check=true) const
Definition: dynamic_system.cc:1365
void buildListOfLinks(std::vector< Link * > &lnk)
build flat list of links
Definition: dynamic_system.cc:961
void updateuallRef(fmatvec::Vec &uParent)
references to velocities of dynamic system parent
Definition: dynamic_system.cc:613
void setrMax(double rMax)
Definition: dynamic_system.cc:1324
std::string name
name of element
Definition: element.h:249
void updateqdRef(fmatvec::Vec &qdParent)
references to differentiated positions of dynamic system parent
Definition: dynamic_system.cc:583
void updatehRef(fmatvec::Vec &hParent, int j=0)
references to smooth right hand side of dynamic system parent
Definition: dynamic_system.cc:688
void updatesvRef(fmatvec::Vec &svParent)
references to stopvector (rootfunction for event driven integrator) of dynamic system parent
Definition: dynamic_system.cc:835
int LinkStatusRegSize
size and local start index of single-valued link status vector relative to parent
Definition: dynamic_system.h:955
void calcgdSize(int j)
calculates size of gap velocities
Definition: dynamic_system.cc:1226
fmatvec::Vec wb
TODO.
Definition: dynamic_system.h:868
Class for constraints between generalized coordinates of objects.
Definition: constraint.h:30
virtual Frame * getFrame(const std::string &name, bool check=true) const
Definition: dynamic_system.cc:545
virtual void checkConstraintsForTermination()
validate force laws concerning given tolerances
Definition: dynamic_system.cc:527
int svSize
size and local start index of stop vector relative to parent
Definition: dynamic_system.h:945
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:878
Constraint * getConstraint(const std::string &name, bool check=true) const
Definition: dynamic_system.cc:1432
void calcgSize(int j)
calculates size of relative distances
Definition: dynamic_system.cc:1216
fmatvec::Vec sv
stop vector (root functions for event driven integration
Definition: dynamic_system.h:883
void updateudRef(fmatvec::Vec &udParent)
references to differentiated velocities of dynamic system parent
Definition: dynamic_system.cc:621
virtual int solveImpactsFixpointSingle()
solve impact equations with single step fixed point scheme on velocity level
Definition: dynamic_system.cc:471
void updateTRef(fmatvec::Mat &TParent)
references to linear transformation matrix between differentiated positions and velocities of dynamic...
Definition: dynamic_system.cc:721
fmatvec::Vec g
relative distances and velocities
Definition: dynamic_system.h:863
void calcLinkStatusRegSize()
calculates size of single-valued link status vector
Definition: dynamic_system.cc:1136
bool gActiveChanged()
Definition: dynamic_system.cc:1053
virtual void setGeneralizedRelativeVelocityCorrectionValue(double corr)
Definition: dynamic_system.cc:1317
void updateqRef(fmatvec::Vec &qParent)
references to positions of dynamic system parent
Definition: dynamic_system.cc:573
virtual void updategRef(fmatvec::Vec &gParent)
references to relative distances of dynamic system parent
Definition: dynamic_system.cc:765
H5::GroupBase * plotGroup
associated plot group
Definition: element.h:286
void calcsvSize()
calculates size of stop vector
Definition: dynamic_system.cc:1151
void checkActiveReg(int j)
check if single-valued contacts are active
Definition: dynamic_system.cc:1270
virtual void setGeneralizedRelativeVelocityTolerance(double tol)
Definition: dynamic_system.cc:1282
~DynamicSystem() override
destructor
Definition: dynamic_system.cc:61
std::vector< Object * > object
container for possible ingredients
Definition: dynamic_system.h:801
fmatvec::Vec la
contact force parameters
Definition: dynamic_system.h:856
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:869
Definition: observer.h:26
void updateMRef(fmatvec::SymMat &MParent)
references to mass matrix of dynamic system parent
Definition: dynamic_system.cc:731
void setUpInverseKinetics()
analyse constraints of dynamic systems for usage in inverse kinetics
Definition: dynamic_system.cc:1024
int frameIndex(const Frame *frame_) const
Definition: dynamic_system.cc:1357
int hSize[2]
size and local start index of order smooth right hand side relative to parent
Definition: dynamic_system.h:918
void updaterdtRef(fmatvec::Vec &rdtParent)
references to nonsmooth right hand side of dynamic system parent
Definition: dynamic_system.cc:711
int xSize
size and local start index of order one parameters relative to parent
Definition: dynamic_system.h:913
void calclaSize(int j)
calculates size of contact force parameters
Definition: dynamic_system.cc:1164
fmatvec::VecInt jsv
boolean evaluation of stop vector concerning roots
Definition: dynamic_system.h:888
virtual int solveConstraintsFixpointSingle()
solve contact equations with single step fixed point scheme
Definition: dynamic_system.cc:463
virtual int jacobianImpacts()
compute JACOBIAN of contact equations on velocity level
Definition: dynamic_system.cc:519
void addLink(Link *lnk)
Definition: dynamic_system.cc:1393
fmatvec::SymMat M
mass matrix
Definition: dynamic_system.h:821
void buildListOfDynamicSystems(std::vector< DynamicSystem * > &sys)
build flat list of dynamic systems
Definition: dynamic_system.cc:943
void updateudallRef(fmatvec::Vec &udParent)
references to velocities of dynamic system parent
Definition: dynamic_system.cc:641
void addGroup(DynamicSystem *sys)
Definition: dynamic_system.cc:1469
virtual void updategdRef(fmatvec::Vec &gdParent)
references to relative velocities of dynamic system parent
Definition: dynamic_system.cc:772
class for all objects having own dynamics and mass
Definition: object.h:42
namespace MBSim
Definition: bilateral_constraint.cc:29