aboutsummaryrefslogtreecommitdiffstats
path: root/src/include/glm/gtx/orthonormalize.inl
diff options
context:
space:
mode:
Diffstat (limited to 'src/include/glm/gtx/orthonormalize.inl')
-rw-r--r--src/include/glm/gtx/orthonormalize.inl29
1 files changed, 29 insertions, 0 deletions
diff --git a/src/include/glm/gtx/orthonormalize.inl b/src/include/glm/gtx/orthonormalize.inl
new file mode 100644
index 0000000..7ebe0fa
--- /dev/null
+++ b/src/include/glm/gtx/orthonormalize.inl
@@ -0,0 +1,29 @@
+/// @ref gtx_orthonormalize
+
+namespace glm
+{
+ template<typename T, qualifier Q>
+ GLM_FUNC_QUALIFIER mat<3, 3, T, Q> orthonormalize(mat<3, 3, T, Q> const& m)
+ {
+ mat<3, 3, T, Q> r = m;
+
+ r[0] = normalize(r[0]);
+
+ T d0 = dot(r[0], r[1]);
+ r[1] -= r[0] * d0;
+ r[1] = normalize(r[1]);
+
+ T d1 = dot(r[1], r[2]);
+ d0 = dot(r[0], r[2]);
+ r[2] -= r[0] * d0 + r[1] * d1;
+ r[2] = normalize(r[2]);
+
+ return r;
+ }
+
+ template<typename T, qualifier Q>
+ GLM_FUNC_QUALIFIER vec<3, T, Q> orthonormalize(vec<3, T, Q> const& x, vec<3, T, Q> const& y)
+ {
+ return normalize(x - y * dot(y, x));
+ }
+}//namespace glm