fix for painting bug added since 25391 (own fault)
[blender.git] / source / blender / blenlib / intern / math_vector_inline.c
1 /**
2  * $Id$
3  *
4  * ***** BEGIN GPL LICENSE BLOCK *****
5  *
6  * This program is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU General Public License
8  * as published by the Free Software Foundation; either version 2
9  * of the License, or (at your option) any later version.
10  *
11  * This program is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  * GNU General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License
17  * along with this program; if not, write to the Free Software Foundation,
18  * Inc., 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
19  *
20  * The Original Code is Copyright (C) 2001-2002 by NaN Holding BV.
21  * All rights reserved.
22  
23  * The Original Code is: some of this file.
24  *
25  * ***** END GPL LICENSE BLOCK *****
26  * */
27
28 #include "BLI_math.h"
29
30 #ifndef BLI_MATH_VECTOR_INLINE
31 #define BLI_MATH_VECTOR_INLINE
32
33 /********************************** Init *************************************/
34
35 MINLINE void zero_v2(float r[2])
36 {
37         r[0]= 0.0f;
38         r[1]= 0.0f;
39 }
40
41 MINLINE void zero_v3(float r[3])
42 {
43         r[0]= 0.0f;
44         r[1]= 0.0f;
45         r[2]= 0.0f;
46 }
47
48 MINLINE void copy_v2_v2(float r[2], const float a[2])
49 {
50         r[0]= a[0];
51         r[1]= a[1];
52 }
53
54 MINLINE void copy_v3_v3(float r[3], const float a[3])
55 {
56         r[0]= a[0];
57         r[1]= a[1];
58         r[2]= a[2];
59 }
60
61 MINLINE void swap_v2_v2(float a[2], float b[2])
62 {
63         SWAP(float, a[0], b[0]);
64         SWAP(float, a[1], b[1]);
65 }
66
67 MINLINE void swap_v3_v3(float a[3], float b[3])
68 {
69         SWAP(float, a[0], b[0]);
70         SWAP(float, a[1], b[1]);
71         SWAP(float, a[2], b[2]);
72 }
73
74 /********************************* Arithmetic ********************************/
75
76 MINLINE void add_v2_v2(float *r, float *a)
77 {
78         r[0] += a[0];
79         r[1] += a[1];
80 }
81
82 MINLINE void add_v2_v2v2(float *r, float *a, float *b)
83 {
84         r[0]= a[0] + b[0];
85         r[1]= a[1] + b[1];
86 }
87
88 MINLINE void add_v3_v3(float *r, float *a)
89 {
90         r[0] += a[0];
91         r[1] += a[1];
92         r[2] += a[2];
93 }
94
95 MINLINE void add_v3_v3v3(float *r, float *a, float *b)
96 {
97         r[0]= a[0] + b[0];
98         r[1]= a[1] + b[1];
99         r[2]= a[2] + b[2];
100 }
101
102 MINLINE void sub_v2_v2(float *r, float *a)
103 {
104         r[0] -= a[0];
105         r[1] -= a[1];
106 }
107
108 MINLINE void sub_v2_v2v2(float *r, float *a, float *b)
109 {
110         r[0]= a[0] - b[0];
111         r[1]= a[1] - b[1];
112 }
113
114 MINLINE void sub_v3_v3(float *r, float *a)
115 {
116         r[0] -= a[0];
117         r[1] -= a[1];
118         r[2] -= a[2];
119 }
120
121 MINLINE void sub_v3_v3v3(float r[3], const float a[3], const float b[3])
122 {
123         r[0]= a[0] - b[0];
124         r[1]= a[1] - b[1];
125         r[2]= a[2] - b[2];
126 }
127
128 MINLINE void mul_v2_fl(float *v1, float f)
129 {
130         v1[0]*= f;
131         v1[1]*= f;
132 }
133
134 MINLINE void mul_v3_fl(float r[3], float f)
135 {
136         r[0] *= f;
137         r[1] *= f;
138         r[2] *= f;
139 }
140
141 MINLINE void mul_v3_v3fl(float r[3], float a[3], float f)
142 {
143         r[0]= a[0]*f;
144         r[1]= a[1]*f;
145         r[2]= a[2]*f;
146 }
147
148 MINLINE void mul_v2_v2(float r[2], const float a[2])
149 {
150         r[0] *= a[0];
151         r[1] *= a[1];
152 }
153
154 MINLINE void mul_v3_v3(float r[3], float a[3])
155 {
156         r[0] *= a[0];
157         r[1] *= a[1];
158         r[2] *= a[2];
159 }
160
161 MINLINE void madd_v3_v3fl(float r[3], float a[3], float f)
162 {
163         r[0] += a[0]*f;
164         r[1] += a[1]*f;
165         r[2] += a[2]*f;
166 }
167
168 MINLINE void madd_v3_v3v3(float r[3], float a[3], float b[3])
169 {
170         r[0] += a[0]*b[0];
171         r[1] += a[1]*b[1];
172         r[2] += a[2]*b[2];
173 }
174
175 MINLINE void madd_v2_v2v2fl(float r[2], const float a[2], const float b[2], const float f)
176 {
177         r[0] = a[0] + b[0]*f;
178         r[1] = a[1] + b[1]*f;
179 }
180
181 MINLINE void madd_v3_v3v3fl(float r[3], float a[3], float b[3], float f)
182 {
183         r[0] = a[0] + b[0]*f;
184         r[1] = a[1] + b[1]*f;
185         r[2] = a[2] + b[2]*f;
186 }
187
188 MINLINE void madd_v3_v3v3v3(float r[3], float a[3], float b[3], float c[3])
189 {
190         r[0] = a[0] + b[0]*c[0];
191         r[1] = a[1] + b[1]*c[1];
192         r[2] = a[2] + b[2]*c[2];
193 }
194
195 MINLINE void mul_v3_v3v3(float *v, float *v1, float *v2)
196 {
197         v[0] = v1[0] * v2[0];
198         v[1] = v1[1] * v2[1];
199         v[2] = v1[2] * v2[2];
200 }
201
202 MINLINE void negate_v3(float r[3])
203 {
204         r[0]= -r[0];
205         r[1]= -r[1];
206         r[2]= -r[2];
207 }
208
209 MINLINE void negate_v3_v3(float r[3], const float a[3])
210 {
211         r[0]= -a[0];
212         r[1]= -a[1];
213         r[2]= -a[2];
214 }
215
216 MINLINE float dot_v2v2(const float a[2], const float b[2])
217 {
218         return a[0]*b[0] + a[1]*b[1];
219 }
220
221 MINLINE float dot_v3v3(const float a[3], const float b[3])
222 {
223         return a[0]*b[0] + a[1]*b[1] + a[2]*b[2];
224 }
225
226 MINLINE float cross_v2v2(const float a[2], const float b[2])
227 {
228          return a[0]*b[1] - a[1]*b[0];
229 }
230
231 MINLINE void cross_v3_v3v3(float r[3], const float a[3], const float b[3])
232 {
233         r[0]= a[1]*b[2] - a[2]*b[1];
234         r[1]= a[2]*b[0] - a[0]*b[2];
235         r[2]= a[0]*b[1] - a[1]*b[0];
236 }
237
238 MINLINE void star_m3_v3(float mat[][3], float *vec)
239 {
240         mat[0][0]= mat[1][1]= mat[2][2]= 0.0;
241         mat[0][1]= -vec[2];     
242         mat[0][2]= vec[1];
243         mat[1][0]= vec[2];      
244         mat[1][2]= -vec[0];
245         mat[2][0]= -vec[1];     
246         mat[2][1]= vec[0];
247 }
248
249 /*********************************** Length **********************************/
250
251 MINLINE float len_v2(const float v[2])
252 {
253         return (float)sqrt(v[0]*v[0] + v[1]*v[1]);
254 }
255
256 MINLINE float len_v2v2(const float v1[2], const float v2[2])
257 {
258         float x, y;
259
260         x = v1[0]-v2[0];
261         y = v1[1]-v2[1];
262         return (float)sqrt(x*x+y*y);
263 }
264
265 MINLINE float len_v3(const float a[3])
266 {
267         return sqrtf(dot_v3v3(a, a));
268 }
269
270 MINLINE float len_v3v3(const float a[3], const float b[3])
271 {
272         float d[3];
273
274         sub_v3_v3v3(d, b, a);
275         return len_v3(d);
276 }
277
278 MINLINE float normalize_v2(float n[2])
279 {
280         float d= dot_v2v2(n, n);
281
282         if(d > 1.0e-35f) {
283                 d= sqrtf(d);
284                 mul_v2_fl(n, 1.0f/d);
285         } else {
286                 zero_v2(n);
287                 d= 0.0f;
288         }
289         return d;
290 }
291
292 MINLINE float normalize_v3(float n[3])
293 {
294         float d= dot_v3v3(n, n);
295
296         /* a larger value causes normalize errors in a
297            scaled down models with camera xtreme close */
298         if(d > 1.0e-35f) {
299                 d= sqrtf(d);
300                 mul_v3_fl(n, 1.0f/d);
301         }
302         else {
303                 zero_v3(n);
304                 d= 0.0f;
305         }
306
307         return d;
308 }
309
310 MINLINE void normal_short_to_float_v3(float *out, short *in)
311 {
312         out[0] = in[0]*(1.0f/32767.0f);
313         out[1] = in[1]*(1.0f/32767.0f);
314         out[2] = in[2]*(1.0f/32767.0f);
315 }
316
317 MINLINE void normal_float_to_short_v3(short *out, float *in)
318 {
319         out[0] = (short)(in[0]*32767.0f);
320         out[1] = (short)(in[1]*32767.0f);
321         out[2] = (short)(in[2]*32767.0f);
322 }
323
324 #endif /* BLI_MATH_VECTOR_INLINE */
325