21 #ifndef _SUPERELEMENT_LINEAR_EXTERNAL_H_
22 #define _SUPERELEMENT_LINEAR_EXTERNAL_H_
25 #include "mbsim/discretization_interface.h"
26 #include "mbsim/mbsim_event.h"
27 #include "mbsim/contour_pdata.h"
29 namespace MBSimFlexibleBody {
41 void init(MBSim::InitStage stage);
46 void setM(
const fmatvec::SymMat &M_);
51 void setK(
const fmatvec::SqrMat &K_);
61 const fmatvec::SymMat& getM()
const {
return M; }
62 const fmatvec::Vec& geth()
const {
return h; }
64 const fmatvec::SqrMat& getdhdq()
const {
return Dhq; }
65 const fmatvec::SqrMat& getdhdu()
const {
return Dhqp; }
66 int getqSize()
const {
return K.size(); }
67 int getuSize()
const {
return M.size(); }
69 void computeM(
const fmatvec::Vec& qElement) {}
73 void computeh(
const fmatvec::Vec& qElement,
const fmatvec::Vec& uElement) {
h = -
K * qElement -
D * uElement; }
74 void computedhdz(
const fmatvec::Vec& qElement,
const fmatvec::Vec& uElement) {}
75 double computeKineticEnergy(
const fmatvec::Vec& q,
const fmatvec::Vec& u) {
return 0.5*u.T()*
M*u;}
76 double computeGravitationalEnergy(
const fmatvec::Vec& q) {
return 0.0;}
77 double computeElasticEnergy(
const fmatvec::Vec& q) {
return 0.5*q.T()*
K*q;}
79 fmatvec::Vec computeVelocity(
const fmatvec::Vec&q,
const fmatvec::Vec&u,
const MBSim::ContourPointData& cp) {
return computeJacobianOfMotion(q,cp).T()*u;}
80 fmatvec::Vec computeAngularVelocity(
const fmatvec::Vec&q,
const fmatvec::Vec&u,
const MBSim::ContourPointData& cp) {
return computeJacobianOfMotion(q,cp).T()*u;}
81 fmatvec::Vec computePosition(
const fmatvec::Vec&q,
const MBSim::ContourPointData& cp);
82 fmatvec::SqrMat computeOrientation(
const fmatvec::Vec&q,
const MBSim::ContourPointData& cp) {
throw MBSim::MBSimError(
"ERROR(SuperElementLinearExternal::computeOrientation): Not Implemented");}
83 fmatvec::Mat computeJacobianOfMotion(
const fmatvec::Vec&q,
const MBSim::ContourPointData& cp);
85 MBSim::ContourPointData addInterface(fmatvec::Mat J_, fmatvec::Vec KrP_);
101 fmatvec::SqrMat
Dhq, Dhqp;
103 std::vector<fmatvec::Mat>
J;
105 std::vector<fmatvec::Vec>
KrP;