From 718d0c7d04db1db6fdeae85bd411d3a5831d992a Mon Sep 17 00:00:00 2001
From: lisyarus <lisyarus@gmail.com>
Date: Thu, 14 Mar 2024 12:54:12 +0300
Subject: [PATCH] Add geom::project_from

---
 libs/geom/include/psemek/geom/vector.hpp | 7 +++++++
 1 file changed, 7 insertions(+)

diff --git a/libs/geom/include/psemek/geom/vector.hpp b/libs/geom/include/psemek/geom/vector.hpp
index 08e58e66..b7ed4d1a 100644
--- a/libs/geom/include/psemek/geom/vector.hpp
+++ b/libs/geom/include/psemek/geom/vector.hpp
@@ -390,6 +390,13 @@ namespace psemek::geom
 		}
 	}
 
+	// Return vector orthogonal to n
+	template <typename T, std::size_t N>
+	vector<T, N> project_from(vector<T, N> const & v, vector<T, N> const & n)
+	{
+		return v - n * (dot(v, n) / dot(n, n));
+	}
+
 	template <typename T, std::size_t N>
 	std::ostream & operator << (std::ostream & os, vector<T, N> const & v)
 	{