mbsim  4.0.0
MBSim Kernel
joint.h
1 /* Copyright (C) 2004-2014 MBSim Development Team
2  *
3  * This library is free software; you can redistribute it and/or
4  * modify it under the terms of the GNU Lesser General Public
5  * License as published by the Free Software Foundation; either
6  * version 2.1 of the License, or (at your option) any later version.
7  *
8  * This library is distributed in the hope that it will be useful,
9  * but WITHOUT ANY WARRANTY; without even the implied warranty of
10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
11  * Lesser General Public License for more details.
12  *
13  * You should have received a copy of the GNU Lesser General Public
14  * License along with this library; if not, write to the Free Software
15  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
16  *
17  * Contact: martin.o.foerg@googlemail.com
18  */
19 
20 #ifndef _JOINT_H_
21 #define _JOINT_H_
22 
23 #include "mbsim/links/floating_frame_link.h"
24 
25 namespace MBSim {
26 
27  class GeneralizedForceLaw;
28  class GeneralizedImpactLaw;
29  class FrictionForceLaw;
30  class FrictionImpactLaw;
31  class Body;
32 
42  class Joint : public FloatingFrameLink {
43  public:
48  Joint(const std::string &name = "") : FloatingFrameLink(name), iFM(0,-1), iMM(0,-1) { }
49 
53  ~Joint() override;
54 
55  void updatelaF() override { (this->*updatelaF_)(); updlaF = false; }
56  void updatelaM() override { (this->*updatelaM_)(); updlaM = false; }
57  void updatelaF0() { }
58  void updatelaFS();
59  void updatelaFM();
60  void updatelaM0() { }
61  void updatelaMS();
62  void updatelaMM();
63  void (Joint::*updatelaF_)();
64  void (Joint::*updatelaM_)();
65  void updateh(int i=0) override;
66  void updateW(int i=0) override;
67  void updateg() override;
68  void updategd() override;
69  void updatewb() override;
70  void updatexd() override;
71 
72  void calclaSize(int j) override;
73  void calcgSize(int j) override;
74  void calcgdSize(int j) override;
75  void calcrFactorSize(int j) override;
76  void calccorrSize(int j) override;
77  void calcxSize() override { if(integrateGeneralizedRelativeVelocityOfRotation) xSize = momentDir.cols(); }
78  void init(InitStage stage, const InitConfigSet &config) override;
79 
80  bool isSetValued() const override;
81  bool isSingleValued() const override;
82  bool isActive() const override { return true; }
83  bool gActiveChanged() override { return false; }
84  void solveImpactsFixpointSingle() override;
85  void solveConstraintsFixpointSingle() override;
86  void solveImpactsGaussSeidel() override;
87  void solveConstraintsGaussSeidel() override;
88  void solveImpactsRootFinding() override;
89  void solveConstraintsRootFinding() override;
90  void jacobianConstraints() override;
91  void jacobianImpacts() override;
92  void updaterFactors() override;
93  void checkImpactsForTermination() override;
94  void checkConstraintsForTermination() override;
95 
96  void setForceLaw(GeneralizedForceLaw * rc);
97  void setMomentLaw(GeneralizedForceLaw * rc);
98 
102  void setForceDirection(const fmatvec::Mat3xV& fd) { forceDir <<= fd; }
103 
107  void setMomentDirection(const fmatvec::Mat3xV& md) { momentDir <<= md; }
108 
109  void setIntegrateGeneralizedRelativeVelocityOfRotation(bool integrateGeneralizedRelativeVelocityOfRotation_) { integrateGeneralizedRelativeVelocityOfRotation = integrateGeneralizedRelativeVelocityOfRotation_; }
110 
111  fmatvec::VecV evalGeneralizedRelativePositionOfRotation() override;
112 
113  void initializeUsingXML(xercesc::DOMElement *element) override;
114 
115  protected:
120 
125 
130 
135 
139  fmatvec::Vec gdn, gdd;
140 
141  bool integrateGeneralizedRelativeVelocityOfRotation{false};
142 
143  fmatvec::Mat3xV RF, RM;
144  fmatvec::RangeV iFM, iMM;
145  };
146 
147  class InverseKineticsJoint : public Joint {
148  friend class JointConstraint;
149  public:
150  InverseKineticsJoint(const std::string &name) : Joint(name) { }
151  void updateb() override;
152  void calcbSize() override;
153  void setBody(Body* body_) { body = body_; }
154  void init(InitStage stage, const InitConfigSet &config) override;
155  bool isSetValued() const override { return true; }
156 
157  protected:
158  Body* body{nullptr};
159  };
160 
161 }
162 
163 #endif
void jacobianConstraints() override
computes JACOBIAN and mass action matrix of nonlinear contact equations
Definition: joint.cc:323
basic force law on acceleration level for constraint description
Definition: generalized_force_law.h:32
void calclaSize(int j) override
calculates size of contact force parameters
Definition: joint.cc:103
Joint(const std::string &name="")
constructor
Definition: joint.h:48
void setForceDirection(const fmatvec::Mat3xV &fd)
Definition: joint.h:102
void solveConstraintsFixpointSingle() override
Definition: joint.cc:203
void updaterFactors() override
update relaxation factors for contact equations
Definition: joint.cc:382
~Joint() override
destructor
Definition: joint.cc:40
void init(InitStage stage, const InitConfigSet &config) override
plots time series header
Definition: joint.cc:507
void setMomentDirection(const fmatvec::Mat3xV &md)
Definition: joint.h:107
void checkConstraintsForTermination() override
verify underlying force laws concerning given tolerances
Definition: joint.cc:435
void checkImpactsForTermination() override
verify underlying force laws on velocity level concerning given tolerances
Definition: joint.cc:405
GeneralizedForceLaw * ffl
Definition: joint.h:119
bool isSingleValued() const override
asks the link if it contains single valued force laws that contribute to the right-hand side vector h
Definition: joint.cc:175
void calcgSize(int j) override
calculates size of relative distances
Definition: joint.cc:107
class for connections: constraints on frames
Definition: joint.h:42
GeneralizedForceLaw * fml
Definition: joint.h:124
void solveImpactsRootFinding() override
Definition: joint.cc:275
Joint contraint.
Definition: joint_constraint.h:36
void calcrFactorSize(int j) override
calculates size of rfactors
Definition: joint.cc:115
InitStage
The stages of the initialization.
Definition: element.h:64
bool isActive() const override
Definition: joint.h:82
bool gActiveChanged() override
Definition: joint.h:83
GeneralizedImpactLaw * fiml
Definition: joint.h:134
basic force law on velocity level for constraint description
Definition: generalized_impact_law.h:32
GeneralizedImpactLaw * fifl
Definition: joint.h:129
void init(InitStage stage, const InitConfigSet &config) override
plots time series header
Definition: joint.cc:123
std::string name
name of element
Definition: element.h:262
bool isSetValued() const override
asks the link if it contains force laws that contribute to the lagrange multiplier and is therefore s...
Definition: joint.h:155
void solveImpactsGaussSeidel() override
Definition: joint.cc:227
bool isSetValued() const override
asks the link if it contains force laws that contribute to the lagrange multiplier and is therefore s...
Definition: joint.cc:171
fmatvec::Vec gdn
relative velocity and acceleration after an impact for event driven scheme summarizing all possible c...
Definition: joint.h:139
void solveConstraintsGaussSeidel() override
Definition: joint.cc:251
void solveConstraintsRootFinding() override
Definition: joint.cc:299
void solveImpactsFixpointSingle() override
Definition: joint.cc:179
base class for all mechanical bodies with mass and generalised coordinates
Definition: body.h:49
void calcbSize() override
calculates size of rfactors
Definition: joint.cc:496
Definition: joint.h:147
namespace MBSim
Definition: bilateral_constraint.cc:29
void calcgdSize(int j) override
calculates size of gap velocities
Definition: joint.cc:111
void jacobianImpacts() override
computes JACOBIAN and mass action matrix of nonlinear contact equations on velocity level
Definition: joint.cc:353