21 #ifndef _FINITE_ELEMENT_1S_21_RCM_H_
22 #define _FINITE_ELEMENT_1S_21_RCM_H_
24 #include "mbsim/discretization_interface.h"
25 #include "mbsim/contour_pdata.h"
26 #include "mbsim/mbsim_event.h"
29 namespace MBSimFlexibleBody {
69 virtual const fmatvec::SymMat& getM()
const {
return M; }
70 virtual const fmatvec::Vec& geth()
const {
return h; }
71 virtual const fmatvec::SqrMat& getdhdq()
const {
return Dhq; }
72 virtual const fmatvec::SqrMat& getdhdu()
const {
return Dhqp; }
73 virtual int getqSize()
const {
return 8; }
74 virtual int getuSize()
const {
return 8; }
75 virtual void computeM(
const fmatvec::Vec& qElement);
76 virtual void computeh(
const fmatvec::Vec& qElement,
const fmatvec::Vec& qpElement);
77 virtual void computedhdz(
const fmatvec::Vec& qElement,
const fmatvec::Vec& qpElement);
78 virtual double computeKineticEnergy(
const fmatvec::Vec& qElement,
const fmatvec::Vec& qpElement);
79 virtual double computeGravitationalEnergy(
const fmatvec::Vec& qElement);
80 virtual double computeElasticEnergy(
const fmatvec::Vec& qElement);
81 virtual fmatvec::Vec computePosition(
const fmatvec::Vec&q,
const MBSim::ContourPointData& cp) {
throw MBSim::MBSimError(
"ERROR (FiniteElement1s21RCM::computePosition): not implemented!"); }
82 virtual fmatvec::SqrMat computeOrientation(
const fmatvec::Vec&q,
const MBSim::ContourPointData& cp) {
throw MBSim::MBSimError(
"ERROR (FiniteElement1s21RCM::computeOrientation): not implemented!"); }
83 virtual fmatvec::Vec computeVelocity (
const fmatvec::Vec&q,
const fmatvec::Vec&u,
const MBSim::ContourPointData& cp) {
throw MBSim::MBSimError(
"ERROR (FiniteElement1s21RCM::computeVelocity): not implemented!"); }
84 virtual fmatvec::Vec computeAngularVelocity(
const fmatvec::Vec&q,
const fmatvec::Vec&u,
const MBSim::ContourPointData& cp) {
throw MBSim::MBSimError(
"ERROR (FiniteElement1s21RCM::computeAngularVelocity): not implemented!"); }
85 virtual fmatvec::Mat computeJacobianOfMotion(
const fmatvec::Vec&q,
const MBSim::ContourPointData& cp) {
return JGeneralized(q,cp.getLagrangeParameterPosition()(0)); }
93 void setCurlRadius(
double);
94 void setMaterialDamping(
double);
95 void setLehrDamping(
double);
103 fmatvec::Vec
LocateBeam(
const fmatvec::Vec&q,
const double &s);
111 fmatvec::Vec
StateBeam(
const fmatvec::Vec&q,
const fmatvec::Vec&u,
const double &s);
125 fmatvec::Mat
JGeneralized (
const fmatvec::Vec& qElement,
const double& s);
134 fmatvec::Mat
JpGeneralized(
const fmatvec::Vec& qElement,
const fmatvec::Vec& qpElement,
const double& s,
const double& sp);
141 fmatvec::Vec
ElementData(fmatvec::Vec qElement, fmatvec::Vec qpElement);
147 double l0, Arho, EA, EI;
177 fmatvec::SqrMat
Dhq, Dhqp;
187 fmatvec::Vec
qLocal, qpLocal, hIntermediate;
197 fmatvec::SqrMat
Jeg, Jegp;
231 void BuildJacobi(
const fmatvec::Vec&
qLocal,
const fmatvec::Vec& qpIntern, fmatvec::SqrMat&
Jeg, fmatvec::SqrMat& Jegp);
240 fmatvec::Vec
LocateLocalBeam(
const fmatvec::Vec&
qLocal,
const fmatvec::Vec& qpLocal,
const double& s,
const bool calcAll=
true);
253 fmatvec::Mat
hFullJacobi(
const fmatvec::Vec& qElement,
const fmatvec::Vec& qpElement,
const fmatvec::Vec&
qLocal,
const fmatvec::Vec& qpLocal,
const fmatvec::SqrMat&
Jeg,
const fmatvec::SqrMat& Jegp,
const fmatvec::SymMat&
MLocal,
const fmatvec::Vec& hIntermediate);
258 double l0h2, l0h3, l0h4, l0h5, l0h7, l0h8;
261 inline double Sec(
const double& alpha) {
return 1.0/cos(alpha); }
262 inline double Power(
double base,
int exponent) {
return pow(base,exponent); }