moved from h4570/tyra

src/engine/models/math/plane.cpp

@@ -0,0 +1,50 @@
+/*
+# ______       ____   ___
+#   |     \/   ____| |___|    
+#   |     |   |   \  |   |       
+#-----------------------------------------------------------------------
+# Copyright 2020, tyra - https://github.com/h4570/tyra
+# Licenced under Apache License 2.0
+# Sandro Sobczyński <sandro.sobczynski@gmail.com>
+*/
+
+#include "../../include/models/math/plane.hpp"
+
+#include <stdio.h>
+
+// ----
+// Constructors/Destructors
+// ----
+
+/** Create empty plane */
+Plane::Plane() { this->distance = 0; }
+
+/** Create by specyfying 3 points.
+ * This function assumes that the points
+ * are given in counter clockwise order
+ */
+Plane::Plane(Vector3 &a, Vector3 &b, Vector3 &c) { this->update(a, b, c); }
+
+Plane::~Plane() {}
+
+// ----
+// Methods
+// ----
+
+/** Set plane by specyfying 3 points.
+ * This function assumes that the points
+ * are given in counter clockwise order
+ */
+void Plane::update(Vector3 &a, Vector3 &b, Vector3 &c)
+{
+    Vector3 aux1 = a - b;
+    Vector3 aux2 = c - b;
+    this->normal = aux2 * aux1;
+    this->normal.normalize();
+    this->distance = -this->normal.innerProduct(b);
+}
+
+void Plane::print()
+{
+    printf("Plane(Vector3(%f, %f, %f), %f)\n", this->normal.x, this->normal.y, this->normal.z, this->distance);
+}