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  fmatvec::Vec3 evalGlobalRelativeAngle();
113 
114  void initializeUsingXML(xercesc::DOMElement *element) override;
115 
116  protected:
121 
126 
131 
136 
141 
142  fmatvec::Vec3 WphiK0K1, eR;
143 
144  size_t iR{2};
145 
146  bool integrateGeneralizedRelativeVelocityOfRotation{false};
147 
148  fmatvec::Mat3xV RF, RM;
149  fmatvec::RangeV iFM, iMM;
150  };
151 
152  class InverseKineticsJoint : public Joint {
153  friend class JointConstraint;
154  public:
155  InverseKineticsJoint(const std::string &name) : Joint(name) { }
156  void updateb() override;
157  void calcbSize() override;
158  void setBody(Body* body_) { body = body_; }
159  void init(InitStage stage, const InitConfigSet &config) override;
160  bool isSetValued() const override { return true; }
161 
162  protected:
163  Body* body{nullptr};
164  };
165 
166 }
167 
168 #endif
void jacobianConstraints() override
computes JACOBIAN and mass action matrix of nonlinear contact equations
Definition: joint.cc:341
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:102
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:221
void updaterFactors() override
update relaxation factors for contact equations
Definition: joint.cc:400
~Joint() override
destructor
Definition: joint.cc:39
void init(InitStage stage, const InitConfigSet &config) override
plots time series header
Definition: joint.cc:531
void setMomentDirection(const fmatvec::Mat3xV &md)
Definition: joint.h:107
void checkConstraintsForTermination() override
verify underlying force laws concerning given tolerances
Definition: joint.cc:453
void checkImpactsForTermination() override
verify underlying force laws on velocity level concerning given tolerances
Definition: joint.cc:423
GeneralizedForceLaw * ffl
Definition: joint.h:120
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:193
void calcgSize(int j) override
calculates size of relative distances
Definition: joint.cc:106
class for connections: constraints on frames
Definition: joint.h:42
GeneralizedForceLaw * fml
Definition: joint.h:125
void solveImpactsRootFinding() override
Definition: joint.cc:293
Joint contraint.
Definition: joint_constraint.h:36
void calcrFactorSize(int j) override
calculates size of rfactors
Definition: joint.cc:114
InitStage
The stages of the initialization.
Definition: element.h:62
bool isActive() const override
Definition: joint.h:82
bool gActiveChanged() override
Definition: joint.h:83
GeneralizedImpactLaw * fiml
Definition: joint.h:135
basic force law on velocity level for constraint description
Definition: generalized_impact_law.h:32
GeneralizedImpactLaw * fifl
Definition: joint.h:130
void init(InitStage stage, const InitConfigSet &config) override
plots time series header
Definition: joint.cc:122
std::string name
name of element
Definition: element.h:249
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:160
void solveImpactsGaussSeidel() override
Definition: joint.cc:245
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:189
fmatvec::Vec gdn
relative velocity and acceleration after an impact for event driven scheme summarizing all possible c...
Definition: joint.h:140
void solveConstraintsGaussSeidel() override
Definition: joint.cc:269
void solveConstraintsRootFinding() override
Definition: joint.cc:317
void solveImpactsFixpointSingle() override
Definition: joint.cc:197
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:520
Definition: joint.h:152
namespace MBSim
Definition: eigenanalyzer.cc:47
void calcgdSize(int j) override
calculates size of gap velocities
Definition: joint.cc:110
void jacobianImpacts() override
computes JACOBIAN and mass action matrix of nonlinear contact equations on velocity level
Definition: joint.cc:371