|
mbsimflexiblebody
3.2.0
|
00001 /* Copyright (C) 2004-2012 MBSim Development Team 00002 * 00003 * This library is free software; you can redistribute it and/or 00004 * modify it under the terms of the GNU Lesser General Public 00005 * License as published by the Free Software Foundation; either 00006 * version 2.1 of the License, or (at your option) any later version. 00007 * 00008 * This library is distributed in the hope that it will be useful, 00009 * but WITHOUT ANY WARRANTY; without even the implied warranty of 00010 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 00011 * Lesser General Public License for more details. 00012 * 00013 * You should have received a copy of the GNU Lesser General Public 00014 * License along with this library; if not, write to the Free Software 00015 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA 00016 * 00017 * Contact: thorsten.schindler@mytum.de 00018 */ 00019 00020 #ifndef _FINITE_ELEMENT_1S_33_COSSERAT_TRANSLATION_H_ 00021 #define _FINITE_ELEMENT_1S_33_COSSERAT_TRANSLATION_H_ 00022 00023 #include "mbsim/discretization_interface.h" 00024 #include "mbsim/mbsim_event.h" 00025 #include "mbsim/contour_pdata.h" 00026 #include "mbsimFlexibleBody/pointer.h" 00027 #include "fmatvec/fmatvec.h" 00028 00029 namespace MBSimFlexibleBody { 00030 00054 class FiniteElement1s33CosseratTranslation : public MBSim::DiscretizationInterface { 00055 public: 00056 00070 FiniteElement1s33CosseratTranslation(double l0_,double rho_,double A_,double E_,double G_,double I1_,double I2_,double I0_,const fmatvec::Vec& g_,CardanPtr ag_); 00071 00075 virtual ~FiniteElement1s33CosseratTranslation(); 00076 00077 /* INHERITED INTERFACE OF DISCRETIZATIONINTERFACE */ 00078 virtual const fmatvec::SymMat& getM() const; 00079 virtual const fmatvec::Vec& geth() const; 00080 virtual const fmatvec::SqrMat& getdhdq() const; 00081 virtual const fmatvec::SqrMat& getdhdu() const; 00082 virtual int getqSize() const; 00083 virtual int getuSize() const; 00084 00085 virtual void computeM(const fmatvec::Vec& qG); 00086 virtual void computeh(const fmatvec::Vec& qG, const fmatvec::Vec& qGt); 00087 virtual void computedhdz(const fmatvec::Vec& qG, const fmatvec::Vec& qGt); 00088 virtual double computeKineticEnergy(const fmatvec::Vec& qG, const fmatvec::Vec& qGt); 00089 virtual double computeGravitationalEnergy(const fmatvec::Vec& qG); 00090 virtual double computeElasticEnergy(const fmatvec::Vec& qG); 00091 00092 virtual fmatvec::Vec computePosition(const fmatvec::Vec& q, const MBSim::ContourPointData &data); 00093 virtual fmatvec::SqrMat computeOrientation(const fmatvec::Vec& q, const MBSim::ContourPointData &data); 00094 virtual fmatvec::Vec computeVelocity(const fmatvec::Vec& q, const fmatvec::Vec& u, const MBSim::ContourPointData &data); 00095 virtual fmatvec::Vec computeAngularVelocity(const fmatvec::Vec& q, const fmatvec::Vec& u, const MBSim::ContourPointData &data); 00096 virtual fmatvec::Mat computeJacobianOfMotion(const fmatvec::Vec& qG, const MBSim::ContourPointData& data); 00097 00098 /* GETTER / SETTER */ 00099 void setMaterialDamping(double cEps0D_,double cEps1D_,double cEps2D_); 00100 void setShearCorrectionFactors(double sigma1_, double sigma2_); 00101 double getl0() const; 00102 00109 const fmatvec::Vec& computeStateTranslation(const fmatvec::Vec& qG, const fmatvec::Vec& qGt, double s); 00110 00116 fmatvec::Mat computeJXqG(const fmatvec::Vec& qG,double x); 00117 00121 void initM(); 00122 00123 private: 00127 double l0; 00128 00132 double rho; 00133 00137 double A; 00138 00142 double E; 00143 00147 double G; 00148 00152 double I1, I2, I0; 00153 00157 fmatvec::Vec g; 00158 00162 double cEps0D, cEps1D, cEps2D; 00163 00167 double sigma1, sigma2; 00168 00172 fmatvec::SymMat M; 00173 fmatvec::Vec h; 00174 00178 fmatvec::SqrMat dhdq, dhdu; 00179 00183 fmatvec::Vec X; 00184 00188 CardanPtr ag; 00189 00190 FiniteElement1s33CosseratTranslation(); // standard constructor 00191 FiniteElement1s33CosseratTranslation(const FiniteElement1s33CosseratTranslation&); // copy constructor 00192 FiniteElement1s33CosseratTranslation& operator=(const FiniteElement1s33CosseratTranslation&); // assignment operator 00193 }; 00194 00195 inline const fmatvec::SymMat& FiniteElement1s33CosseratTranslation::getM() const { return M; } 00196 inline const fmatvec::Vec& FiniteElement1s33CosseratTranslation::geth() const { return h; } 00197 inline const fmatvec::SqrMat& FiniteElement1s33CosseratTranslation::getdhdq() const { return dhdq; } 00198 inline const fmatvec::SqrMat& FiniteElement1s33CosseratTranslation::getdhdu() const { return dhdu; } 00199 inline int FiniteElement1s33CosseratTranslation::getqSize() const { return 9; } 00200 inline int FiniteElement1s33CosseratTranslation::getuSize() const { return 9; } 00201 inline void FiniteElement1s33CosseratTranslation::computedhdz(const fmatvec::Vec& qG, const fmatvec::Vec& qGt) { throw MBSim::MBSimError("Error(FiniteElement1s33CosseratTranslation::computedhdz): Not implemented"); } 00202 inline fmatvec::Vec FiniteElement1s33CosseratTranslation::computePosition(const fmatvec::Vec& q, const MBSim::ContourPointData &data) { throw MBSim::MBSimError("ERROR (FiniteElement1s33CosseratTranslation::computePosition): Not implemented!"); } 00203 inline fmatvec::SqrMat FiniteElement1s33CosseratTranslation::computeOrientation(const fmatvec::Vec& q, const MBSim::ContourPointData &data) { throw MBSim::MBSimError("ERROR (FiniteElement1s33CosseratTranslation::computeOrientation): Not implemented!"); } 00204 inline fmatvec::Vec FiniteElement1s33CosseratTranslation::computeVelocity(const fmatvec::Vec& q, const fmatvec::Vec& u, const MBSim::ContourPointData &data) { throw MBSim::MBSimError("ERROR (FiniteElement1s33CosseratTranslation::computeVelocity): Not implemented!"); } 00205 inline fmatvec::Vec FiniteElement1s33CosseratTranslation::computeAngularVelocity(const fmatvec::Vec& q, const fmatvec::Vec& u, const MBSim::ContourPointData &data) { throw MBSim::MBSimError("ERROR (FiniteElement1s33CosseratTranslation::computeAngularVelocity): Not implemented!"); } 00206 inline fmatvec::Mat FiniteElement1s33CosseratTranslation::computeJacobianOfMotion(const fmatvec::Vec& qG,const MBSim::ContourPointData& data) { return computeJXqG(qG,data.getLagrangeParameterPosition()(0)); } 00207 inline void FiniteElement1s33CosseratTranslation::setShearCorrectionFactors(double sigma1_, double sigma2_) { sigma1 = sigma1_; sigma2 = sigma2_; } 00208 inline double FiniteElement1s33CosseratTranslation::getl0() const { return l0; } 00209 inline fmatvec::Mat FiniteElement1s33CosseratTranslation::computeJXqG(const fmatvec::Vec& qG,double x) { throw MBSim::MBSimError("ERROR (FiniteElement1s33CosseratTranslation::computeJXqG): Not implemented!"); } 00210 00211 } 00212 00213 #endif /* _FINITE_ELEMENT_1S_33_COSSERAT_TRANSLATION_H_ */
1.8.0