FhSim  3.1.0
Marine systems simulation
Loading...
Searching...
No Matches
RBCable.h
1#pragma once
66#include <string>
67
68#include <fhsim/simobject/SimObject.h>
69#ifdef FH_VISUALIZATION
70# include "sfh/ogre/C3DLine.h"
71#endif
72
73
74namespace RbCable
75{
84inline void AddRelativeLinearDamping(double damping, int numElements, const double* velocity, double* force)
85{
86 for (int element = 0; element + 1 < numElements; element++)
87 for (int k = 0; k < 3; k++) {
88 const double dashpot = damping * (velocity[3 * (element + 1) + k] - velocity[3 * element + k]);
89 force[3 * element + k] += dashpot;
90 force[3 * (element + 1) + k] -= dashpot;
91 }
92}
93
94class RBCable : public SimObject
95{
96public:
97 RBCable(const std::string& simObjectName, ISimObjectCreator* const creator);
98 ~RBCable();
99 void OdeFcn(const double T, const double* const X, double* const XDot) const;
100 void InitialConditionSetup(const double T, const double* const currentIC, double* const updatedIC, ISimObjectCreator* const creator);
101
102 const double* const totalLength(const double T, const double* const X);
103 const double* forceA(const double T, const double* const X);
104 const double* forceB(const double T, const double* const X);
105 void calculations(const double T, const double* const X);
106 void calculationsCommon(const double T, const double* const X) const;
107
108#ifdef FH_VISUALIZATION
109 void RenderInit(Ogre::Root* const ogreRoot, ISimObjectCreator* const creator);
110 void RenderUpdate(const double T, const double* const X);
111#endif
112
113protected:
114 int m_numElements;
115 int* m_pos;
116 int* m_vel;
117
118 double m_length;
119 double m_alpha;
120 double m_beta;
121 double m_epsilon;
122 double m_bendingStiffness;
123 double m_linearDamping;
124 int counter;
125
126 double m_totalLength;
127 double m_kineticEnergy;
128
129 ISignalPort* m_posA;
130 ISignalPort* m_posB;
131 ISignalPort* m_velA;
132 ISignalPort* m_velB;
133
134 ICommonComputation* m_calcDynamics;
135 double* m_lambda;
136 double* m_accel;
137
138 double m_forceA[3];
139 double m_forceB[3];
140
141#ifdef FH_VISUALIZATION
142 C3DLine* m_line;
143#endif
144};
145} // namespace RbCable
Definition RBCable.h:95
RBCable(const std::string &simObjectName, ISimObjectCreator *const creator)
reads parameters, registers states, output and intput ports.