25#include <fhsim_environment/hydrodynamics/PanelClampLog.h>
26#include <fhsim_environment/hydrodynamics/PanelLoadLaw.h>
28#include <sfh/linalg/matrix_ops.h>
29#include <sfh/math/array.h>
30#include <sfh/math/math.h>
31#include <sfh/sim/kinematics.h>
32#include <sfh/util/diagnostic.h>
38namespace net_element_forces
42const double kMinMeshBarLength = 1.0e-10;
46const hydrodynamics::FlowReference kFlowReference = hydrodynamics::FlowReference::FreeStream;
52inline double PanelStiffness(
double eA,
double barL0,
const double nodesDistAB_mesh[2],
53 const double nodesDistAC_mesh[2],
const double nodesDistBC_mesh[2],
double meshDet)
56 for (
int family = 0; family < 2; family++) {
57 const int component = 1 - family;
58 const double sum = nodesDistAB_mesh[component] * nodesDistAB_mesh[component]
59 + nodesDistAC_mesh[component] * nodesDistAC_mesh[component]
60 + nodesDistBC_mesh[component] * nodesDistBC_mesh[component];
61 stiffness = std::max(stiffness, eA / barL0 * sum / (2 * std::abs(meshDet)));
70inline double PanelTensionDampingTime(
double dampingRatio,
double eA,
double barL0,
71 const double nodesDistAB_mesh[2],
const double nodesDistAC_mesh[2],
const double nodesDistBC_mesh[2],
72 double meshDet,
double panelInertia)
74 const double stiffness = PanelStiffness(eA, barL0, nodesDistAB_mesh, nodesDistAC_mesh, nodesDistBC_mesh, meshDet);
75 if (!(stiffness > 0))
return 0.0;
76 return 2 * dampingRatio * std::sqrt(panelInertia / 3 / stiffness);
138void CalcLocalUVComponents(
const PanelParams& params,
const T distAB_panel[3],
139 const T distAC_panel[3], T meshBarComp[6], T meshBarLength[2])
145 meshBarComp[2] = T(0.0);
148 meshBarComp[5] = T(0.0);
150 meshBarLength[0] = sfh::math::Max(
151 sqrt(meshBarComp[0] * meshBarComp[0] + meshBarComp[1] * meshBarComp[1]),
152 T(kMinMeshBarLength));
153 meshBarLength[1] = sfh::math::Max(
154 sqrt(meshBarComp[3] * meshBarComp[3] + meshBarComp[4] * meshBarComp[4]),
155 T(kMinMeshBarLength));
170void CalcBarRates(
const PanelParams& params,
const PanelFrame<T>& frame,
const T*
const velA_ned,
171 const T*
const velB_ned,
const T*
const velC_ned, T barRate[2])
173 T velAB_ned[3], velAC_ned[3], velAB_panel[3], velAC_panel[3], barVelComp[6], unusedLength[2];
174 sfh::math::ArraySubtract(velB_ned, velA_ned, velAB_ned, 3ul);
175 sfh::math::ArraySubtract(velC_ned, velA_ned, velAC_ned, 3ul);
176 sfh::sim::RotateToLocal(velAB_ned, frame.R_ned2panel, velAB_panel);
177 sfh::sim::RotateToLocal(velAC_ned, frame.R_ned2panel, velAC_panel);
178 CalcLocalUVComponents(params, velAB_panel, velAC_panel, barVelComp, unusedLength);
179 for (
int family = 0; family < 2; family++) {
180 const int offset = 3 * family;
181 barRate[family] = (frame.meshBarComp[offset] * barVelComp[offset]
182 + frame.meshBarComp[offset + 1] * barVelComp[offset + 1]) / frame.meshBarLength[family];
197PanelFrame<T> ComputePanelFrame(
const PanelParams& params,
const T*
const posA_ned,
198 const T*
const posB_ned,
const T*
const posC_ned)
204 sfh::sim::RMatrixFromThreePoints(posA_ned, posB_ned, posC_ned, frame.R_ned2panel);
208 T distAB_ned[3], distAC_ned[3];
209 T distAB_panel[3], distAC_panel[3];
210 sfh::math::ArraySubtract(posB_ned, posA_ned, distAB_ned, 3ul);
211 sfh::math::ArraySubtract(posC_ned, posA_ned, distAC_ned, 3ul);
212 sfh::sim::RotateToLocal(distAB_ned, frame.R_ned2panel, distAB_panel);
213 sfh::sim::RotateToLocal(distAC_ned, frame.R_ned2panel, distAC_panel);
215 CalcLocalUVComponents(params, distAB_panel, distAC_panel, frame.meshBarComp,
216 frame.meshBarLength);
221 T normBarCompU = T(0);
222 T normBarCompV = T(0);
223 for (
int i = 0; i < 3; i++) {
224 normBarCompU += frame.meshBarComp[i] * frame.meshBarComp[i];
225 normBarCompV += frame.meshBarComp[i + 3] * frame.meshBarComp[i + 3];
227 normBarCompU = sqrt(normBarCompU);
228 normBarCompV = sqrt(normBarCompV);
230 frame.meshOpeningAngle = 0.5 * acos(sfh::linalg::Dot(frame.meshBarComp, frame.meshBarComp + 3, 2ul) / (normBarCompU * normBarCompV));
231 if (!(frame.meshOpeningAngle == frame.meshOpeningAngle)) frame.meshOpeningAngle = T(0);
234 frame.area = 0.5 * sfh::math::Abs(distAB_panel[0] * distAC_panel[1] - distAB_panel[1] * distAC_panel[0]);
248void CalcTensionForces(
const PanelParams& params,
const T meshBarComp[6],
249 const T meshBarLength[2],
const T barRate[2], T nodeATension_panel[3], T nodeBTension_panel[3],
250 T nodeCTension_panel[3])
255 for (
int family = 0; family < 2; family++) {
256 if (params.tensionDampingTime > 0) {
257 twineTension[family] = sfh::math::Max(
258 params.eATwine * (meshBarLength[family] - params.barL0 + params.tensionDampingTime * barRate[family]) / params.barL0,
262 twineTension[family] = (meshBarLength[family] > params.barL0)
263 ? params.eATwine * (meshBarLength[family] - params.barL0) / params.barL0
268 nodeATension_panel[0] = params.nodesDistBC_mesh[1] * twineTension[0] * meshBarComp[0] / (2 * meshBarLength[0]) - params.nodesDistBC_mesh[0] * twineTension[1] * meshBarComp[3] / (2 * meshBarLength[1]);
269 nodeATension_panel[1] = params.nodesDistBC_mesh[1] * twineTension[0] * meshBarComp[1] / (2 * meshBarLength[0]) - params.nodesDistBC_mesh[0] * twineTension[1] * meshBarComp[4] / (2 * meshBarLength[1]);
270 nodeATension_panel[2] = T(0.0);
272 nodeBTension_panel[0] = -params.nodesDistAC_mesh[1] * twineTension[0] * meshBarComp[0] / (2 * meshBarLength[0]) + params.nodesDistAC_mesh[0] * twineTension[1] * meshBarComp[3] / (2 * meshBarLength[1]);
273 nodeBTension_panel[1] = -params.nodesDistAC_mesh[1] * twineTension[0] * meshBarComp[1] / (2 * meshBarLength[0]) + params.nodesDistAC_mesh[0] * twineTension[1] * meshBarComp[4] / (2 * meshBarLength[1]);
274 nodeBTension_panel[2] = T(0.0);
276 nodeCTension_panel[0] = params.nodesDistAB_mesh[1] * twineTension[0] * meshBarComp[0] / (2 * meshBarLength[0]) - params.nodesDistAB_mesh[0] * twineTension[1] * meshBarComp[3] / (2 * meshBarLength[1]);
277 nodeCTension_panel[1] = params.nodesDistAB_mesh[1] * twineTension[0] * meshBarComp[1] / (2 * meshBarLength[0]) - params.nodesDistAB_mesh[0] * twineTension[1] * meshBarComp[4] / (2 * meshBarLength[1]);
278 nodeCTension_panel[2] = T(0.0);
299hydrodynamics::PanelLoad<T> EvaluatePanelLoad(
const PanelParams& params,
const PanelFrame<T>& frame,
300 const hydrodynamics::PanelLoadLaw& law,
const hydrodynamics::Fluid& fluid,
const T& solidity,
301 const T elementVel_ned[3],
const T*
const waterVel_ned)
303 hydrodynamics::PanelGeometry<T> geometry;
304 geometry.area = frame.area;
306 hydrodynamics::Netting<T> netting;
307 netting.solidity = solidity;
308 netting.twineThickness = params.barD;
309 netting.hasBarDirections = params.meshDet != 0;
310 netting.barLength = params.barL0;
311 netting.knotDiameter = params.knotDiameter;
312 netting.numBarsU = params.numBarsU;
313 netting.numBarsV = params.numBarsV;
314 netting.numKnots = params.numKnots;
316 hydrodynamics::FlowSample<T> flow;
317 flow.reference = kFlowReference;
319 for (
int i = 0; i < 3; i++) {
320 geometry.normal[i] = frame.R_ned2panel[i][2];
321 flow.relativeVelocity[i] = waterVel_ned[i] - elementVel_ned[i];
324 const T barU = frame.R_ned2panel[i][0] * frame.meshBarComp[0] + frame.R_ned2panel[i][1] * frame.meshBarComp[1];
325 const T barV = frame.R_ned2panel[i][0] * frame.meshBarComp[3] + frame.R_ned2panel[i][1] * frame.meshBarComp[4];
326 netting.barU[i] = barU / frame.meshBarLength[0];
327 netting.barV[i] = barV / frame.meshBarLength[1];
330 return hydrodynamics::Evaluate(law, geometry, netting, fluid, flow);
336void CalcDampingForces(
const PanelParams& params,
const T elementVel_ned[3],
337 const T*
const velA_ned,
const T*
const velB_ned,
const T*
const velC_ned,
338 T dampingForcesNodeA_ned[3], T dampingForcesNodeB_ned[3],
339 T dampingForcesNodeC_ned[3])
341 for (
unsigned short i = 0; i < 3; i++) {
342 dampingForcesNodeA_ned[i] = params.dampingCoeff * (elementVel_ned[i] - velA_ned[i]);
343 dampingForcesNodeB_ned[i] = params.dampingCoeff * (elementVel_ned[i] - velB_ned[i]);
344 dampingForcesNodeC_ned[i] = params.dampingCoeff * (elementVel_ned[i] - velC_ned[i]);
371bool AddNodeForces(
const PanelParams& params,
const PanelFrame<T>& frame,
372 const hydrodynamics::PanelLoadLaw& law,
const hydrodynamics::Fluid& fluid,
const T& solidity,
373 const T*
const velA_ned,
const T*
const velB_ned,
const T*
const velC_ned,
374 const T*
const waterVel_ned, T*
const nodeAforce_ned, T*
const nodeBforce_ned,
375 T*
const nodeCforce_ned,
376 const hydrodynamics::PanelClampLog* clampLog =
nullptr)
378 T nodeATension_panel[3] = {T(0), T(0), T(0)};
379 T nodeBTension_panel[3] = {T(0), T(0), T(0)};
380 T nodeCTension_panel[3] = {T(0), T(0), T(0)};
381 if (params.twineStructure) {
383 CalcBarRates(params, frame, velA_ned, velB_ned, velC_ned, barRate);
384 CalcTensionForces(params, frame.meshBarComp, frame.meshBarLength, barRate, nodeATension_panel,
385 nodeBTension_panel, nodeCTension_panel);
389 for (
int i = 0; i < 3; i++) {
390 elementVel_ned[i] = (velA_ned[i] + velB_ned[i] + velC_ned[i]) / 3.0;
393 const hydrodynamics::PanelLoad<T> load =
394 EvaluatePanelLoad(params, frame, law, fluid, solidity, elementVel_ned, waterVel_ned);
396 clampLog->Note(load.flags);
398 T dampingForcesNodeA_ned[3] = {T(0), T(0), T(0)};
399 T dampingForcesNodeB_ned[3] = {T(0), T(0), T(0)};
400 T dampingForcesNodeC_ned[3] = {T(0), T(0), T(0)};
401 if (params.twineStructure) {
402 CalcDampingForces(params, elementVel_ned, velA_ned, velB_ned, velC_ned,
403 dampingForcesNodeA_ned, dampingForcesNodeB_ned, dampingForcesNodeC_ned);
406 sfh::sim::RotateFromLocalAndAdd(nodeATension_panel, frame.R_ned2panel, nodeAforce_ned);
407 sfh::sim::RotateFromLocalAndAdd(nodeBTension_panel, frame.R_ned2panel, nodeBforce_ned);
408 sfh::sim::RotateFromLocalAndAdd(nodeCTension_panel, frame.R_ned2panel, nodeCforce_ned);
412 for (
int i = 0; i < 3; i++) {
413 const T hydroForcePerNode = load.force[i] / 3.0;
414 nodeAforce_ned[i] += hydroForcePerNode;
415 nodeBforce_ned[i] += hydroForcePerNode;
416 nodeCforce_ned[i] += hydroForcePerNode;
420 nodeAforce_ned[2] += params.NodeWeight;
421 nodeBforce_ned[2] += params.NodeWeight;
422 nodeCforce_ned[2] += params.NodeWeight;
424 if (params.twineStructure) {
425 for (
unsigned short i = 0; i < 3; i++) {
426 nodeAforce_ned[i] += dampingForcesNodeA_ned[i];
427 nodeBforce_ned[i] += dampingForcesNodeB_ned[i];
428 nodeCforce_ned[i] += dampingForcesNodeC_ned[i];
434 if constexpr (std::is_same_v<T, double>) {
435 const unsigned long none =
static_cast<unsigned long>(-1);
436 return sfh::util::FindBadValues(nodeAforce_ned, 3) == none && sfh::util::FindBadValues(nodeBforce_ned, 3) == none && sfh::util::FindBadValues(nodeCforce_ned, 3) == none;
Definition NetElement3NForces.h:118
T meshBarComp[6]
The u-bar in [0..2] and the v-bar in [3..5], panel frame.
Definition NetElement3NForces.h:120
T meshOpeningAngle
The mesh half opening angle, rad; 0 when undefined.
Definition NetElement3NForces.h:122
T R_ned2panel[3][3]
Columns: the panel x, y and z axes in the global frame.
Definition NetElement3NForces.h:119
T area
The element's area, m^2.
Definition NetElement3NForces.h:123
T meshBarLength[2]
The length of a u-bar and of a v-bar, bounded away from zero.
Definition NetElement3NForces.h:121
Definition NetElement3NForces.h:90
double meshDet
Mesh determinant, Priour (2005, Eq. 7); 0 for collinear corners.
Definition NetElement3NForces.h:94
double nodesDistBC_mesh[2]
Distance from node B to C in mesh (u,v) coordinates.
Definition NetElement3NForces.h:93
double tensionDampingTime
Definition NetElement3NForces.h:104
bool twineStructure
Definition NetElement3NForces.h:107
double knotDiameter
Diameter of the knots.
Definition NetElement3NForces.h:98
double eATwine
E-modulus times twine cross-sectional area.
Definition NetElement3NForces.h:96
double numKnots
Number of knots in the element, its number of meshes.
Definition NetElement3NForces.h:101
double nodesDistAB_mesh[2]
Distance from node A to B in mesh (u,v) coordinates.
Definition NetElement3NForces.h:91
double barD
Diameter of the twines.
Definition NetElement3NForces.h:97
double dampingCoeff
Coefficient of the isotropic relative-velocity damping, kg/s.
Definition NetElement3NForces.h:103
double NodeWeight
Weight in water carried by one node.
Definition NetElement3NForces.h:102
double barL0
Unstretched length of a mesh bar.
Definition NetElement3NForces.h:95
double numBarsV
Number of v-bars in the element, half its bar count.
Definition NetElement3NForces.h:100
double numBarsU
Number of u-bars in the element, half its bar count.
Definition NetElement3NForces.h:99
double nodesDistAC_mesh[2]
Distance from node A to C in mesh (u,v) coordinates.
Definition NetElement3NForces.h:92