1 files changed, 25 insertions, 5 deletions
diff --git a/lib/geometricPlane.h b/lib/geometricPlane.h
index c74beff..5be76ec 100644
--- a/lib/geometricPlane.h
+++ b/lib/geometricPlane.h
@@ -1,11 +1,12 @@
 #pragma once
 
 #include "config/types.h"
+#include "ray.h"
+#include <glm/geometric.hpp>
+#include <glm/gtx/intersect.hpp>
 #include <glm/vec3.hpp>
 #include <optional>
 
-class Ray;
-
 class GeometricPlane {
 public:
 	struct DistAndPosition {
@@ -17,8 +18,27 @@ public:
 	Position3D origin;
 	Normal3D normal;
 
-	[[nodiscard]] PlaneRelation getRelation(Position3D point) const;
-	[[nodiscard]] std::optional<DistAndPosition> getRayIntersectPosition(const Ray &) const;
+	[[nodiscard]] inline PlaneRelation
+	getRelation(Position3D point) const
+	{
+		const auto d = glm::dot(normal, point - origin);
+		return d < 0.F ? PlaneRelation::Below : d > 0.F ? PlaneRelation::Above : PlaneRelation::On;
+	}
+
+	[[nodiscard]] inline std::optional<DistAndPosition>
+	getRayIntersectPosition(const Ray & ray) const
+	{
+		float dist {};
+		if (!glm::intersectRayPlane(ray.start, ray.direction, origin, normal, dist)) {
+			return {};
+		}
+		return DistAndPosition {dist, ray.start + (ray.direction * dist)};
+	}
 
-	static bool isIntersect(PlaneRelation a, PlaneRelation b);
+	inline static bool
+	isIntersect(PlaneRelation a, PlaneRelation b)
+	{
+		return ((a == PlaneRelation::Above && b == PlaneRelation::Below)
+				|| (a == PlaneRelation::Below && b == PlaneRelation::Above));
+	}
 };