mbsimflexiblebody  4.0.0
finite_element_1s_33_cosserat_translation.h
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_ */