20 #ifndef _FINITE_ELEMENT_1S_33_RCM_H_
21 #define _FINITE_ELEMENT_1S_33_RCM_H_
23 #include "mbsim/discretization_interface.h"
24 #include "mbsim/mbsim_event.h"
25 #include "mbsim/contour_pdata.h"
26 #include "mbsimFlexibleBody/pointer.h"
27 #include "mbsimFlexibleBody/flexible_body/finite_elements/finite_element_1s_33_rcm/weight33RCM.h"
30 namespace MBSimFlexibleBody {
56 FiniteElement1s33RCM(
double l0_,
double rho_,
double A_,
double E_,
double G_,
double I1_,
double I2_,
double I0_,
const fmatvec::Vec& g_,RevCardanPtr ag_);
64 virtual const fmatvec::SymMat& getM()
const;
65 virtual const fmatvec::Vec& geth()
const;
66 virtual const fmatvec::SqrMat& getdhdq()
const;
67 virtual const fmatvec::SqrMat& getdhdu()
const;
68 virtual int getqSize()
const;
69 virtual int getuSize()
const;
71 virtual void computeM(
const fmatvec::Vec& qG);
72 virtual void computeh(
const fmatvec::Vec& qG,
const fmatvec::Vec& qGt);
73 virtual void computedhdz(
const fmatvec::Vec& qG,
const fmatvec::Vec& qGt);
74 virtual double computeKineticEnergy(
const fmatvec::Vec& qG,
const fmatvec::Vec& qGt);
75 virtual double computeGravitationalEnergy(
const fmatvec::Vec& qG);
76 virtual double computeElasticEnergy(
const fmatvec::Vec& qG);
78 virtual fmatvec::Vec computePosition(
const fmatvec::Vec& q,
const MBSim::ContourPointData &data);
79 virtual fmatvec::SqrMat computeOrientation(
const fmatvec::Vec& q,
const MBSim::ContourPointData &data);
80 virtual fmatvec::Vec computeVelocity(
const fmatvec::Vec& q,
const fmatvec::Vec& u,
const MBSim::ContourPointData &data);
81 virtual fmatvec::Vec computeAngularVelocity(
const fmatvec::Vec& q,
const fmatvec::Vec& u,
const MBSim::ContourPointData &data);
82 virtual fmatvec::Mat computeJacobianOfMotion(
const fmatvec::Vec& qG,
const MBSim::ContourPointData& data);
86 void setGauss(
int nGauss);
87 void setCurlRadius(
double R1,
double R2);
88 void setMaterialDamping(
double epstD_,
double k0D_);
89 void setLehrDamping(
double epstL,
double k0L);
99 const fmatvec::Vec&
computeState(
const fmatvec::Vec& qG,
const fmatvec::Vec& qGt,
double x);
106 fmatvec::Mat
computeJXqG(
const fmatvec::Vec& qG,
double x);
113 fmatvec::Vec
computeData(
const fmatvec::Vec& qG,
const fmatvec::Vec& qGt);
211 fmatvec::RowVec depstil, dk0;
244 inline void FiniteElement1s33RCM::setGauss(
int nGauss) {
wt->setGauss(nGauss); }
245 inline double FiniteElement1s33RCM::getl0()
const {
return l0; }
246 inline const fmatvec::SymMat& FiniteElement1s33RCM::getM()
const {
return M; }
247 inline const fmatvec::Vec& FiniteElement1s33RCM::geth()
const {
return h; }
248 inline const fmatvec::SqrMat& FiniteElement1s33RCM::getdhdq()
const {
return dhdq; }
249 inline const fmatvec::SqrMat& FiniteElement1s33RCM::getdhdu()
const {
return dhdu; }
250 inline int FiniteElement1s33RCM::getqSize()
const {
return 16; }
251 inline int FiniteElement1s33RCM::getuSize()
const {
return 16; }
252 inline fmatvec::Vec FiniteElement1s33RCM::computePosition(
const fmatvec::Vec& q,
const MBSim::ContourPointData &data) {
throw MBSim::MBSimError(
"ERROR (FiniteElement1s33RCM::computePosition): Not implemented!"); }
253 inline fmatvec::SqrMat FiniteElement1s33RCM::computeOrientation(
const fmatvec::Vec& q,
const MBSim::ContourPointData &data) {
throw MBSim::MBSimError(
"ERROR (FiniteElement1s33RCM::computeOrientation): Not implemented!"); }
254 inline fmatvec::Vec FiniteElement1s33RCM::computeVelocity(
const fmatvec::Vec& q,
const fmatvec::Vec& u,
const MBSim::ContourPointData &data) {
throw MBSim::MBSimError(
"ERROR (FiniteElement1s33RCM::computeVelocity): Not implemented!"); }
255 inline fmatvec::Vec FiniteElement1s33RCM::computeAngularVelocity(
const fmatvec::Vec& q,
const fmatvec::Vec& u,
const MBSim::ContourPointData &data) {
throw MBSim::MBSimError(
"ERROR (FiniteElement1s33RCM::computeAngularVelocity): Not implemented!"); }
256 inline fmatvec::Mat FiniteElement1s33RCM::computeJacobianOfMotion(
const fmatvec::Vec& qG,
const MBSim::ContourPointData& data) {
return computeJXqG(qG,data.getLagrangeParameterPosition()(0)); }