1 files changed, 132 insertions, 0 deletions
diff --git a/src/cWiremesh.cpp b/src/cWiremesh.cpp
new file mode 100644
index 0000000..62fee0d
--- /dev/null
+++ b/src/cWiremesh.cpp
@@ -0,0 +1,132 @@
+#include "cWiremesh.h"
+
+cWiremesh::cWiremesh() : position({0,0,0}), angle({0,0,0}) { }
+
+cWiremesh::~cWiremesh() { }
+
+void cWiremesh::addVector(sCoord3d _origin, sCoord3d _vector, char _char, WORD _color)
+{
+  vectors.push_back(sVector{_origin, _vector, _char, _color});
+}
+
+void cWiremesh::rotate(sCoord3d _val)
+{
+  angle = angle + _val;
+}
+
+void cWiremesh::reset()
+{
+  vectors.clear();
+}
+
+void cWiremesh::write(cRender *_render)
+{
+  if(!_render)
+    return;
+
+  sPos porigin = _render->getSize();
+  sCoord3d origin = {porigin.x / 2, porigin.y / 2, 0};
+
+  for(long unsigned int i = 0; i < vectors.size(); i++)
+  {
+    sCoord3d vorigin    = applyRotation(vectors[i].origin,    angle);
+    sCoord3d vdirection = applyRotation(vectors[i].direction, angle);
+
+    _render->drawLine(vectors[i].c,
+          translate(vorigin + position, origin),
+          translate(vorigin + vdirection + position, origin),
+          true, vectors[i].color);
+  }
+}
+
+sPos cWiremesh::translate(sCoord3d _coord, sCoord3d _origin)
+{
+  sPos ret;
+
+  ret.x = (int)((float)_coord.x - ((float)_coord.z / (float)_DEPTH * (float)(_coord.x - _origin.x)));
+  ret.y = (int)((float)_coord.y - ((float)_coord.z / (float)_DEPTH * (float)(_coord.y - _origin.y)));
+
+  return ret;
+}
+
+sCoord3d cWiremesh::getPosition()
+{
+  return position;
+}
+
+void cWiremesh::setPosition(int _x, int _y, int _z)
+{
+  position = {_x, _y, _z};
+}
+
+void cWiremesh::setPosition(sCoord3d _pos)
+{
+  position = _pos;
+}
+
+void cWiremesh::scale(float _scalar)
+{
+  for(unsigned long int i = 0; i < vectors.size(); i++)
+  {
+    vectors[i].origin.x = (int)((float)vectors[i].origin.x * _scalar);
+    vectors[i].origin.y = (int)((float)vectors[i].origin.y * _scalar);
+    vectors[i].origin.z = (int)((float)vectors[i].origin.z * _scalar);
+
+    vectors[i].direction.x = (int)((float)vectors[i].direction.x * _scalar);
+    vectors[i].direction.y = (int)((float)vectors[i].direction.y * _scalar);
+    vectors[i].direction.z = (int)((float)vectors[i].direction.z * _scalar);
+  }
+}
+
+sCoord3d cWiremesh::applyRotation(sCoord3d _vector, sCoord3d _angle)
+{
+  sCoord3d ret = _vector;
+
+  //Perform some algebra-magic
+  //couldn't be bothered to implement or use a matrix class
+
+  if(_angle.x)
+  {
+    float rads = (float)_angle.x * PI / 180.0;
+
+    ret.y = (int)(
+      (float)_vector.y * cos(rads) -
+      (float)_vector.z * sin(rads)
+    );
+    ret.z = (int)(
+      (float)_vector.y * sin(rads) +
+      (float)_vector.z * cos(rads)
+    );
+  }
+  if(_angle.y)
+  {
+    float rads = (float)_angle.y * PI / 180.0;
+    sCoord3d tmp = ret;
+
+    ret.x = (int)(
+      (float)tmp.x * cos(rads) +
+      (float)tmp.z * sin(rads)
+    );
+
+    ret.z = (int)(
+      - (float)tmp.x * sin(rads)
+      + (float)tmp.z * cos(rads)
+    );
+  }
+  if(_angle.z)
+  {
+    float rads = (float)_angle.z * PI / 180.0;
+    sCoord3d tmp = ret;
+
+    ret.x = (int) (
+      (float)tmp.x * cos(rads) -
+      (float)tmp.y * sin(rads)
+    );
+    ret.y = (int) (
+      (float)tmp.x * sin(rads) +
+      (float)tmp.y * cos(rads)
+    );
+  }
+
+  return ret;
+}