Blender V5.3
math_vector_inline.cc
Go to the documentation of this file.
1/* SPDX-FileCopyrightText: 2001-2002 NaN Holding BV. All rights reserved.
2 *
3 * SPDX-License-Identifier: GPL-2.0-or-later */
4
8
9#pragma once
10
11#include "BLI_math_base_c.hh"
12#include "BLI_utildefines.hh"
13
14namespace blender {
15
16/* -------------------------------------------------------------------- */
19
20MINLINE void zero_v2(float r[2])
21{
22 r[0] = 0.0f;
23 r[1] = 0.0f;
24}
25
26MINLINE void zero_v3(float r[3])
27{
28 r[0] = 0.0f;
29 r[1] = 0.0f;
30 r[2] = 0.0f;
31}
32
33MINLINE void zero_v4(float r[4])
34{
35 r[0] = 0.0f;
36 r[1] = 0.0f;
37 r[2] = 0.0f;
38 r[3] = 0.0f;
39}
40
41MINLINE void copy_v2_v2(float r[2], const float a[2])
42{
43 r[0] = a[0];
44 r[1] = a[1];
45}
46
47MINLINE void copy_v3_v3(float r[3], const float a[3])
48{
49 r[0] = a[0];
50 r[1] = a[1];
51 r[2] = a[2];
52}
53
54MINLINE void copy_v4_v4(float r[4], const float a[4])
55{
56 r[0] = a[0];
57 r[1] = a[1];
58 r[2] = a[2];
59 r[3] = a[3];
60}
61
62MINLINE void copy_v2_fl(float r[2], float f)
63{
64 r[0] = f;
65 r[1] = f;
66}
67
68MINLINE void copy_v3_fl(float r[3], float f)
69{
70 r[0] = f;
71 r[1] = f;
72 r[2] = f;
73}
74
75MINLINE void copy_v4_fl(float r[4], float f)
76{
77 r[0] = f;
78 r[1] = f;
79 r[2] = f;
80 r[3] = f;
81}
82
83/* unsigned char */
84
85MINLINE void copy_v3_v3_uchar(unsigned char r[3], const unsigned char a[3])
86{
87 r[0] = a[0];
88 r[1] = a[1];
89 r[2] = a[2];
90}
91
92MINLINE void copy_v4_v4_uchar(unsigned char r[4], const unsigned char a[4])
93{
94 r[0] = a[0];
95 r[1] = a[1];
96 r[2] = a[2];
97 r[3] = a[3];
98}
99
100/* short */
101
102MINLINE void copy_v2_v2_short(short r[2], const short a[2])
103{
104 r[0] = a[0];
105 r[1] = a[1];
106}
107
108MINLINE void copy_v3_v3_short(short r[3], const short a[3])
109{
110 r[0] = a[0];
111 r[1] = a[1];
112 r[2] = a[2];
113}
114
115/* int */
116MINLINE void zero_v2_int(int r[2])
117{
118 r[0] = 0;
119 r[1] = 0;
120}
121
122MINLINE void zero_v3_int(int r[3])
123{
124 r[0] = 0;
125 r[1] = 0;
126 r[2] = 0;
127}
128
129MINLINE void copy_v2_v2_int(int r[2], const int a[2])
130{
131 r[0] = a[0];
132 r[1] = a[1];
133}
134
135MINLINE void copy_v3_v3_int(int r[3], const int a[3])
136{
137 r[0] = a[0];
138 r[1] = a[1];
139 r[2] = a[2];
140}
141
142MINLINE void copy_v4_v4_int(int r[4], const int a[4])
143{
144 r[0] = a[0];
145 r[1] = a[1];
146 r[2] = a[2];
147 r[3] = a[3];
148}
149
150/* double */
151
152MINLINE void copy_v2_v2_db(double r[2], const double a[2])
153{
154 r[0] = a[0];
155 r[1] = a[1];
156}
157
158MINLINE void copy_v3_v3_db(double r[3], const double a[3])
159{
160 r[0] = a[0];
161 r[1] = a[1];
162 r[2] = a[2];
163}
164
165MINLINE void copy_v4_v4_db(double r[4], const double a[4])
166{
167 r[0] = a[0];
168 r[1] = a[1];
169 r[2] = a[2];
170 r[3] = a[3];
171}
172
173MINLINE void copy_v2fl_v2i(float r[2], const int a[2])
174{
175 r[0] = float(a[0]);
176 r[1] = float(a[1]);
177}
178
179/* double -> float */
180
181MINLINE void copy_v3fl_v3db(float r[3], const double a[3])
182{
183 r[0] = float(a[0]);
184 r[1] = float(a[1]);
185 r[2] = float(a[2]);
186}
187
188MINLINE void copy_v4fl_v4db(float r[4], const double a[4])
189{
190 r[0] = float(a[0]);
191 r[1] = float(a[1]);
192 r[2] = float(a[2]);
193 r[3] = float(a[3]);
194}
195
196/* float -> double */
197
198MINLINE void copy_v2db_v2fl(double r[2], const float a[2])
199{
200 r[0] = double(a[0]);
201 r[1] = double(a[1]);
202}
203
204MINLINE void copy_v3db_v3fl(double r[3], const float a[3])
205{
206 r[0] = double(a[0]);
207 r[1] = double(a[1]);
208 r[2] = double(a[2]);
209}
210
211MINLINE void swap_v2_v2(float a[2], float b[2])
212{
213 SWAP(float, a[0], b[0]);
214 SWAP(float, a[1], b[1]);
215}
216
217MINLINE void swap_v3_v3(float a[3], float b[3])
218{
219 SWAP(float, a[0], b[0]);
220 SWAP(float, a[1], b[1]);
221 SWAP(float, a[2], b[2]);
222}
223
224MINLINE void swap_v4_v4(float a[4], float b[4])
225{
226 SWAP(float, a[0], b[0]);
227 SWAP(float, a[1], b[1]);
228 SWAP(float, a[2], b[2]);
229 SWAP(float, a[3], b[3]);
230}
231
232/* float args -> vec */
233
234MINLINE void copy_v2_fl2(float v[2], float x, float y)
235{
236 v[0] = x;
237 v[1] = y;
238}
239
240MINLINE void copy_v3_fl3(float v[3], float x, float y, float z)
241{
242 v[0] = x;
243 v[1] = y;
244 v[2] = z;
245}
246
247MINLINE void copy_v4_fl4(float v[4], float x, float y, float z, float w)
248{
249 v[0] = x;
250 v[1] = y;
251 v[2] = z;
252 v[3] = w;
253}
254
256
257/* -------------------------------------------------------------------- */
260
261MINLINE void add_v2_fl(float r[2], float f)
262{
263 r[0] += f;
264 r[1] += f;
265}
266
267MINLINE void add_v3_fl(float r[3], float f)
268{
269 r[0] += f;
270 r[1] += f;
271 r[2] += f;
272}
273
274MINLINE void add_v2_v2(float r[2], const float a[2])
275{
276 r[0] += a[0];
277 r[1] += a[1];
278}
279
280MINLINE void add_v2_v2v2(float r[2], const float a[2], const float b[2])
281{
282 r[0] = a[0] + b[0];
283 r[1] = a[1] + b[1];
284}
285
286MINLINE void add_v3_v3(float r[3], const float a[3])
287{
288 r[0] += a[0];
289 r[1] += a[1];
290 r[2] += a[2];
291}
292
293MINLINE void add_v3_v3_db(double r[3], const double a[3])
294{
295 r[0] += a[0];
296 r[1] += a[1];
297 r[2] += a[2];
298}
299
300MINLINE void add_v3_v3v3(float r[3], const float a[3], const float b[3])
301{
302 r[0] = a[0] + b[0];
303 r[1] = a[1] + b[1];
304 r[2] = a[2] + b[2];
305}
306
307MINLINE void add_v3fl_v3fl_v3i(float r[3], const float a[3], const int b[3])
308{
309 r[0] = a[0] + float(b[0]);
310 r[1] = a[1] + float(b[1]);
311 r[2] = a[2] + float(b[2]);
312}
313
314MINLINE void add_v4_v4(float r[4], const float a[4])
315{
316 r[0] += a[0];
317 r[1] += a[1];
318 r[2] += a[2];
319 r[3] += a[3];
320}
321
323{
324 r[0] = uchar(clamp_i(r[0] + i, 0, 255));
325 r[1] = uchar(clamp_i(r[1] + i, 0, 255));
326 r[2] = uchar(clamp_i(r[2] + i, 0, 255));
327}
328
329MINLINE void sub_v2_v2(float r[2], const float a[2])
330{
331 r[0] -= a[0];
332 r[1] -= a[1];
333}
334
335MINLINE void sub_v2_v2v2(float r[2], const float a[2], const float b[2])
336{
337 r[0] = a[0] - b[0];
338 r[1] = a[1] - b[1];
339}
340
341MINLINE void sub_v2_v2v2_db(double r[2], const double a[2], const double b[2])
342{
343 r[0] = a[0] - b[0];
344 r[1] = a[1] - b[1];
345}
346
347MINLINE void sub_v2_v2v2_int(int r[2], const int a[2], const int b[2])
348{
349 r[0] = a[0] - b[0];
350 r[1] = a[1] - b[1];
351}
352
353MINLINE void sub_v3_v3(float r[3], const float a[3])
354{
355 r[0] -= a[0];
356 r[1] -= a[1];
357 r[2] -= a[2];
358}
359
360MINLINE void sub_v3_v3v3(float r[3], const float a[3], const float b[3])
361{
362 r[0] = a[0] - b[0];
363 r[1] = a[1] - b[1];
364 r[2] = a[2] - b[2];
365}
366
367MINLINE void sub_v3_v3v3_int(int r[3], const int a[3], const int b[3])
368{
369 r[0] = a[0] - b[0];
370 r[1] = a[1] - b[1];
371 r[2] = a[2] - b[2];
372}
373
374MINLINE void sub_v3_v3v3_db(double r[3], const double a[3], const double b[3])
375{
376 r[0] = a[0] - b[0];
377 r[1] = a[1] - b[1];
378 r[2] = a[2] - b[2];
379}
380
381MINLINE void sub_v2db_v2fl_v2fl(double r[2], const float a[2], const float b[2])
382{
383 r[0] = double(a[0]) - double(b[0]);
384 r[1] = double(a[1]) - double(b[1]);
385}
386
387MINLINE void sub_v3db_v3fl_v3fl(double r[3], const float a[3], const float b[3])
388{
389 r[0] = double(a[0]) - double(b[0]);
390 r[1] = double(a[1]) - double(b[1]);
391 r[2] = double(a[2]) - double(b[2]);
392}
393
394MINLINE void sub_v4_v4v4(float r[4], const float a[4], const float b[4])
395{
396 r[0] = a[0] - b[0];
397 r[1] = a[1] - b[1];
398 r[2] = a[2] - b[2];
399 r[3] = a[3] - b[3];
400}
401
402MINLINE void mul_v2_fl(float r[2], float f)
403{
404 r[0] *= f;
405 r[1] *= f;
406}
407
408MINLINE void mul_v2_v2fl(float r[2], const float a[2], float f)
409{
410 r[0] = a[0] * f;
411 r[1] = a[1] * f;
412}
413
414MINLINE void mul_v3_fl(float r[3], float f)
415{
416 r[0] *= f;
417 r[1] *= f;
418 r[2] *= f;
419}
420
421MINLINE void mul_v3db_db(double r[3], double f)
422{
423 r[0] *= f;
424 r[1] *= f;
425 r[2] *= f;
426}
427
428MINLINE void mul_v3_v3fl(float r[3], const float a[3], float f)
429{
430 r[0] = a[0] * f;
431 r[1] = a[1] * f;
432 r[2] = a[2] * f;
433}
434
435MINLINE void mul_v2_v2(float r[2], const float a[2])
436{
437 r[0] *= a[0];
438 r[1] *= a[1];
439}
440
441MINLINE void mul_v3_v3(float r[3], const float a[3])
442{
443 r[0] *= a[0];
444 r[1] *= a[1];
445 r[2] *= a[2];
446}
447
448MINLINE void mul_v4_fl(float r[4], float f)
449{
450 r[0] *= f;
451 r[1] *= f;
452 r[2] *= f;
453 r[3] *= f;
454}
455
456MINLINE void mul_v4_v4fl(float r[4], const float a[4], float f)
457{
458 r[0] = a[0] * f;
459 r[1] = a[1] * f;
460 r[2] = a[2] * f;
461 r[3] = a[3] * f;
462}
463
464MINLINE float mul_project_m4_v3_zfac(const float mat[4][4], const float co[3])
465{
466 return (mat[0][3] * co[0]) + (mat[1][3] * co[1]) + (mat[2][3] * co[2]) + mat[3][3];
467}
468
469MINLINE float dot_m3_v3_row_x(const float M[3][3], const float a[3])
470{
471 return M[0][0] * a[0] + M[1][0] * a[1] + M[2][0] * a[2];
472}
473MINLINE float dot_m3_v3_row_y(const float M[3][3], const float a[3])
474{
475 return M[0][1] * a[0] + M[1][1] * a[1] + M[2][1] * a[2];
476}
477MINLINE float dot_m3_v3_row_z(const float M[3][3], const float a[3])
478{
479 return M[0][2] * a[0] + M[1][2] * a[1] + M[2][2] * a[2];
480}
481
482MINLINE float dot_m4_v3_row_x(const float M[4][4], const float a[3])
483{
484 return M[0][0] * a[0] + M[1][0] * a[1] + M[2][0] * a[2];
485}
486MINLINE float dot_m4_v3_row_y(const float M[4][4], const float a[3])
487{
488 return M[0][1] * a[0] + M[1][1] * a[1] + M[2][1] * a[2];
489}
490MINLINE float dot_m4_v3_row_z(const float M[4][4], const float a[3])
491{
492 return M[0][2] * a[0] + M[1][2] * a[1] + M[2][2] * a[2];
493}
494
495MINLINE void madd_v2_v2fl(float r[2], const float a[2], float f)
496{
497 r[0] += a[0] * f;
498 r[1] += a[1] * f;
499}
500
501MINLINE void madd_v3_v3fl(float r[3], const float a[3], float f)
502{
503 r[0] += a[0] * f;
504 r[1] += a[1] * f;
505 r[2] += a[2] * f;
506}
507
508MINLINE void madd_v2_v2v2fl(float r[2], const float a[2], const float b[2], float f)
509{
510 r[0] = a[0] + b[0] * f;
511 r[1] = a[1] + b[1] * f;
512}
513
514MINLINE void madd_v3_v3v3fl(float r[3], const float a[3], const float b[3], float f)
515{
516 r[0] = a[0] + b[0] * f;
517 r[1] = a[1] + b[1] * f;
518 r[2] = a[2] + b[2] * f;
519}
520
521MINLINE void madd_v3_v3v3v3(float r[3], const float a[3], const float b[3], const float c[3])
522{
523 r[0] = a[0] + b[0] * c[0];
524 r[1] = a[1] + b[1] * c[1];
525 r[2] = a[2] + b[2] * c[2];
526}
527
529 const float a[3],
530 const float b[3],
531 const int c[3])
532{
533 r[0] = a[0] + b[0] * float(c[0]);
534 r[1] = a[1] + b[1] * float(c[1]);
535 r[2] = a[2] + b[2] * float(c[2]);
536}
537
538MINLINE void madd_v4_v4fl(float r[4], const float a[4], float f)
539{
540 r[0] += a[0] * f;
541 r[1] += a[1] * f;
542 r[2] += a[2] * f;
543 r[3] += a[3] * f;
544}
545
546MINLINE void mul_v3_v3v3(float r[3], const float v1[3], const float v2[3])
547{
548 r[0] = v1[0] * v2[0];
549 r[1] = v1[1] * v2[1];
550 r[2] = v1[2] * v2[2];
551}
552
553MINLINE void mul_v2_v2v2(float r[2], const float a[2], const float b[2])
554{
555 r[0] = a[0] * b[0];
556 r[1] = a[1] * b[1];
557}
558
559MINLINE void negate_v2(float r[2])
560{
561 r[0] = -r[0];
562 r[1] = -r[1];
563}
564
565MINLINE void negate_v2_v2(float r[2], const float a[2])
566{
567 r[0] = -a[0];
568 r[1] = -a[1];
569}
570
571MINLINE void negate_v3(float r[3])
572{
573 r[0] = -r[0];
574 r[1] = -r[1];
575 r[2] = -r[2];
576}
577
578MINLINE void negate_v3_v3(float r[3], const float a[3])
579{
580 r[0] = -a[0];
581 r[1] = -a[1];
582 r[2] = -a[2];
583}
584
585MINLINE void negate_v4(float r[4])
586{
587 r[0] = -r[0];
588 r[1] = -r[1];
589 r[2] = -r[2];
590 r[3] = -r[3];
591}
592
593MINLINE void negate_v4_v4(float r[4], const float a[4])
594{
595 r[0] = -a[0];
596 r[1] = -a[1];
597 r[2] = -a[2];
598 r[3] = -a[3];
599}
600
601MINLINE void negate_v3_db(double r[3])
602{
603 r[0] = -r[0];
604 r[1] = -r[1];
605 r[2] = -r[2];
606}
607
608MINLINE void invert_v2(float r[2])
609{
610 BLI_assert(!ELEM(0.0f, r[0], r[1]));
611 r[0] = 1.0f / r[0];
612 r[1] = 1.0f / r[1];
613}
614
615MINLINE void invert_v3(float r[3])
616{
617 BLI_assert(!ELEM(0.0f, r[0], r[1], r[2]));
618 r[0] = 1.0f / r[0];
619 r[1] = 1.0f / r[1];
620 r[2] = 1.0f / r[2];
621}
622
623MINLINE void invert_v3_safe(float r[3])
624{
625 if (r[0] != 0.0f) {
626 r[0] = 1.0f / r[0];
627 }
628 if (r[1] != 0.0f) {
629 r[1] = 1.0f / r[1];
630 }
631 if (r[2] != 0.0f) {
632 r[2] = 1.0f / r[2];
633 }
634}
635
636MINLINE float dot_v2v2(const float a[2], const float b[2])
637{
638 return a[0] * b[0] + a[1] * b[1];
639}
640
641MINLINE double dot_v2v2_db(const double a[2], const double b[2])
642{
643 return a[0] * b[0] + a[1] * b[1];
644}
645
646MINLINE float dot_v3v3(const float a[3], const float b[3])
647{
648 return a[0] * b[0] + a[1] * b[1] + a[2] * b[2];
649}
650
651MINLINE bool is_zero_v3(const float v[3]);
652
653MINLINE float dot_v3v3v3(const float p[3], const float a[3], const float b[3])
654{
655 float vec1[3], vec2[3];
656
657 sub_v3_v3v3(vec1, a, p);
658 sub_v3_v3v3(vec2, b, p);
659 if (is_zero_v3(vec1) || is_zero_v3(vec2)) {
660 return 0.0f;
661 }
662 return dot_v3v3(vec1, vec2);
663}
664
665MINLINE float dot_v4v4(const float a[4], const float b[4])
666{
667 return a[0] * b[0] + a[1] * b[1] + a[2] * b[2] + a[3] * b[3];
668}
669
670MINLINE double dot_v3db_v3fl(const double a[3], const float b[3])
671{
672 return a[0] * double(b[0]) + a[1] * double(b[1]) + a[2] * double(b[2]);
673}
674
675MINLINE double dot_v3v3_db(const double a[3], const double b[3])
676{
677 return a[0] * b[0] + a[1] * b[1] + a[2] * b[2];
678}
679
680MINLINE float cross_v2v2(const float a[2], const float b[2])
681{
682 return a[0] * b[1] - a[1] * b[0];
683}
684
685MINLINE double cross_v2v2_db(const double a[2], const double b[2])
686{
687 return a[0] * b[1] - a[1] * b[0];
688}
689
690MINLINE void cross_v3_v3v3(float r[3], const float a[3], const float b[3])
691{
692 BLI_assert(r != a && r != b);
693 r[0] = a[1] * b[2] - a[2] * b[1];
694 r[1] = a[2] * b[0] - a[0] * b[2];
695 r[2] = a[0] * b[1] - a[1] * b[0];
696}
697
698MINLINE void cross_v3_v3v3_db(double r[3], const double a[3], const double b[3])
699{
700 BLI_assert(r != a && r != b);
701 r[0] = a[1] * b[2] - a[2] * b[1];
702 r[1] = a[2] * b[0] - a[0] * b[2];
703 r[2] = a[0] * b[1] - a[1] * b[0];
704}
705
706MINLINE void add_newell_cross_v3_v3v3(float n[3], const float v_prev[3], const float v_curr[3])
707{
708 n[0] += (v_prev[1] - v_curr[1]) * (v_prev[2] + v_curr[2]);
709 n[1] += (v_prev[2] - v_curr[2]) * (v_prev[0] + v_curr[0]);
710 n[2] += (v_prev[0] - v_curr[0]) * (v_prev[1] + v_curr[1]);
711}
712
714
715/* -------------------------------------------------------------------- */
718
719MINLINE float len_squared_v2(const float v[2])
720{
721 return v[0] * v[0] + v[1] * v[1];
722}
723
724MINLINE float len_squared_v3(const float v[3])
725{
726 return v[0] * v[0] + v[1] * v[1] + v[2] * v[2];
727}
728
729MINLINE float len_manhattan_v2(const float v[2])
730{
731 return fabsf(v[0]) + fabsf(v[1]);
732}
733
735{
736 return abs(v[0]) + abs(v[1]);
737}
738
739MINLINE float len_manhattan_v3(const float v[3])
740{
741 return fabsf(v[0]) + fabsf(v[1]) + fabsf(v[2]);
742}
743
744MINLINE float len_v2(const float v[2])
745{
746 return sqrtf(v[0] * v[0] + v[1] * v[1]);
747}
748
749MINLINE double len_v2_db(const double v[2])
750{
751 return sqrt(v[0] * v[0] + v[1] * v[1]);
752}
753
754MINLINE float len_v2v2(const float v1[2], const float v2[2])
755{
756 float x, y;
757
758 x = v1[0] - v2[0];
759 y = v1[1] - v2[1];
760 return sqrtf(x * x + y * y);
761}
762
763MINLINE double len_v2v2_db(const double v1[2], const double v2[2])
764{
765 double x, y;
766
767 x = v1[0] - v2[0];
768 y = v1[1] - v2[1];
769 return sqrt(x * x + y * y);
770}
771
772MINLINE float len_v2v2_int(const int v1[2], const int v2[2])
773{
774 float x, y;
775
776 x = float(v1[0] - v2[0]);
777 y = float(v1[1] - v2[1]);
778 return sqrtf(x * x + y * y);
779}
780
781MINLINE float len_v3(const float a[3])
782{
783 return sqrtf(dot_v3v3(a, a));
784}
785
786MINLINE float len_squared_v2v2(const float a[2], const float b[2])
787{
788 float d[2];
789
790 sub_v2_v2v2(d, b, a);
791 return dot_v2v2(d, d);
792}
793
794MINLINE float len_squared_v3v3(const float a[3], const float b[3])
795{
796 float d[3];
797
798 sub_v3_v3v3(d, b, a);
799 return dot_v3v3(d, d);
800}
801
802MINLINE float len_squared_v4v4(const float a[4], const float b[4])
803{
804 float d[4];
805
806 sub_v4_v4v4(d, b, a);
807 return dot_v4v4(d, d);
808}
809
810MINLINE float len_manhattan_v2v2(const float a[2], const float b[2])
811{
812 float d[2];
813
814 sub_v2_v2v2(d, b, a);
815 return len_manhattan_v2(d);
816}
817
818MINLINE int len_manhattan_v2v2_int(const int a[2], const int b[2])
819{
820 int d[2];
821
822 sub_v2_v2v2_int(d, b, a);
823 return len_manhattan_v2_int(d);
824}
825
826MINLINE float len_v3v3(const float a[3], const float b[3])
827{
828 float d[3];
829
830 sub_v3_v3v3(d, b, a);
831 return len_v3(d);
832}
833
834MINLINE float len_v4(const float a[4])
835{
836 return sqrtf(dot_v4v4(a, a));
837}
838
839MINLINE float len_v4v4(const float a[4], const float b[4])
840{
841 float d[4];
842
843 sub_v4_v4v4(d, b, a);
844 return len_v4(d);
845}
846
847MINLINE float normalize_v2_v2_length(float r[2], const float a[2], const float unit_length)
848{
849 float d = dot_v2v2(a, a);
850
851 if (d > 1.0e-35f) {
852 d = sqrtf(d);
853 mul_v2_v2fl(r, a, unit_length / d);
854 }
855 else {
856 /* Either the vector is small or one of it's values contained `nan`. */
857 zero_v2(r);
858 d = 0.0f;
859 }
860
861 return d;
862}
863MINLINE float normalize_v2_v2(float r[2], const float a[2])
864{
865 return normalize_v2_v2_length(r, a, 1.0f);
866}
867
868MINLINE float normalize_v2(float n[2])
869{
870 return normalize_v2_v2(n, n);
871}
872
873MINLINE float normalize_v2_length(float n[2], const float unit_length)
874{
875 return normalize_v2_v2_length(n, n, unit_length);
876}
877
878MINLINE float normalize_v3_v3_length(float r[3], const float a[3], const float unit_length)
879{
880 float d = dot_v3v3(a, a);
881
882 /* A larger value causes normalize errors in a scaled down models with camera extreme close. */
883 if (d > 1.0e-35f) {
884 d = sqrtf(d);
885 mul_v3_v3fl(r, a, unit_length / d);
886 }
887 else {
888 /* Either the vector is small or one of it's values contained `nan`. */
889 zero_v3(r);
890 d = 0.0f;
891 }
892
893 return d;
894}
895MINLINE float normalize_v3_v3(float r[3], const float a[3])
896{
897 return normalize_v3_v3_length(r, a, 1.0f);
898}
899
900MINLINE double normalize_v3_length_db(double n[3], const double unit_length)
901{
902 double d = n[0] * n[0] + n[1] * n[1] + n[2] * n[2];
903
904 /* a larger value causes normalize errors in a
905 * scaled down models with camera extreme close */
906 if (d > 1.0e-35) {
907 double mul;
908
909 d = sqrt(d);
910 mul = unit_length / d;
911
912 n[0] *= mul;
913 n[1] *= mul;
914 n[2] *= mul;
915 }
916 else {
917 n[0] = n[1] = n[2] = 0;
918 d = 0.0;
919 }
920
921 return d;
922}
923MINLINE double normalize_v3_db(double n[3])
924{
925 return normalize_v3_length_db(n, 1.0);
926}
927
928MINLINE float normalize_v3_length(float n[3], const float unit_length)
929{
930 return normalize_v3_v3_length(n, n, unit_length);
931}
932
933MINLINE float normalize_v3(float n[3])
934{
935 return normalize_v3_v3(n, n);
936}
937
938MINLINE void normal_short_to_float_v3(float out[3], const short in[3])
939{
940 out[0] = in[0] * (1.0f / 32767.0f);
941 out[1] = in[1] * (1.0f / 32767.0f);
942 out[2] = in[2] * (1.0f / 32767.0f);
943}
944
945MINLINE void normal_float_to_short_v3(short out[3], const float in[3])
946{
947 out[0] = short(in[0] * 32767.0f);
948 out[1] = short(in[1] * 32767.0f);
949 out[2] = short(in[2] * 32767.0f);
950}
951
953
954/* -------------------------------------------------------------------- */
957
958MINLINE bool is_zero_v2(const float v[2])
959{
960 return (v[0] == 0.0f && v[1] == 0.0f);
961}
962
963MINLINE bool is_zero_v3(const float v[3])
964{
965 return (v[0] == 0.0f && v[1] == 0.0f && v[2] == 0.0f);
966}
967
968MINLINE bool is_zero_v4(const float v[4])
969{
970 return (v[0] == 0.0f && v[1] == 0.0f && v[2] == 0.0f && v[3] == 0.0f);
971}
972
973MINLINE bool is_finite_v2(const float v[2])
974{
975 return (isfinite(v[0]) && isfinite(v[1]));
976}
977
978MINLINE bool is_finite_v3(const float v[3])
979{
980 return (isfinite(v[0]) && isfinite(v[1]) && isfinite(v[2]));
981}
982
983MINLINE bool is_finite_v4(const float v[4])
984{
985 return (isfinite(v[0]) && isfinite(v[1]) && isfinite(v[2]) && isfinite(v[3]));
986}
987
988MINLINE bool is_one_v3(const float v[3])
989{
990 return (v[0] == 1.0f && v[1] == 1.0f && v[2] == 1.0f);
991}
992
994
995/* -------------------------------------------------------------------- */
1000
1001MINLINE bool equals_v2v2(const float v1[2], const float v2[2])
1002{
1003 return ((v1[0] == v2[0]) && (v1[1] == v2[1]));
1004}
1005
1006MINLINE bool equals_v3v3(const float v1[3], const float v2[3])
1007{
1008 return ((v1[0] == v2[0]) && (v1[1] == v2[1]) && (v1[2] == v2[2]));
1009}
1010
1011MINLINE bool equals_v4v4(const float v1[4], const float v2[4])
1012{
1013 return ((v1[0] == v2[0]) && (v1[1] == v2[1]) && (v1[2] == v2[2]) && (v1[3] == v2[3]));
1014}
1015
1016MINLINE bool equals_v4v4_int(const int v1[4], const int v2[4])
1017{
1018 return ((v1[0] == v2[0]) && (v1[1] == v2[1]) && (v1[2] == v2[2]) && (v1[3] == v2[3]));
1019}
1020
1021MINLINE bool compare_v2v2(const float v1[2], const float v2[2], const float limit)
1022{
1023 return (compare_ff(v1[0], v2[0], limit) && compare_ff(v1[1], v2[1], limit));
1024}
1025
1026MINLINE bool compare_v3v3(const float v1[3], const float v2[3], const float limit)
1027{
1028 return (compare_ff(v1[0], v2[0], limit) && compare_ff(v1[1], v2[1], limit) &&
1029 compare_ff(v1[2], v2[2], limit));
1030}
1031
1032MINLINE bool compare_v4v4(const float v1[4], const float v2[4], const float limit)
1033{
1034 return (compare_ff(v1[0], v2[0], limit) && compare_ff(v1[1], v2[1], limit) &&
1035 compare_ff(v1[2], v2[2], limit) && compare_ff(v1[3], v2[3], limit));
1036}
1037
1038MINLINE bool compare_len_v3v3(const float v1[3], const float v2[3], const float limit)
1039{
1040 float d[3];
1041 sub_v3_v3v3(d, v1, v2);
1042 return (dot_v3v3(d, d) <= (limit * limit));
1043}
1044
1045MINLINE bool compare_size_v3v3(const float v1[3], const float v2[3], const float limit)
1046{
1047 for (int i = 0; i < 3; i++) {
1048 if (v2[i] == 0.0f) {
1049 /* Catch division by zero. */
1050 if (v1[i] != v2[i]) {
1051 return false;
1052 }
1053 }
1054 else {
1055 if (fabsf(v1[i] / v2[i] - 1.0f) > limit) {
1056 return false;
1057 }
1058 }
1059 }
1060 return true;
1061}
1062
1064
1065/* -------------------------------------------------------------------- */
1068
1069MINLINE void clamp_v2(float vec[2], const float min, const float max)
1070{
1071 CLAMP(vec[0], min, max);
1072 CLAMP(vec[1], min, max);
1073}
1074
1075MINLINE void clamp_v3(float vec[3], const float min, const float max)
1076{
1077 CLAMP(vec[0], min, max);
1078 CLAMP(vec[1], min, max);
1079 CLAMP(vec[2], min, max);
1080}
1081
1082MINLINE void clamp_v4(float vec[4], const float min, const float max)
1083{
1084 CLAMP(vec[0], min, max);
1085 CLAMP(vec[1], min, max);
1086 CLAMP(vec[2], min, max);
1087 CLAMP(vec[3], min, max);
1088}
1089
1091
1092/* -------------------------------------------------------------------- */
1095
1096MINLINE float line_point_side_v2(const float l1[2], const float l2[2], const float pt[2])
1097{
1098 return (((l1[0] - pt[0]) * (l2[1] - pt[1])) - ((l2[0] - pt[0]) * (l1[1] - pt[1])));
1099}
1100
1102
1103} // namespace blender
#define MINLINE
#define CLAMP(a, b, c)
#define SWAP(type, a, b)
#define ELEM(...)
btScalar max
SIMD_FORCE_INLINE const btScalar & z() const
Return the z value.
Definition btQuadWord.h:117
SIMD_FORCE_INLINE const btScalar & w() const
Return the w value.
Definition btQuadWord.h:119
#define abs
#define M
BMesh Iterators.
MINLINE void madd_v3_v3v3fl(float r[3], const float a[3], const float b[3], float f)
MINLINE void add_v3fl_v3fl_v3i(float r[3], const float a[3], const int b[3])
MINLINE void madd_v4_v4fl(float r[4], const float a[4], float f)
MINLINE float dot_m4_v3_row_z(const float M[4][4], const float a[3]) ATTR_WARN_UNUSED_RESULT
BLI_assert(slot->slot_subtype.map==BMO_OP_SLOT_SUBTYPE_MAP_FLT)
MINLINE float len_squared_v3v3(const float a[3], const float b[3]) ATTR_WARN_UNUSED_RESULT
MINLINE void negate_v3_v3(float r[3], const float a[3])
MINLINE double len_v2_db(const double v[2]) ATTR_WARN_UNUSED_RESULT
MINLINE float dot_m3_v3_row_z(const float M[3][3], const float a[3]) ATTR_WARN_UNUSED_RESULT
MINLINE double normalize_v3_length_db(double n[3], double unit_length)
MINLINE bool is_zero_v2(const float v[2]) ATTR_WARN_UNUSED_RESULT
MINLINE void copy_v2_v2_int(int r[2], const int a[2])
MINLINE bool is_finite_v3(const float v[3]) ATTR_WARN_UNUSED_RESULT
MINLINE void sub_v2_v2v2_db(double r[2], const double a[2], const double b[2])
MINLINE float dot_v3v3v3(const float p[3], const float a[3], const float b[3]) ATTR_WARN_UNUSED_RESULT
MINLINE int len_manhattan_v2_int(const int v[2]) ATTR_WARN_UNUSED_RESULT
MINLINE void copy_v2_fl(float r[2], float f)
MINLINE double dot_v3v3_db(const double a[3], const double b[3]) ATTR_WARN_UNUSED_RESULT
MINLINE float dot_m3_v3_row_y(const float M[3][3], const float a[3]) ATTR_WARN_UNUSED_RESULT
MINLINE float len_squared_v4v4(const float a[4], const float b[4]) ATTR_WARN_UNUSED_RESULT
MINLINE void copy_v3_v3(float r[3], const float a[3])
MINLINE void add_v2_v2v2(float r[2], const float a[2], const float b[2])
MINLINE bool equals_v4v4_int(const int v1[4], const int v2[4]) ATTR_WARN_UNUSED_RESULT
MINLINE void copy_v3db_v3fl(double r[3], const float a[3])
MINLINE void add_v3_v3v3(float r[3], const float a[3], const float b[3])
MINLINE void sub_v3_v3v3_int(int r[3], const int a[3], const int b[3])
MINLINE void sub_v4_v4v4(float r[4], const float a[4], const float b[4])
MINLINE void mul_v2_fl(float r[2], float f)
MINLINE float cross_v2v2(const float a[2], const float b[2]) ATTR_WARN_UNUSED_RESULT
MINLINE void negate_v2_v2(float r[2], const float a[2])
MINLINE void copy_v2_v2(float r[2], const float a[2])
MINLINE void sub_v2db_v2fl_v2fl(double r[2], const float a[2], const float b[2])
MINLINE float mul_project_m4_v3_zfac(const float mat[4][4], const float co[3]) ATTR_WARN_UNUSED_RESULT
MINLINE float len_v2v2_int(const int v1[2], const int v2[2])
MINLINE void invert_v3(float r[3])
MINLINE void copy_v3_v3_int(int r[3], const int a[3])
MINLINE void copy_v4_v4_db(double r[4], const double a[4])
MINLINE void mul_v4_v4fl(float r[4], const float a[4], float f)
MINLINE void copy_v3_v3_short(short r[3], const short a[3])
MINLINE float normalize_v2_length(float n[2], float unit_length)
MINLINE float len_manhattan_v3(const float v[3]) ATTR_WARN_UNUSED_RESULT
MINLINE void swap_v2_v2(float a[2], float b[2])
MINLINE void add_v3_fl(float r[3], float f)
MINLINE void swap_v4_v4(float a[4], float b[4])
MINLINE void sub_v2_v2v2(float r[2], const float a[2], const float b[2])
MINLINE void copy_v4_fl(float r[4], float f)
MINLINE int len_manhattan_v2v2_int(const int a[2], const int b[2]) ATTR_WARN_UNUSED_RESULT
MINLINE float normalize_v2(float n[2])
MINLINE void copy_v4_fl4(float v[4], float x, float y, float z, float w)
MINLINE void madd_v3fl_v3fl_v3fl_v3i(float r[3], const float a[3], const float b[3], const int c[3])
ATTR_WARN_UNUSED_RESULT const BMVert * v
MINLINE void sub_v2_v2v2_int(int r[2], const int a[2], const int b[2])
MINLINE float len_v4v4(const float a[4], const float b[4])
MINLINE void copy_v3_v3_db(double r[3], const double a[3])
MINLINE void copy_v4fl_v4db(float r[4], const double a[4])
MINLINE float normalize_v2_v2_length(float r[2], const float a[2], float unit_length)
MINLINE void mul_v3_fl(float r[3], float f)
MINLINE void mul_v2_v2(float r[2], const float a[2])
MINLINE bool is_zero_v4(const float v[4]) ATTR_WARN_UNUSED_RESULT
MINLINE bool is_finite_v2(const float v[2]) ATTR_WARN_UNUSED_RESULT
MINLINE void normal_float_to_short_v3(short out[3], const float in[3])
MINLINE void invert_v3_safe(float r[3])
MINLINE bool compare_v4v4(const float v1[4], const float v2[4], float limit) ATTR_WARN_UNUSED_RESULT
MINLINE void sub_v3_v3(float r[3], const float a[3])
MINLINE void copy_v4_v4_int(int r[4], const int a[4])
MINLINE void zero_v4(float r[4])
MINLINE void madd_v3_v3fl(float r[3], const float a[3], float f)
MINLINE bool equals_v3v3(const float v1[3], const float v2[3]) ATTR_WARN_UNUSED_RESULT
MINLINE bool equals_v4v4(const float v1[4], const float v2[4]) ATTR_WARN_UNUSED_RESULT
MINLINE void negate_v2(float r[2])
MINLINE void normal_short_to_float_v3(float out[3], const short in[3])
MINLINE float dot_m4_v3_row_x(const float M[4][4], const float a[3]) ATTR_WARN_UNUSED_RESULT
MINLINE void mul_v3_v3(float r[3], const float a[3])
MINLINE void add_v2_v2(float r[2], const float a[2])
unsigned char uchar
Definition BKE_text.h:58
MINLINE void cross_v3_v3v3(float r[3], const float a[3], const float b[3])
MINLINE void add_v4_v4(float r[4], const float a[4])
MINLINE void swap_v3_v3(float a[3], float b[3])
MINLINE void copy_v2_v2_db(double r[2], const double a[2])
MINLINE float dot_m3_v3_row_x(const float M[3][3], const float a[3]) ATTR_WARN_UNUSED_RESULT
MINLINE void cross_v3_v3v3_db(double r[3], const double a[3], const double b[3])
sqrt(x)+1/max(0
MINLINE void negate_v3(float r[3])
MINLINE void copy_v2_v2_short(short r[2], const short a[2])
MINLINE bool is_one_v3(const float v[3]) ATTR_WARN_UNUSED_RESULT
MINLINE void clamp_v4(float vec[4], float min, float max)
MINLINE void add_v3_uchar_clamped(uchar r[3], int i)
MINLINE void copy_v2_fl2(float v[2], float x, float y)
MINLINE float len_v3(const float a[3]) ATTR_WARN_UNUSED_RESULT
MINLINE double len_v2v2_db(const double v1[2], const double v2[2]) ATTR_WARN_UNUSED_RESULT
MINLINE float len_v4(const float a[4])
MINLINE void copy_v4_v4_uchar(unsigned char r[4], const unsigned char a[4])
MINLINE void mul_v2_v2fl(float r[2], const float a[2], float f)
MINLINE void zero_v3(float r[3])
MINLINE float dot_v2v2(const float a[2], const float b[2]) ATTR_WARN_UNUSED_RESULT
MINLINE bool equals_v2v2(const float v1[2], const float v2[2]) ATTR_WARN_UNUSED_RESULT
MINLINE double cross_v2v2_db(const double a[2], const double b[2]) ATTR_WARN_UNUSED_RESULT
MINLINE void copy_v3fl_v3db(float r[3], const double a[3])
MINLINE float normalize_v3_v3(float r[3], const float a[3])
MINLINE void mul_v3_v3fl(float r[3], const float a[3], float f)
MINLINE float normalize_v3(float n[3])
MINLINE void mul_v3db_db(double r[3], double f)
MINLINE float len_squared_v2(const float v[2]) ATTR_WARN_UNUSED_RESULT
MINLINE void add_v3_v3(float r[3], const float a[3])
MINLINE float len_manhattan_v2v2(const float a[2], const float b[2]) ATTR_WARN_UNUSED_RESULT
MINLINE void copy_v2db_v2fl(double r[2], const float a[2])
MINLINE void sub_v3_v3v3(float r[3], const float a[3], const float b[3])
MINLINE void madd_v3_v3v3v3(float r[3], const float a[3], const float b[3], const float c[3])
MINLINE bool compare_v3v3(const float v1[3], const float v2[3], float limit) ATTR_WARN_UNUSED_RESULT
MINLINE void copy_v3_fl3(float v[3], float x, float y, float z)
MINLINE void zero_v2_int(int r[2])
MINLINE float dot_m4_v3_row_y(const float M[4][4], const float a[3]) ATTR_WARN_UNUSED_RESULT
MINLINE void madd_v2_v2fl(float r[2], const float a[2], float f)
MINLINE bool compare_size_v3v3(const float v1[3], const float v2[3], float limit) ATTR_WARN_UNUSED_RESULT
ATTR_WARN_UNUSED_RESULT const BMVert * v2
MINLINE void copy_v3_fl(float r[3], float f)
MINLINE void sub_v3db_v3fl_v3fl(double r[3], const float a[3], const float b[3])
MINLINE void sub_v3_v3v3_db(double r[3], const double a[3], const double b[3])
MINLINE void clamp_v2(float vec[2], float min, float max)
MINLINE void copy_v3_v3_uchar(unsigned char r[3], const unsigned char a[3])
MINLINE void add_newell_cross_v3_v3v3(float n[3], const float v_prev[3], const float v_curr[3])
MINLINE float len_v2v2(const float v1[2], const float v2[2]) ATTR_WARN_UNUSED_RESULT
MINLINE float normalize_v3_length(float n[3], float unit_length)
MINLINE float normalize_v3_v3_length(float r[3], const float a[3], float unit_length)
MINLINE float len_squared_v3(const float v[3]) ATTR_WARN_UNUSED_RESULT
MINLINE double dot_v2v2_db(const double a[2], const double b[2]) ATTR_WARN_UNUSED_RESULT
MINLINE void clamp_v3(float vec[3], float min, float max)
MINLINE bool is_finite_v4(const float v[4]) ATTR_WARN_UNUSED_RESULT
MINLINE float line_point_side_v2(const float l1[2], const float l2[2], const float pt[2]) ATTR_WARN_UNUSED_RESULT
MINLINE void negate_v4(float r[4])
MINLINE float dot_v4v4(const float a[4], const float b[4]) ATTR_WARN_UNUSED_RESULT
MINLINE void copy_v4_v4(float r[4], const float a[4])
MINLINE void sub_v2_v2(float r[2], const float a[2])
MINLINE void mul_v2_v2v2(float r[2], const float a[2], const float b[2])
MINLINE void add_v3_v3_db(double r[3], const double a[3])
MINLINE float len_v2(const float v[2]) ATTR_WARN_UNUSED_RESULT
MINLINE void mul_v4_fl(float r[4], float f)
MINLINE void negate_v4_v4(float r[4], const float a[4])
MINLINE float len_v3v3(const float a[3], const float b[3]) ATTR_WARN_UNUSED_RESULT
MINLINE void mul_v3_v3v3(float r[3], const float v1[3], const float v2[3])
MINLINE void add_v2_fl(float r[2], float f)
MINLINE float len_squared_v2v2(const float a[2], const float b[2]) ATTR_WARN_UNUSED_RESULT
MINLINE void copy_v2fl_v2i(float r[2], const int a[2])
MINLINE void invert_v2(float r[2])
MINLINE int clamp_i(int value, int min, int max)
MINLINE double normalize_v3_db(double n[3])
MINLINE float normalize_v2_v2(float r[2], const float a[2])
MINLINE float dot_v3v3(const float a[3], const float b[3]) ATTR_WARN_UNUSED_RESULT
MINLINE void zero_v3_int(int r[3])
MINLINE double dot_v3db_v3fl(const double a[3], const float b[3]) ATTR_WARN_UNUSED_RESULT
MINLINE void zero_v2(float r[2])
MINLINE float len_manhattan_v2(const float v[2]) ATTR_WARN_UNUSED_RESULT
MINLINE void negate_v3_db(double r[3])
MINLINE bool is_zero_v3(const float v[3]) ATTR_WARN_UNUSED_RESULT
MINLINE int compare_ff(float a, float b, float max_diff)
MINLINE bool compare_len_v3v3(const float v1[3], const float v2[3], float limit) ATTR_WARN_UNUSED_RESULT
MINLINE void madd_v2_v2v2fl(float r[2], const float a[2], const float b[2], float f)
MINLINE bool compare_v2v2(const float v1[2], const float v2[2], float limit) ATTR_WARN_UNUSED_RESULT
#define fabsf
#define sqrtf
KERNEL_FEATURE_LIGHT_PASSES KERNEL_FEATURE_PATH_GUIDING float
#define min(a, b)
Definition sort.cc:38