rev |
line source |
nuclear@0
|
1 /*
|
nuclear@0
|
2 ---------------------------------------------------------------------------
|
nuclear@0
|
3 Open Asset Import Library (assimp)
|
nuclear@0
|
4 ---------------------------------------------------------------------------
|
nuclear@0
|
5
|
nuclear@0
|
6 Copyright (c) 2006-2018, assimp team
|
nuclear@0
|
7
|
nuclear@0
|
8
|
nuclear@0
|
9
|
nuclear@0
|
10 All rights reserved.
|
nuclear@0
|
11
|
nuclear@0
|
12 Redistribution and use of this software in source and binary forms,
|
nuclear@0
|
13 with or without modification, are permitted provided that the following
|
nuclear@0
|
14 conditions are met:
|
nuclear@0
|
15
|
nuclear@0
|
16 * Redistributions of source code must retain the above
|
nuclear@0
|
17 copyright notice, this list of conditions and the
|
nuclear@0
|
18 following disclaimer.
|
nuclear@0
|
19
|
nuclear@0
|
20 * Redistributions in binary form must reproduce the above
|
nuclear@0
|
21 copyright notice, this list of conditions and the
|
nuclear@0
|
22 following disclaimer in the documentation and/or other
|
nuclear@0
|
23 materials provided with the distribution.
|
nuclear@0
|
24
|
nuclear@0
|
25 * Neither the name of the assimp team, nor the names of its
|
nuclear@0
|
26 contributors may be used to endorse or promote products
|
nuclear@0
|
27 derived from this software without specific prior
|
nuclear@0
|
28 written permission of the assimp team.
|
nuclear@0
|
29
|
nuclear@0
|
30 THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
nuclear@0
|
31 "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
nuclear@0
|
32 LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
|
nuclear@0
|
33 A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
|
nuclear@0
|
34 OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
|
nuclear@0
|
35 SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
nuclear@0
|
36 LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
nuclear@0
|
37 DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
nuclear@0
|
38 THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
nuclear@0
|
39 (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
|
nuclear@0
|
40 OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
nuclear@0
|
41 ---------------------------------------------------------------------------
|
nuclear@0
|
42 */
|
nuclear@0
|
43
|
nuclear@0
|
44 /** @file vector3.inl
|
nuclear@0
|
45 * @brief Inline implementation of aiVector3t<TReal> operators
|
nuclear@0
|
46 */
|
nuclear@0
|
47 #pragma once
|
nuclear@0
|
48 #ifndef AI_VECTOR3D_INL_INC
|
nuclear@0
|
49 #define AI_VECTOR3D_INL_INC
|
nuclear@0
|
50
|
nuclear@0
|
51 #ifdef __cplusplus
|
nuclear@0
|
52 #include "vector3.h"
|
nuclear@0
|
53
|
nuclear@0
|
54 #include <cmath>
|
nuclear@0
|
55
|
nuclear@0
|
56 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
57 /** Transformation of a vector by a 3x3 matrix */
|
nuclear@0
|
58 template <typename TReal>
|
nuclear@0
|
59 AI_FORCE_INLINE
|
nuclear@0
|
60 aiVector3t<TReal> operator * (const aiMatrix3x3t<TReal>& pMatrix, const aiVector3t<TReal>& pVector) {
|
nuclear@0
|
61 aiVector3t<TReal> res;
|
nuclear@0
|
62 res.x = pMatrix.a1 * pVector.x + pMatrix.a2 * pVector.y + pMatrix.a3 * pVector.z;
|
nuclear@0
|
63 res.y = pMatrix.b1 * pVector.x + pMatrix.b2 * pVector.y + pMatrix.b3 * pVector.z;
|
nuclear@0
|
64 res.z = pMatrix.c1 * pVector.x + pMatrix.c2 * pVector.y + pMatrix.c3 * pVector.z;
|
nuclear@0
|
65 return res;
|
nuclear@0
|
66 }
|
nuclear@0
|
67
|
nuclear@0
|
68 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
69 /** Transformation of a vector by a 4x4 matrix */
|
nuclear@0
|
70 template <typename TReal>
|
nuclear@0
|
71 AI_FORCE_INLINE
|
nuclear@0
|
72 aiVector3t<TReal> operator * (const aiMatrix4x4t<TReal>& pMatrix, const aiVector3t<TReal>& pVector) {
|
nuclear@0
|
73 aiVector3t<TReal> res;
|
nuclear@0
|
74 res.x = pMatrix.a1 * pVector.x + pMatrix.a2 * pVector.y + pMatrix.a3 * pVector.z + pMatrix.a4;
|
nuclear@0
|
75 res.y = pMatrix.b1 * pVector.x + pMatrix.b2 * pVector.y + pMatrix.b3 * pVector.z + pMatrix.b4;
|
nuclear@0
|
76 res.z = pMatrix.c1 * pVector.x + pMatrix.c2 * pVector.y + pMatrix.c3 * pVector.z + pMatrix.c4;
|
nuclear@0
|
77 return res;
|
nuclear@0
|
78 }
|
nuclear@0
|
79 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
80 template <typename TReal>
|
nuclear@0
|
81 template <typename TOther>
|
nuclear@0
|
82 aiVector3t<TReal>::operator aiVector3t<TOther> () const {
|
nuclear@0
|
83 return aiVector3t<TOther>(static_cast<TOther>(x),static_cast<TOther>(y),static_cast<TOther>(z));
|
nuclear@0
|
84 }
|
nuclear@0
|
85 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
86 template <typename TReal>
|
nuclear@0
|
87 AI_FORCE_INLINE
|
nuclear@0
|
88 void aiVector3t<TReal>::Set( TReal pX, TReal pY, TReal pZ) {
|
nuclear@0
|
89 x = pX;
|
nuclear@0
|
90 y = pY;
|
nuclear@0
|
91 z = pZ;
|
nuclear@0
|
92 }
|
nuclear@0
|
93 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
94 template <typename TReal>
|
nuclear@0
|
95 AI_FORCE_INLINE
|
nuclear@0
|
96 TReal aiVector3t<TReal>::SquareLength() const {
|
nuclear@0
|
97 return x*x + y*y + z*z;
|
nuclear@0
|
98 }
|
nuclear@0
|
99 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
100 template <typename TReal>
|
nuclear@0
|
101 AI_FORCE_INLINE
|
nuclear@0
|
102 TReal aiVector3t<TReal>::Length() const {
|
nuclear@0
|
103 return std::sqrt( SquareLength());
|
nuclear@0
|
104 }
|
nuclear@0
|
105 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
106 template <typename TReal>
|
nuclear@0
|
107 AI_FORCE_INLINE
|
nuclear@0
|
108 aiVector3t<TReal>& aiVector3t<TReal>::Normalize() {
|
nuclear@0
|
109 *this /= Length();
|
nuclear@0
|
110
|
nuclear@0
|
111 return *this;
|
nuclear@0
|
112 }
|
nuclear@0
|
113 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
114 template <typename TReal>
|
nuclear@0
|
115 AI_FORCE_INLINE
|
nuclear@0
|
116 aiVector3t<TReal>& aiVector3t<TReal>::NormalizeSafe() {
|
nuclear@0
|
117 TReal len = Length();
|
nuclear@0
|
118 if ( len > static_cast< TReal >( 0 ) ) {
|
nuclear@0
|
119 *this /= len;
|
nuclear@0
|
120 }
|
nuclear@0
|
121 return *this;
|
nuclear@0
|
122 }
|
nuclear@0
|
123 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
124 template <typename TReal>
|
nuclear@0
|
125 AI_FORCE_INLINE
|
nuclear@0
|
126 const aiVector3t<TReal>& aiVector3t<TReal>::operator += (const aiVector3t<TReal>& o) {
|
nuclear@0
|
127 x += o.x;
|
nuclear@0
|
128 y += o.y;
|
nuclear@0
|
129 z += o.z;
|
nuclear@0
|
130
|
nuclear@0
|
131 return *this;
|
nuclear@0
|
132 }
|
nuclear@0
|
133 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
134 template <typename TReal>
|
nuclear@0
|
135 AI_FORCE_INLINE
|
nuclear@0
|
136 const aiVector3t<TReal>& aiVector3t<TReal>::operator -= (const aiVector3t<TReal>& o) {
|
nuclear@0
|
137 x -= o.x;
|
nuclear@0
|
138 y -= o.y;
|
nuclear@0
|
139 z -= o.z;
|
nuclear@0
|
140
|
nuclear@0
|
141 return *this;
|
nuclear@0
|
142 }
|
nuclear@0
|
143 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
144 template <typename TReal>
|
nuclear@0
|
145 AI_FORCE_INLINE
|
nuclear@0
|
146 const aiVector3t<TReal>& aiVector3t<TReal>::operator *= (TReal f) {
|
nuclear@0
|
147 x *= f;
|
nuclear@0
|
148 y *= f;
|
nuclear@0
|
149 z *= f;
|
nuclear@0
|
150
|
nuclear@0
|
151 return *this;
|
nuclear@0
|
152 }
|
nuclear@0
|
153 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
154 template <typename TReal>
|
nuclear@0
|
155 AI_FORCE_INLINE
|
nuclear@0
|
156 const aiVector3t<TReal>& aiVector3t<TReal>::operator /= (TReal f) {
|
nuclear@0
|
157 const TReal invF = (TReal) 1.0 / f;
|
nuclear@0
|
158 x *= invF;
|
nuclear@0
|
159 y *= invF;
|
nuclear@0
|
160 z *= invF;
|
nuclear@0
|
161
|
nuclear@0
|
162 return *this;
|
nuclear@0
|
163 }
|
nuclear@0
|
164 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
165 template <typename TReal>
|
nuclear@0
|
166 AI_FORCE_INLINE
|
nuclear@0
|
167 aiVector3t<TReal>& aiVector3t<TReal>::operator *= (const aiMatrix3x3t<TReal>& mat){
|
nuclear@0
|
168 return (*this = mat * (*this));
|
nuclear@0
|
169 }
|
nuclear@0
|
170 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
171 template <typename TReal>
|
nuclear@0
|
172 AI_FORCE_INLINE
|
nuclear@0
|
173 aiVector3t<TReal>& aiVector3t<TReal>::operator *= (const aiMatrix4x4t<TReal>& mat){
|
nuclear@0
|
174 return (*this = mat * (*this));
|
nuclear@0
|
175 }
|
nuclear@0
|
176 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
177 template <typename TReal>
|
nuclear@0
|
178 AI_FORCE_INLINE
|
nuclear@0
|
179 TReal aiVector3t<TReal>::operator[](unsigned int i) const {
|
nuclear@0
|
180 switch (i) {
|
nuclear@0
|
181 case 0:
|
nuclear@0
|
182 return x;
|
nuclear@0
|
183 case 1:
|
nuclear@0
|
184 return y;
|
nuclear@0
|
185 case 2:
|
nuclear@0
|
186 return z;
|
nuclear@0
|
187 default:
|
nuclear@0
|
188 break;
|
nuclear@0
|
189 }
|
nuclear@0
|
190 return x;
|
nuclear@0
|
191 }
|
nuclear@0
|
192 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
193 template <typename TReal>
|
nuclear@0
|
194 AI_FORCE_INLINE
|
nuclear@0
|
195 TReal& aiVector3t<TReal>::operator[](unsigned int i) {
|
nuclear@0
|
196 // return *(&x + i);
|
nuclear@0
|
197 switch (i) {
|
nuclear@0
|
198 case 0:
|
nuclear@0
|
199 return x;
|
nuclear@0
|
200 case 1:
|
nuclear@0
|
201 return y;
|
nuclear@0
|
202 case 2:
|
nuclear@0
|
203 return z;
|
nuclear@0
|
204 default:
|
nuclear@0
|
205 break;
|
nuclear@0
|
206 }
|
nuclear@0
|
207 return x;
|
nuclear@0
|
208 }
|
nuclear@0
|
209 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
210 template <typename TReal>
|
nuclear@0
|
211 AI_FORCE_INLINE
|
nuclear@0
|
212 bool aiVector3t<TReal>::operator== (const aiVector3t<TReal>& other) const {
|
nuclear@0
|
213 return x == other.x && y == other.y && z == other.z;
|
nuclear@0
|
214 }
|
nuclear@0
|
215 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
216 template <typename TReal>
|
nuclear@0
|
217 AI_FORCE_INLINE
|
nuclear@0
|
218 bool aiVector3t<TReal>::operator!= (const aiVector3t<TReal>& other) const {
|
nuclear@0
|
219 return x != other.x || y != other.y || z != other.z;
|
nuclear@0
|
220 }
|
nuclear@0
|
221 // ---------------------------------------------------------------------------
|
nuclear@0
|
222 template<typename TReal>
|
nuclear@0
|
223 AI_FORCE_INLINE
|
nuclear@0
|
224 bool aiVector3t<TReal>::Equal(const aiVector3t<TReal>& other, TReal epsilon) const {
|
nuclear@0
|
225 return
|
nuclear@0
|
226 std::abs(x - other.x) <= epsilon &&
|
nuclear@0
|
227 std::abs(y - other.y) <= epsilon &&
|
nuclear@0
|
228 std::abs(z - other.z) <= epsilon;
|
nuclear@0
|
229 }
|
nuclear@0
|
230 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
231 template <typename TReal>
|
nuclear@0
|
232 AI_FORCE_INLINE
|
nuclear@0
|
233 bool aiVector3t<TReal>::operator < (const aiVector3t<TReal>& other) const {
|
nuclear@0
|
234 return x != other.x ? x < other.x : y != other.y ? y < other.y : z < other.z;
|
nuclear@0
|
235 }
|
nuclear@0
|
236 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
237 template <typename TReal>
|
nuclear@0
|
238 AI_FORCE_INLINE
|
nuclear@0
|
239 const aiVector3t<TReal> aiVector3t<TReal>::SymMul(const aiVector3t<TReal>& o) {
|
nuclear@0
|
240 return aiVector3t<TReal>(x*o.x,y*o.y,z*o.z);
|
nuclear@0
|
241 }
|
nuclear@0
|
242 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
243 // symmetric addition
|
nuclear@0
|
244 template <typename TReal>
|
nuclear@0
|
245 AI_FORCE_INLINE
|
nuclear@0
|
246 aiVector3t<TReal> operator + (const aiVector3t<TReal>& v1, const aiVector3t<TReal>& v2) {
|
nuclear@0
|
247 return aiVector3t<TReal>( v1.x + v2.x, v1.y + v2.y, v1.z + v2.z);
|
nuclear@0
|
248 }
|
nuclear@0
|
249 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
250 // symmetric subtraction
|
nuclear@0
|
251 template <typename TReal>
|
nuclear@0
|
252 AI_FORCE_INLINE
|
nuclear@0
|
253 aiVector3t<TReal> operator - (const aiVector3t<TReal>& v1, const aiVector3t<TReal>& v2) {
|
nuclear@0
|
254 return aiVector3t<TReal>( v1.x - v2.x, v1.y - v2.y, v1.z - v2.z);
|
nuclear@0
|
255 }
|
nuclear@0
|
256 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
257 // scalar product
|
nuclear@0
|
258 template <typename TReal>
|
nuclear@0
|
259 AI_FORCE_INLINE
|
nuclear@0
|
260 TReal operator * (const aiVector3t<TReal>& v1, const aiVector3t<TReal>& v2) {
|
nuclear@0
|
261 return v1.x*v2.x + v1.y*v2.y + v1.z*v2.z;
|
nuclear@0
|
262 }
|
nuclear@0
|
263 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
264 // scalar multiplication
|
nuclear@0
|
265 template <typename TReal>
|
nuclear@0
|
266 AI_FORCE_INLINE
|
nuclear@0
|
267 aiVector3t<TReal> operator * ( TReal f, const aiVector3t<TReal>& v) {
|
nuclear@0
|
268 return aiVector3t<TReal>( f*v.x, f*v.y, f*v.z);
|
nuclear@0
|
269 }
|
nuclear@0
|
270 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
271 // and the other way around
|
nuclear@0
|
272 template <typename TReal>
|
nuclear@0
|
273 AI_FORCE_INLINE
|
nuclear@0
|
274 aiVector3t<TReal> operator * ( const aiVector3t<TReal>& v, TReal f) {
|
nuclear@0
|
275 return aiVector3t<TReal>( f*v.x, f*v.y, f*v.z);
|
nuclear@0
|
276 }
|
nuclear@0
|
277 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
278 // scalar division
|
nuclear@0
|
279 template <typename TReal>
|
nuclear@0
|
280 AI_FORCE_INLINE
|
nuclear@0
|
281 aiVector3t<TReal> operator / ( const aiVector3t<TReal>& v, TReal f) {
|
nuclear@0
|
282 return v * (1/f);
|
nuclear@0
|
283 }
|
nuclear@0
|
284 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
285 // vector division
|
nuclear@0
|
286 template <typename TReal>
|
nuclear@0
|
287 AI_FORCE_INLINE
|
nuclear@0
|
288 aiVector3t<TReal> operator / ( const aiVector3t<TReal>& v, const aiVector3t<TReal>& v2) {
|
nuclear@0
|
289 return aiVector3t<TReal>(v.x / v2.x,v.y / v2.y,v.z / v2.z);
|
nuclear@0
|
290 }
|
nuclear@0
|
291 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
292 // cross product
|
nuclear@0
|
293 template<typename TReal>
|
nuclear@0
|
294 AI_FORCE_INLINE
|
nuclear@0
|
295 aiVector3t<TReal> operator ^ ( const aiVector3t<TReal>& v1, const aiVector3t<TReal>& v2) {
|
nuclear@0
|
296 return aiVector3t<TReal>( v1.y*v2.z - v1.z*v2.y, v1.z*v2.x - v1.x*v2.z, v1.x*v2.y - v1.y*v2.x);
|
nuclear@0
|
297 }
|
nuclear@0
|
298 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
299 // vector negation
|
nuclear@0
|
300 template<typename TReal>
|
nuclear@0
|
301 AI_FORCE_INLINE
|
nuclear@0
|
302 aiVector3t<TReal> operator - ( const aiVector3t<TReal>& v) {
|
nuclear@0
|
303 return aiVector3t<TReal>( -v.x, -v.y, -v.z);
|
nuclear@0
|
304 }
|
nuclear@0
|
305
|
nuclear@0
|
306 // ------------------------------------------------------------------------------------------------
|
nuclear@0
|
307
|
nuclear@0
|
308 #endif // __cplusplus
|
nuclear@0
|
309 #endif // AI_VECTOR3D_INL_INC
|