Merge pull request #40 from Thales1330/wip-mimo-control-system

Wip mimo control system

1 files changed, 76 insertions, 0 deletions

diff --git a/Project/Divider.cpp b/Project/Divider.cpp
new file mode 100644
index 0000000..2bd8251
--- /dev/null
+++ b/Project/Divider.cpp
@@ -0,0 +1,76 @@
+/*
+ *  Copyright (C) 2017  Thales Lima Oliveira <thales@ufu.br>
+ *
+ *  This program is free software; you can redistribute it and/or modify
+ *  it under the terms of the GNU General Public License as published by
+ *  the Free Software Foundation; either version 2 of the License, or
+ *  any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program.  If not, see <https://www.gnu.org/licenses/>.
+ */
+
+#include "Divider.h"
+#include "ConnectionLine.h"
+
+Divider::Divider(int id) : MathOperation(id) {}
+Divider::~Divider() {}
+void Divider::DrawSymbol() const
+{
+    // Plot divider.
+    glLineWidth(2.0);
+    std::vector<wxPoint2DDouble> mSymbol;
+    mSymbol.push_back(m_position + wxPoint2DDouble(-5, 0));
+    mSymbol.push_back(m_position + wxPoint2DDouble(5, 0));
+    glColor4d(0.0, 0.3, 1.0, 1.0);
+    DrawLine(mSymbol, GL_LINES);
+    DrawCircle(m_position + wxPoint2DDouble(0, -3), 2, 10, GL_POLYGON);
+    DrawCircle(m_position + wxPoint2DDouble(0, 3), 2, 10, GL_POLYGON);
+}
+
+bool Divider::Solve(double input, double timeStep)
+{
+    std::vector<double> inputVector;
+    for(auto itN = m_nodeList.begin(), itNEnd = m_nodeList.end(); itN != itNEnd; ++itN) {
+        Node* node = *itN;
+        if(node->GetNodeType() != Node::NODE_OUT) {
+            if(!node->IsConnected()) {
+                inputVector.push_back(0.0);
+            } else {
+                for(auto itC = m_childList.begin(), itCEnd = m_childList.end(); itC != itCEnd; ++itC) {
+                    ConnectionLine* cLine = static_cast<ConnectionLine*>(*itC);
+                    auto nodeList = cLine->GetNodeList();
+                    for(auto itCN = nodeList.begin(), itCNEnd = nodeList.end(); itCN != itCNEnd; ++itCN) {
+                        Node* childNode = *itCN;
+                        if(childNode == node) {
+                            inputVector.push_back(cLine->GetValue());
+                            break;
+                        }
+                    }
+                }
+            }
+        }
+    }
+    if(inputVector.size() != 2) return false;
+
+    // If the denominator is zero, set the output a big number (1e15).
+    if(std::abs(inputVector[1]) < 1e-15) {
+        m_output = 1e15;
+    } else {
+        m_output = inputVector[0] / inputVector[1];
+    }
+
+    return true;
+}
+
+Element* Divider::GetCopy()
+{
+    Divider* copy = new Divider(m_elementID);
+    *copy = *this;
+    return copy;
+}