FhSim  3.1.0
Marine systems simulation
Loading...
Searching...
No Matches
SpeedBracket.h
1#pragma once
2
3#include <algorithm>
4#include <cstddef>
5#include <vector>
6
7namespace Ship
8{
15{
16 double lowSpeed = 0;
17 double highSpeed = 0;
18 int lowIndex = 0;
19 int highIndex = 0;
20 double lowWeight = 1;
21};
22
24inline SpeedBracket BracketSpeed(const std::vector<double>& speeds, double shipSpeed)
25{
26 SpeedBracket bracket;
27 const int count = static_cast<int>(speeds.size());
28 if (count < 2) {
29 bracket.lowSpeed = speeds.empty() ? 0.0 : speeds[0];
30 bracket.highSpeed = bracket.lowSpeed;
31 return bracket;
32 }
33 const double clamped = std::min(std::max(shipSpeed, speeds.front()), speeds.back());
34
35 // the last interval whose upper speed is above the ship speed; the top interval for a speed at or above the last
36 int low = 0;
37 while (low < count - 2 && speeds[low + 1] <= clamped) {
38 ++low;
39 }
40 bracket.lowIndex = low;
41 bracket.highIndex = low + 1;
42 bracket.lowSpeed = speeds[low];
43 bracket.highSpeed = speeds[low + 1];
44 if (bracket.highSpeed > bracket.lowSpeed) {
45 bracket.lowWeight = 1.0 - (clamped - bracket.lowSpeed) / (bracket.highSpeed - bracket.lowSpeed);
46 }
47 return bracket;
48}
49}
Superclass of control algorithms for the control system.
Definition CableAttach.h:58
SpeedBracket BracketSpeed(const std::vector< double > &speeds, double shipSpeed)
speeds must be ascending and not empty.
Definition SpeedBracket.h:24
Definition SpeedBracket.h:15