1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
|
#include "RateLimiter.h"
#include "RateLimiterForm.h"
RateLimiter::RateLimiter(int id) : ControlElement(id)
{
m_width = m_height = 36.0;
Node* nodeIn = new Node(m_position + wxPoint2DDouble(-18, 0), Node::NODE_IN, m_borderSize);
nodeIn->StartMove(m_position);
Node* nodeOut = new Node(m_position + wxPoint2DDouble(18, 0), Node::NODE_OUT, m_borderSize);
nodeOut->SetAngle(180.0);
nodeOut->StartMove(m_position);
m_nodeList.push_back(nodeIn);
m_nodeList.push_back(nodeOut);
}
RateLimiter::~RateLimiter() {}
void RateLimiter::Draw(wxPoint2DDouble translation, double scale) const
{
glLineWidth(1.0);
if(m_selected) {
glColor4dv(m_selectionColour.GetRGBA());
double borderSize = (m_borderSize * 2.0 + 1.0) / scale;
DrawRectangle(m_position, m_width + borderSize, m_height + borderSize);
}
glColor4d(1.0, 1.0, 1.0, 1.0);
DrawRectangle(m_position, m_width, m_height);
glColor4d(0.0, 0.0, 0.0, 1.0);
DrawRectangle(m_position, m_width, m_height, GL_LINE_LOOP);
// Plot symbol.
std::vector<wxPoint2DDouble> axis;
axis.push_back(m_position + wxPoint2DDouble(-13, 0));
axis.push_back(m_position + wxPoint2DDouble(13, 0));
axis.push_back(m_position + wxPoint2DDouble(0, -13));
axis.push_back(m_position + wxPoint2DDouble(0, 13));
DrawLine(axis, GL_LINES);
glLineWidth(2.0);
std::vector<wxPoint2DDouble> limSymbol;
limSymbol.push_back(m_position + wxPoint2DDouble(10, -10));
limSymbol.push_back(m_position + wxPoint2DDouble(-10, 10));
glColor4d(0.0, 0.3, 1.0, 1.0);
DrawLine(limSymbol);
glColor4d(0.0, 0.0, 0.0, 1.0);
DrawNodes();
}
bool RateLimiter::ShowForm(wxWindow* parent, Element* element)
{
RateLimiterForm* form = new RateLimiterForm(parent, this);
if(form->ShowModal() == wxID_OK) {
form->Destroy();
return true;
}
form->Destroy();
return false;
}
void RateLimiter::Rotate(bool clockwise)
{
if(clockwise)
m_angle += 90.0;
else
m_angle -= 90.0;
if(m_angle >= 360.0)
m_angle = 0.0;
else if(m_angle < 0)
m_angle = 270.0;
UpdatePoints();
for(auto it = m_nodeList.begin(), itEnd = m_nodeList.end(); it != itEnd; ++it) {
Node* node = *it;
node->Rotate(clockwise);
}
}
void RateLimiter::UpdatePoints()
{
if(m_angle == 0.0) {
m_nodeList[0]->SetPosition(m_position + wxPoint2DDouble(-18, 0));
m_nodeList[1]->SetPosition(m_position + wxPoint2DDouble(18, 0));
} else if(m_angle == 90.0) {
m_nodeList[0]->SetPosition(m_position + wxPoint2DDouble(0, -18));
m_nodeList[1]->SetPosition(m_position + wxPoint2DDouble(0, 18));
} else if(m_angle == 180.0) {
m_nodeList[0]->SetPosition(m_position + wxPoint2DDouble(18, 0));
m_nodeList[1]->SetPosition(m_position + wxPoint2DDouble(-18, 0));
} else if(m_angle == 270.0) {
m_nodeList[0]->SetPosition(m_position + wxPoint2DDouble(0, 18));
m_nodeList[1]->SetPosition(m_position + wxPoint2DDouble(0, -18));
}
}
bool RateLimiter::Solve(double input, double timeStep)
{
double rate = (input - m_output) / timeStep;
bool reachLimit = false;
if(rate > m_upLimit) {
rate = m_upLimit;
reachLimit = true;
} else if(rate < m_lowLimit) {
rate = m_lowLimit;
reachLimit = true;
}
if(reachLimit)
m_output += rate * timeStep;
else
m_output = input;
return true;
}
Element* RateLimiter::GetCopy()
{
RateLimiter* copy = new RateLimiter(m_elementID);
*copy = *this;
return copy;
}
|
