Initial revision
[blender.git] / intern / moto / include / MT_Vector3.inl
1 #include "MT_Optimize.h"
2
3 GEN_INLINE MT_Vector3& MT_Vector3::operator+=(const MT_Vector3& v) {
4     m_co[0] += v[0]; m_co[1] += v[1]; m_co[2] += v[2];
5     return *this;
6 }
7
8 GEN_INLINE MT_Vector3& MT_Vector3::operator-=(const MT_Vector3& v) {
9     m_co[0] -= v[0]; m_co[1] -= v[1]; m_co[2] -= v[2];
10     return *this;
11 }
12  
13 GEN_INLINE MT_Vector3& MT_Vector3::operator*=(MT_Scalar s) {
14     m_co[0] *= s; m_co[1] *= s; m_co[2] *= s;
15     return *this;
16 }
17
18 GEN_INLINE MT_Vector3& MT_Vector3::operator/=(MT_Scalar s) {
19     MT_assert(!MT_fuzzyZero(s));
20     return *this *= MT_Scalar(1.0) / s;
21 }
22
23 GEN_INLINE MT_Vector3 operator+(const MT_Vector3& v1, const MT_Vector3& v2) {
24     return MT_Vector3(v1[0] + v2[0], v1[1] + v2[1], v1[2] + v2[2]);
25 }
26
27 GEN_INLINE MT_Vector3 operator-(const MT_Vector3& v1, const MT_Vector3& v2) {
28     return MT_Vector3(v1[0] - v2[0], v1[1] - v2[1], v1[2] - v2[2]);
29 }
30
31 GEN_INLINE MT_Vector3 operator-(const MT_Vector3& v) {
32     return MT_Vector3(-v[0], -v[1], -v[2]);
33 }
34
35 GEN_INLINE MT_Vector3 operator*(const MT_Vector3& v, MT_Scalar s) {
36     return MT_Vector3(v[0] * s, v[1] * s, v[2] * s);
37 }
38
39 GEN_INLINE MT_Vector3 operator*(MT_Scalar s, const MT_Vector3& v) { return v * s; }
40
41 GEN_INLINE MT_Vector3 operator/(const MT_Vector3& v, MT_Scalar s) {
42     MT_assert(!MT_fuzzyZero(s));
43     return v * (MT_Scalar(1.0) / s);
44 }
45
46 GEN_INLINE MT_Vector3 operator*(const MT_Vector3& v1, const MT_Vector3& v2) {
47     return MT_Vector3(v1[0] * v2[0], v1[1] * v2[1], v1[2] * v2[2]);
48 }
49
50 GEN_INLINE MT_Scalar MT_Vector3::dot(const MT_Vector3& v) const {
51     return m_co[0] * v[0] + m_co[1] * v[1] + m_co[2] * v[2];
52 }
53
54 GEN_INLINE MT_Scalar MT_Vector3::length2() const { return dot(*this); }
55 GEN_INLINE MT_Scalar MT_Vector3::length() const { return sqrt(length2()); }
56
57 GEN_INLINE MT_Vector3 MT_Vector3::absolute() const {
58     return MT_Vector3(MT_abs(m_co[0]), MT_abs(m_co[1]), MT_abs(m_co[2]));
59 }
60
61 GEN_INLINE bool MT_Vector3::fuzzyZero() const {
62         return MT_fuzzyZero(length2());
63 }
64
65 GEN_INLINE void MT_Vector3::noiseGate(MT_Scalar threshold) {
66     if (length2() < threshold) {
67         setValue(MT_Scalar(0.0), MT_Scalar(0.0), MT_Scalar(0.0));
68     }
69 }
70
71 GEN_INLINE void MT_Vector3::normalize() { *this /= length(); }
72 GEN_INLINE MT_Vector3 MT_Vector3::normalized() const { return *this / length(); }
73 GEN_INLINE MT_Vector3 MT_Vector3::safe_normalized() const { 
74         MT_Scalar len = length();
75         return MT_fuzzyZero(len) ? 
76         MT_Vector3(MT_Scalar(1.0), MT_Scalar(0.0), MT_Scalar(0.0)) : 
77         *this / len; 
78 }
79
80 GEN_INLINE void MT_Vector3::scale(MT_Scalar x, MT_Scalar y, MT_Scalar z) {
81     m_co[0] *= x; m_co[1] *= y; m_co[2] *= z;
82 }
83
84 GEN_INLINE MT_Vector3 MT_Vector3::scaled(MT_Scalar x, MT_Scalar y, MT_Scalar z) const {
85     return MT_Vector3(m_co[0] * x, m_co[1] * y, m_co[2] * z);
86 }
87
88 GEN_INLINE MT_Scalar MT_Vector3::angle(const MT_Vector3& v) const {
89     MT_Scalar s = sqrt(length2() * v.length2());
90     MT_assert(!MT_fuzzyZero(s));
91     return acos(dot(v) / s);
92 }
93
94 GEN_INLINE MT_Vector3 MT_Vector3::cross(const MT_Vector3& v) const {
95     return MT_Vector3(m_co[1] * v[2] - m_co[2] * v[1],
96                       m_co[2] * v[0] - m_co[0] * v[2],
97                       m_co[0] * v[1] - m_co[1] * v[0]);
98 }
99
100 GEN_INLINE MT_Scalar MT_Vector3::triple(const MT_Vector3& v1, const MT_Vector3& v2) const {
101     return m_co[0] * (v1[1] * v2[2] - v1[2] * v2[1]) + 
102            m_co[1] * (v1[2] * v2[0] - v1[0] * v2[2]) + 
103            m_co[2] * (v1[0] * v2[1] - v1[1] * v2[0]);
104 }
105
106 GEN_INLINE int MT_Vector3::closestAxis() const {
107     MT_Vector3 a = absolute();
108     return a[0] < a[1] ? (a[1] < a[2] ? 2 : 1) : (a[0] < a[2] ? 2 : 0);
109 }
110
111 GEN_INLINE MT_Vector3 MT_Vector3::random() {
112     MT_Scalar z = MT_Scalar(2.0) * MT_random() - MT_Scalar(1.0);
113     MT_Scalar r = sqrt(MT_Scalar(1.0) - z * z);
114     MT_Scalar t = MT_2_PI * MT_random();
115     return MT_Vector3(r * cos(t), r * sin(t), z);
116 }
117
118 GEN_INLINE MT_Scalar  MT_dot(const MT_Vector3& v1, const MT_Vector3& v2) { 
119     return v1.dot(v2);
120 }
121
122 GEN_INLINE MT_Scalar  MT_length2(const MT_Vector3& v) { return v.length2(); }
123 GEN_INLINE MT_Scalar  MT_length(const MT_Vector3& v) { return v.length(); }
124
125 GEN_INLINE bool       MT_fuzzyZero(const MT_Vector3& v) { return v.fuzzyZero(); }
126 GEN_INLINE bool       MT_fuzzyEqual(const MT_Vector3& v1, const MT_Vector3& v2) { 
127     return MT_fuzzyZero(v1 - v2); 
128 }
129
130 GEN_INLINE MT_Scalar  MT_angle(const MT_Vector3& v1, const MT_Vector3& v2) { return v1.angle(v2); }
131 GEN_INLINE MT_Vector3 MT_cross(const MT_Vector3& v1, const MT_Vector3& v2) { return v1.cross(v2); }
132 GEN_INLINE MT_Scalar  MT_triple(const MT_Vector3& v1, const MT_Vector3& v2, const MT_Vector3& v3) {
133     return v1.triple(v2, v3);
134 }