mbsimflexiblebody  3.0.0
flexible_body_1s_33_cosserat.h
1 /* Copyright (C) 2004-2012 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: thorsten.schindler@mytum.de
18  */
19 
20 #ifndef _FLEXIBLE_BODY_1S_33_COSSERAT_H_
21 #define _FLEXIBLE_BODY_1S_33_COSSERAT_H_
22 
23 #include "mbsimFlexibleBody/flexible_body.h"
24 #include "mbsimFlexibleBody/pointer.h"
25 #include "mbsimFlexibleBody/contours/flexible_band.h"
26 #include "mbsimFlexibleBody/contours/cylinder_flexible.h"
27 #include "mbsimFlexibleBody/flexible_body/finite_elements/finite_element_1s_33_cosserat_translation.h"
28 #include "mbsimFlexibleBody/flexible_body/finite_elements/finite_element_1s_33_cosserat_rotation.h"
29 #ifdef HAVE_OPENMBVCPPINTERFACE
30 #include <openmbvcppinterface/spineextrusion.h>
31 #endif
32 
33 namespace MBSimFlexibleBody {
34 
35  class NurbsCurve1s;
36 
61  public:
62 
68  FlexibleBody1s33Cosserat(const std::string &name, bool openStructure);
69 
73  virtual ~FlexibleBody1s33Cosserat();
74 
75  /* INHERITED INTERFACE OF FLEXIBLE BODY */
76  virtual void BuildElements();
77  virtual void GlobalVectorContribution(int n, const fmatvec::Vec& locVec, fmatvec::Vec& gloVec);
78  virtual void GlobalMatrixContribution(int n, const fmatvec::Mat& locMat, fmatvec::Mat& gloMat);
79  virtual void GlobalMatrixContribution(int n, const fmatvec::SymMat& locMat, fmatvec::SymMat& gloMat);
80  virtual void updateKinematicsForFrame(MBSim::ContourPointData &cp, MBSim::FrameFeature ff, MBSim::Frame *frame=0);
81  virtual void updateJacobiansForFrame(MBSim::ContourPointData &data, MBSim::Frame *frame=0);
82  virtual void exportPositionVelocity(const std::string & filenamePos, const std::string & filenameVel = std::string( ), const int & deg = 3, const bool & writePsFile = false);
83  virtual void importPositionVelocity(const std::string & filenamePos, const std::string & filenameVel = std::string( ));
84  /***************************************************/
85 
86  /* INHERITED INTERFACE OF OBJECT */
87  virtual void init(MBSim::InitStage stage);
88  virtual double computePotentialEnergy();
89  virtual void facLLM(int i=0);
90  /***************************************************/
91 
92  /* INHERITED INTERFACE OF OBJECTINTERFACE */
93  virtual void updateh(double t, int i=0);
94  virtual void updateStateDependentVariables(double t);
95 
96  /* INHERITED INTERFACE OF ELEMENT */
97  virtual void plot(double t, double dt=1);
98  virtual std::string getType() const { return "FlexibleBody1s33Cosserat"; }
99  /***************************************************/
100 
101  /* GETTER / SETTER */
102  void setNumberElements(int n);
103  void setLength(double L_);
104  void setEGModuls(double E_,double G_);
105  void setDensity(double rho_);
106  void setCrossSectionalArea(double A_);
107  void setMomentsInertia(double I1_,double I2_,double I0_);
108  void setCurlRadius(double R1_,double R2_);
109  void setMaterialDamping(double cEps0D_,double cEps1D_,double cEps2D_);
110  void setCylinder(double cylinderRadius_);
111  void setCuboid(double cuboidBreadth_,double cuboidHeight_);
112 
113 #ifdef HAVE_OPENMBVCPPINTERFACE
114  void setOpenMBVSpineExtrusion(OpenMBV::SpineExtrusion* body) { openMBVBody=body; }
115 #endif
116 
117  int getNumberElements() const { return Elements; }
118  int getNumberDOFs() const { return qSize; }
119  double getLength() const { return L; }
120  bool isOpenStructure() const { return openStructure; }
121  /***************************************************/
122 
127  fmatvec::Vec computeState(double s);
128 
132  void initInfo();
133 
134  private:
138  std::vector<MBSim::DiscretizationInterface*> rotationDiscretization;
139 
143  std::vector<fmatvec::Vec> qRotationElement;
144 
148  std::vector<fmatvec::Vec> uRotationElement;
149 
154  FlexibleBand *top, *bottom, *left, *right;
155  Contour1sFlexible *neutralFibre;
156 
160  CardanPtr angle;
161 
165  int Elements;
166 
171 
175  double L, l0;
176 
180  double E, G;
181 
185  double A;
186 
190  double I1, I2, I0;
191 
195  double rho;
196 
200  double R1, R2;
201 
205  double cEps0D, cEps1D, cEps2D;
206 
211 
216 
222  fmatvec::Vec bound_ang_start;
223  fmatvec::Vec bound_ang_end;
224  fmatvec::Vec bound_ang_vel_start;
225  fmatvec::Vec bound_ang_vel_end;
226 
230  double cuboidBreadth, cuboidHeight, cylinderRadius;
231 
236 
237  FlexibleBody1s33Cosserat(); // standard constructor
238  FlexibleBody1s33Cosserat(const FlexibleBody1s33Cosserat&); // copy constructor
239  FlexibleBody1s33Cosserat& operator=(const FlexibleBody1s33Cosserat&); // assignment operator
240 
247  void BuildElementTranslation(const double& sGlobal, double& sLocal, int& currentElementTranslation);
248 
252  void initM();
253 
260 
267  void GlobalVectorContributionRotation(int n, const fmatvec::Vec& locVec, fmatvec::Vec& gloVec);
268  };
269 
270  inline void FlexibleBody1s33Cosserat::setLength(double L_) { L = L_; }
271  inline void FlexibleBody1s33Cosserat::setEGModuls(double E_,double G_) { E = E_; G = G_; }
272  inline void FlexibleBody1s33Cosserat::setDensity(double rho_) { rho = rho_;}
273  inline void FlexibleBody1s33Cosserat::setCrossSectionalArea(double A_) { A = A_; }
274  inline void FlexibleBody1s33Cosserat::setMomentsInertia(double I1_, double I2_, double I0_) { I1 = I1_; I2 = I2_; I0 = I0_; }
275  inline void FlexibleBody1s33Cosserat::setCurlRadius(double R1_,double R2_) { R1 = R1_; R2 = R2_; if(initialised) for(int i=0;i<Elements;i++) static_cast<FiniteElement1s33CosseratRotation*>(rotationDiscretization[i])->setCurlRadius(R1,R2); }
276  inline void FlexibleBody1s33Cosserat::setMaterialDamping(double cEps0D_,double cEps1D_,double cEps2D_) { cEps0D = cEps0D_; cEps1D = cEps1D_; cEps2D = cEps2D_; if(initialised) for(int i=0;i<Elements;i++) static_cast<FiniteElement1s33CosseratTranslation*>(discretization[i])->setMaterialDamping(Elements*cEps0D,cEps1D,cEps2D); }
277  inline void FlexibleBody1s33Cosserat::setCylinder(double cylinderRadius_) { cylinderRadius = cylinderRadius_; }
278  inline void FlexibleBody1s33Cosserat::setCuboid(double cuboidBreadth_,double cuboidHeight_) { cuboidBreadth = cuboidBreadth_; cuboidHeight = cuboidHeight_; }
279 
280 }
281 
282 #endif /* _FLEXIBLE_BODY_1S_33_COSSERAT_H_ */
283