From f9e6a6e37e1c2845f200496f2eaf724fb7253ec7 Mon Sep 17 00:00:00 2001
From: lisyarus <lisyarus@gmail.com>
Date: Sat, 25 Dec 2021 14:19:34 +0300
Subject: [PATCH] Add homogeneous matrix to affine/linear matrix conversion

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

diff --git a/libs/geom/include/psemek/geom/homogeneous.hpp b/libs/geom/include/psemek/geom/homogeneous.hpp
index cce0b495..6b828e90 100644
--- a/libs/geom/include/psemek/geom/homogeneous.hpp
+++ b/libs/geom/include/psemek/geom/homogeneous.hpp
@@ -62,4 +62,16 @@ namespace psemek::geom
 		return result;
 	}
 
+	template <typename T, std::size_t D>
+	matrix<T, D-1, D-1> homogeneous_to_linear(matrix<T, D, D> const & m)
+	{
+		return submatrix<0, 0, D-1, D-1>(m);
+	}
+
+	template <typename T, std::size_t D>
+	matrix<T, D-1, D> homogeneous_to_affine(matrix<T, D, D> const & m)
+	{
+		return submatrix<0, 0, D-1, D>(m);
+	}
+
 }