summaryrefslogtreecommitdiff
path: root/src/glm/gtx/orthonormalize.inl
blob: 929360670e8374a8757b6faa26f6c8c7aa56050a (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
///////////////////////////////////////////////////////////////////////////////////////////////////
// OpenGL Mathematics Copyright (c) 2005 - 2011 G-Truc Creation (www.g-truc.net)
///////////////////////////////////////////////////////////////////////////////////////////////////
// Created : 2005-12-21
// Updated : 2005-12-21
// Licence : This source is under MIT License
// File    : glm/gtx/orthonormalize.inl
///////////////////////////////////////////////////////////////////////////////////////////////////

namespace glm{
namespace gtx{
namespace orthonormalize{

    template <typename T>
    GLM_FUNC_QUALIFIER detail::tmat3x3<T> orthonormalize
	(
		const detail::tmat3x3<T>& m
	)
    {
        detail::tmat3x3<T> r = m;

        r[0] = normalize(r[0]);

	    float d0 = dot(r[0], r[1]);
	    r[1] -= r[0] * d0;
	    r[1] = normalize(r[1]);

	    float 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> 
    GLM_FUNC_QUALIFIER detail::tvec3<T> orthonormalize
	(
		const detail::tvec3<T>& x, 
		const detail::tvec3<T>& y
	)
    {
        return normalize(x - y * dot(y, x));
    }

}//namespace orthonormalize
}//namespace gtx
}//namespace glm