Added cross productsHEADmaster

1 files changed, 26 insertions, 0 deletions

diff --git a/modules/codec/c++/math.hpp b/modules/codec/c++/math.hpp
index a8bbba1..6e1ec8b 100644
--- a/modules/codec/c++/math.hpp
+++ b/modules/codec/c++/math.hpp
@@ -81,5 +81,31 @@ data<schema::Vector<T,M>, Encoding> multiply(const data<schema::Matrix<T,M,N>, E
 
 	return lr;
 }
+
+template<typename T, typename Encoding = FORSTIO_DEFAULT_DATA_ENCODING>
+data<schema::Vector<T,3u>, Encoding> cross(
+	const data<schema::Vector<T,3u>, Encoding> lh,
+	const data<schema::Vector<T,3u>, Encoding> rh
+){
+	data<schema::Vector<T,3u>, Encoding> cross_prod;
+
+	cross_prod.at({{0u}}) = lh.at({{1u}}) * rh.at({{2u}}) - lh.at({{2u}}) * rh.at({{1u}});
+	cross_prod.at({{1u}}) = lh.at({{2u}}) * rh.at({{0u}}) - lh.at({{0u}}) * rh.at({{2u}});
+	cross_prod.at({{2u}}) = lh.at({{0u}}) * rh.at({{1u}}) - lh.at({{1u}}) * rh.at({{0u}});
+
+	return cross_prod;
+}
+
+template<typename T, typename Encoding = FORSTIO_DEFAULT_DATA_ENCODING>
+data<T,Encoding> cross(
+	const data<schema::Vector<T,2u>, Encoding> lh,
+	const data<schema::Vector<T,2u>, Encoding> rh
+){
+	data<T, Encoding> cross_prod;
+
+	cross_prod = lh.at({{0u}}) * rh.at({{1u}}) - lh.at({{1u}}) * rh.at({{0u}});
+
+	return cross_prod;
+}
 }
 }