Large Restructure and Organization

include/J3ML/LinearAlgebra/Vector3.h

@@ -1,5 +1,6 @@
 #pragma once
 
+#include <J3ML/LinearAlgebra/Vector2.h>
 #include <J3ML/LinearAlgebra/Vector3.h>
 #include <cstddef>
 #include <cstdlib>
@@ -12,6 +13,8 @@ namespace J3ML::LinearAlgebra {
 class Vector3 {
 public:
 
+    enum {Dimensions = 3};
+
     // Default Constructor - Initializes to zero
     Vector3();
     // Constructs a new Vector3 with the value (X, Y, Z)
@@ -19,7 +22,7 @@ public:
     Vector3(const Vector3& rhs); // Copy Constructor
     Vector3(Vector3&&) = default; // Move Constructor
     Vector3& operator=(const Vector3& rhs);
-
+    explicit Vector3(const float* data);
 
     static const Vector3 Zero;
     static const Vector3 Up;
@@ -32,17 +35,9 @@ public:
     static const Vector3 Infinity;
     static const Vector3 NegativeInfinity;
 
-    float* ptr()
-    {
-        return &x;
-    }
+    float* ptr();
 
-    static void Orthonormalize(Vector3& a, Vector3& b)
-    {
-        a = a.Normalize();
-        b = b - b.ProjectToNorm(a);
-        b = b.Normalize();
-    }
+    static void Orthonormalize(Vector3& a, Vector3& b);
 
     Vector3 Abs() const;
 
@@ -51,25 +46,14 @@ public:
     static Vector3 Direction(const Vector3 &rhs) ;
 
 
-    static void Orthonormalize(Vector3& a, Vector3& b, Vector3& c)
-    {
-        a = a.Normalize();
-        b = b - b.ProjectToNorm(a);
-        b = b.Normalize();
-        c = c - c.ProjectToNorm(a);
-        c = c - c.ProjectToNorm(b);
-        c = c.Normalize();
-    }
+    static void Orthonormalize(Vector3& a, Vector3& b, Vector3& c);
 
     bool AreOrthonormal(const Vector3& a, const Vector3& b, float epsilon)
     {
 
     }
 
-    Vector3 ProjectToNorm(const Vector3& direction)
-    {
-        return direction * this->Dot(direction);
-    }
+    Vector3 ProjectToNorm(const Vector3& direction) const;
 
     float GetX() const;
     float GetY() const;
@@ -88,10 +72,7 @@ public:
     bool operator == (const Vector3& rhs) const;
     bool operator != (const Vector3& rhs) const;
 
-    bool IsFinite() const
-    {
-        return std::isfinite(x) && std::isfinite(y) && std::isfinite(z);
-    }
+    bool IsFinite() const;
 
     Vector3 Min(const Vector3& min) const;
     static Vector3 Min(const Vector3& lhs, const Vector3& rhs);
@@ -106,6 +87,9 @@ public:
     float Distance(const Vector3& to) const;
     static float Distance(const Vector3& from, const Vector3& to);
 
+    float DistanceSquared(const Vector3& to) const;
+    static float DistanceSquared(const Vector3& from, const Vector3& to);
+
     float Length() const;
     static float Length(const Vector3& of);