15#ifndef MATH_STANDALONE
32 memset(m, 0,
sizeof(
float[3][3]));
37 memset(m, 0,
sizeof(
float[4][4]));
42 m[0][0] = m[1][1] = 1.0f;
49 m[0][0] = m[1][1] = m[2][2] = 1.0f;
50 m[0][1] = m[0][2] = 0.0f;
51 m[1][0] = m[1][2] = 0.0f;
52 m[2][0] = m[2][1] = 0.0f;
57 m[0][0] = m[1][1] = m[2][2] = m[3][3] = 1.0f;
58 m[0][1] = m[0][2] = m[0][3] = 0.0f;
59 m[1][0] = m[1][2] = m[1][3] = 0.0f;
60 m[2][0] = m[2][1] = m[2][3] = 0.0f;
61 m[3][0] = m[3][1] = m[3][2] = 0.0f;
66 m[0][0] = m[1][1] = m[2][2] = m[3][3] = 1.0f;
67 m[0][1] = m[0][2] = m[0][3] = 0.0f;
68 m[1][0] = m[1][2] = m[1][3] = 0.0f;
69 m[2][0] = m[2][1] = m[2][3] = 0.0f;
70 m[3][0] = m[3][1] = m[3][2] = 0.0f;
75 memcpy(m1, m2,
sizeof(
float[2][2]));
81 memcpy(m1, m2,
sizeof(
float[3][3]));
86 memcpy(m1, m2,
sizeof(
float[4][4]));
91 memcpy(m1, m2,
sizeof(
double[4][4]));
174 m1[0][0] =
float(m2[0][0]);
175 m1[0][1] =
float(m2[0][1]);
176 m1[0][2] =
float(m2[0][2]);
178 m1[1][0] =
float(m2[1][0]);
179 m1[1][1] =
float(m2[1][1]);
180 m1[1][2] =
float(m2[1][2]);
182 m1[2][0] =
float(m2[2][0]);
183 m1[2][1] =
float(m2[2][1]);
184 m1[2][2] =
float(m2[2][2]);
192 for (i = 0; i < 4; i++) {
193 for (j = 0; j < 4; j++) {
204 for (
int k = 0; k < 4; k++) {
228 __m128
A0 = _mm_loadu_ps(
A[0]);
229 __m128
A1 = _mm_loadu_ps(
A[1]);
230 __m128
A2 = _mm_loadu_ps(
A[2]);
231 __m128 A3 = _mm_loadu_ps(
A[3]);
233 for (
int i = 0; i < 4; i++) {
234 __m128 B0 = _mm_set1_ps(
B[i][0]);
235 __m128 B1 = _mm_set1_ps(
B[i][1]);
236 __m128 B2 = _mm_set1_ps(
B[i][2]);
237 __m128 B3 = _mm_set1_ps(
B[i][3]);
239 __m128 sum = _mm_add_ps(_mm_add_ps(_mm_mul_ps(B0,
A0), _mm_mul_ps(B1,
A1)),
240 _mm_add_ps(_mm_mul_ps(B2,
A2), _mm_mul_ps(B3, A3)));
242 _mm_storeu_ps(
R[i], sum);
245 R[0][0] =
B[0][0] *
A[0][0] +
B[0][1] *
A[1][0] +
B[0][2] *
A[2][0] +
B[0][3] *
A[3][0];
246 R[0][1] =
B[0][0] *
A[0][1] +
B[0][1] *
A[1][1] +
B[0][2] *
A[2][1] +
B[0][3] *
A[3][1];
247 R[0][2] =
B[0][0] *
A[0][2] +
B[0][1] *
A[1][2] +
B[0][2] *
A[2][2] +
B[0][3] *
A[3][2];
248 R[0][3] =
B[0][0] *
A[0][3] +
B[0][1] *
A[1][3] +
B[0][2] *
A[2][3] +
B[0][3] *
A[3][3];
250 R[1][0] =
B[1][0] *
A[0][0] +
B[1][1] *
A[1][0] +
B[1][2] *
A[2][0] +
B[1][3] *
A[3][0];
251 R[1][1] =
B[1][0] *
A[0][1] +
B[1][1] *
A[1][1] +
B[1][2] *
A[2][1] +
B[1][3] *
A[3][1];
252 R[1][2] =
B[1][0] *
A[0][2] +
B[1][1] *
A[1][2] +
B[1][2] *
A[2][2] +
B[1][3] *
A[3][2];
253 R[1][3] =
B[1][0] *
A[0][3] +
B[1][1] *
A[1][3] +
B[1][2] *
A[2][3] +
B[1][3] *
A[3][3];
255 R[2][0] =
B[2][0] *
A[0][0] +
B[2][1] *
A[1][0] +
B[2][2] *
A[2][0] +
B[2][3] *
A[3][0];
256 R[2][1] =
B[2][0] *
A[0][1] +
B[2][1] *
A[1][1] +
B[2][2] *
A[2][1] +
B[2][3] *
A[3][1];
257 R[2][2] =
B[2][0] *
A[0][2] +
B[2][1] *
A[1][2] +
B[2][2] *
A[2][2] +
B[2][3] *
A[3][2];
258 R[2][3] =
B[2][0] *
A[0][3] +
B[2][1] *
A[1][3] +
B[2][2] *
A[2][3] +
B[2][3] *
A[3][3];
260 R[3][0] =
B[3][0] *
A[0][0] +
B[3][1] *
A[1][0] +
B[3][2] *
A[2][0] +
B[3][3] *
A[3][0];
261 R[3][1] =
B[3][0] *
A[0][1] +
B[3][1] *
A[1][1] +
B[3][2] *
A[2][1] +
B[3][3] *
A[3][1];
262 R[3][2] =
B[3][0] *
A[0][2] +
B[3][1] *
A[1][2] +
B[3][2] *
A[2][2] +
B[3][3] *
A[3][2];
263 R[3][3] =
B[3][0] *
A[0][3] +
B[3][1] *
A[1][3] +
B[3][2] *
A[2][3] +
B[3][3] *
A[3][3];
278 R[0][0] =
B[0][0] *
A[0][0] +
B[0][1] *
A[1][0] +
B[0][2] *
A[2][0] +
B[0][3] *
A[3][0];
279 R[0][1] =
B[0][0] *
A[0][1] +
B[0][1] *
A[1][1] +
B[0][2] *
A[2][1] +
B[0][3] *
A[3][1];
280 R[0][2] =
B[0][0] *
A[0][2] +
B[0][1] *
A[1][2] +
B[0][2] *
A[2][2] +
B[0][3] *
A[3][2];
281 R[0][3] =
B[0][0] *
A[0][3] +
B[0][1] *
A[1][3] +
B[0][2] *
A[2][3] +
B[0][3] *
A[3][3];
283 R[1][0] =
B[1][0] *
A[0][0] +
B[1][1] *
A[1][0] +
B[1][2] *
A[2][0] +
B[1][3] *
A[3][0];
284 R[1][1] =
B[1][0] *
A[0][1] +
B[1][1] *
A[1][1] +
B[1][2] *
A[2][1] +
B[1][3] *
A[3][1];
285 R[1][2] =
B[1][0] *
A[0][2] +
B[1][1] *
A[1][2] +
B[1][2] *
A[2][2] +
B[1][3] *
A[3][2];
286 R[1][3] =
B[1][0] *
A[0][3] +
B[1][1] *
A[1][3] +
B[1][2] *
A[2][3] +
B[1][3] *
A[3][3];
288 R[2][0] =
B[2][0] *
A[0][0] +
B[2][1] *
A[1][0] +
B[2][2] *
A[2][0] +
B[2][3] *
A[3][0];
289 R[2][1] =
B[2][0] *
A[0][1] +
B[2][1] *
A[1][1] +
B[2][2] *
A[2][1] +
B[2][3] *
A[3][1];
290 R[2][2] =
B[2][0] *
A[0][2] +
B[2][1] *
A[1][2] +
B[2][2] *
A[2][2] +
B[2][3] *
A[3][2];
291 R[2][3] =
B[2][0] *
A[0][3] +
B[2][1] *
A[1][3] +
B[2][2] *
A[2][3] +
B[2][3] *
A[3][3];
293 R[3][0] =
B[3][0] *
A[0][0] +
B[3][1] *
A[1][0] +
B[3][2] *
A[2][0] +
B[3][3] *
A[3][0];
294 R[3][1] =
B[3][0] *
A[0][1] +
B[3][1] *
A[1][1] +
B[3][2] *
A[2][1] +
B[3][3] *
A[3][1];
295 R[3][2] =
B[3][0] *
A[0][2] +
B[3][1] *
A[1][2] +
B[3][2] *
A[2][2] +
B[3][3] *
A[3][2];
296 R[3][3] =
B[3][0] *
A[0][3] +
B[3][1] *
A[1][3] +
B[3][2] *
A[2][3] +
B[3][3] *
A[3][3];
327 R[0][0] =
B[0][0] *
A[0][0] +
B[0][1] *
A[1][0] +
B[0][2] *
A[2][0];
328 R[0][1] =
B[0][0] *
A[0][1] +
B[0][1] *
A[1][1] +
B[0][2] *
A[2][1];
329 R[0][2] =
B[0][0] *
A[0][2] +
B[0][1] *
A[1][2] +
B[0][2] *
A[2][2];
331 R[1][0] =
B[1][0] *
A[0][0] +
B[1][1] *
A[1][0] +
B[1][2] *
A[2][0];
332 R[1][1] =
B[1][0] *
A[0][1] +
B[1][1] *
A[1][1] +
B[1][2] *
A[2][1];
333 R[1][2] =
B[1][0] *
A[0][2] +
B[1][1] *
A[1][2] +
B[1][2] *
A[2][2];
335 R[2][0] =
B[2][0] *
A[0][0] +
B[2][1] *
A[1][0] +
B[2][2] *
A[2][0];
336 R[2][1] =
B[2][0] *
A[0][1] +
B[2][1] *
A[1][1] +
B[2][2] *
A[2][1];
337 R[2][2] =
B[2][0] *
A[0][2] +
B[2][1] *
A[1][2] +
B[2][2] *
A[2][2];
355 R[0][0] =
B[0][0] *
A[0][0] +
B[0][1] *
A[1][0] +
B[0][2] *
A[2][0];
356 R[0][1] =
B[0][0] *
A[0][1] +
B[0][1] *
A[1][1] +
B[0][2] *
A[2][1];
357 R[0][2] =
B[0][0] *
A[0][2] +
B[0][1] *
A[1][2] +
B[0][2] *
A[2][2];
358 R[1][0] =
B[1][0] *
A[0][0] +
B[1][1] *
A[1][0] +
B[1][2] *
A[2][0];
359 R[1][1] =
B[1][0] *
A[0][1] +
B[1][1] *
A[1][1] +
B[1][2] *
A[2][1];
360 R[1][2] =
B[1][0] *
A[0][2] +
B[1][1] *
A[1][2] +
B[1][2] *
A[2][2];
361 R[2][0] =
B[2][0] *
A[0][0] +
B[2][1] *
A[1][0] +
B[2][2] *
A[2][0];
362 R[2][1] =
B[2][0] *
A[0][1] +
B[2][1] *
A[1][1] +
B[2][2] *
A[2][1];
363 R[2][2] =
B[2][0] *
A[0][2] +
B[2][1] *
A[1][2] +
B[2][2] *
A[2][2];
377 R[0][0] =
B[0][0] *
A[0][0] +
B[0][1] *
A[1][0] +
B[0][2] *
A[2][0];
378 R[0][1] =
B[0][0] *
A[0][1] +
B[0][1] *
A[1][1] +
B[0][2] *
A[2][1];
379 R[0][2] =
B[0][0] *
A[0][2] +
B[0][1] *
A[1][2] +
B[0][2] *
A[2][2];
381 R[1][0] =
B[1][0] *
A[0][0] +
B[1][1] *
A[1][0] +
B[1][2] *
A[2][0];
382 R[1][1] =
B[1][0] *
A[0][1] +
B[1][1] *
A[1][1] +
B[1][2] *
A[2][1];
383 R[1][2] =
B[1][0] *
A[0][2] +
B[1][1] *
A[1][2] +
B[1][2] *
A[2][2];
385 R[2][0] =
B[2][0] *
A[0][0] +
B[2][1] *
A[1][0] +
B[2][2] *
A[2][0];
386 R[2][1] =
B[2][0] *
A[0][1] +
B[2][1] *
A[1][1] +
B[2][2] *
A[2][1];
387 R[2][2] =
B[2][0] *
A[0][2] +
B[2][1] *
A[1][2] +
B[2][2] *
A[2][2];
401 R[0][0] =
B[0][0] *
A[0][0] +
B[0][1] *
A[1][0] +
B[0][2] *
A[2][0];
402 R[0][1] =
B[0][0] *
A[0][1] +
B[0][1] *
A[1][1] +
B[0][2] *
A[2][1];
403 R[0][2] =
B[0][0] *
A[0][2] +
B[0][1] *
A[1][2] +
B[0][2] *
A[2][2];
405 R[1][0] =
B[1][0] *
A[0][0] +
B[1][1] *
A[1][0] +
B[1][2] *
A[2][0];
406 R[1][1] =
B[1][0] *
A[0][1] +
B[1][1] *
A[1][1] +
B[1][2] *
A[2][1];
407 R[1][2] =
B[1][0] *
A[0][2] +
B[1][1] *
A[1][2] +
B[1][2] *
A[2][2];
409 R[2][0] =
B[2][0] *
A[0][0] +
B[2][1] *
A[1][0] +
B[2][2] *
A[2][0];
410 R[2][1] =
B[2][0] *
A[0][1] +
B[2][1] *
A[1][1] +
B[2][2] *
A[2][1];
411 R[2][2] =
B[2][0] *
A[0][2] +
B[2][1] *
A[1][2] +
B[2][2] *
A[2][2];
429 R[0][0] =
B[0][0] *
A[0][0] +
B[0][1] *
A[1][0] +
B[0][2] *
A[2][0];
430 R[0][1] =
B[0][0] *
A[0][1] +
B[0][1] *
A[1][1] +
B[0][2] *
A[2][1];
431 R[0][2] =
B[0][0] *
A[0][2] +
B[0][1] *
A[1][2] +
B[0][2] *
A[2][2];
432 R[1][0] =
B[1][0] *
A[0][0] +
B[1][1] *
A[1][0] +
B[1][2] *
A[2][0];
433 R[1][1] =
B[1][0] *
A[0][1] +
B[1][1] *
A[1][1] +
B[1][2] *
A[2][1];
434 R[1][2] =
B[1][0] *
A[0][2] +
B[1][1] *
A[1][2] +
B[1][2] *
A[2][2];
435 R[2][0] =
B[2][0] *
A[0][0] +
B[2][1] *
A[1][0] +
B[2][2] *
A[2][0];
436 R[2][1] =
B[2][0] *
A[0][1] +
B[2][1] *
A[1][1] +
B[2][2] *
A[2][1];
437 R[2][2] =
B[2][0] *
A[0][2] +
B[2][1] *
A[1][2] +
B[2][2] *
A[2][2];
442 R[0][0] =
B[0][0] *
A[0][0] +
B[0][1] *
A[1][0] +
B[0][2] *
A[2][0];
443 R[0][1] =
B[0][0] *
A[0][1] +
B[0][1] *
A[1][1] +
B[0][2] *
A[2][1];
444 R[0][2] =
B[0][0] *
A[0][2] +
B[0][1] *
A[1][2] +
B[0][2] *
A[2][2];
445 R[1][0] =
B[1][0] *
A[0][0] +
B[1][1] *
A[1][0] +
B[1][2] *
A[2][0];
446 R[1][1] =
B[1][0] *
A[0][1] +
B[1][1] *
A[1][1] +
B[1][2] *
A[2][1];
447 R[1][2] =
B[1][0] *
A[0][2] +
B[1][1] *
A[1][2] +
B[1][2] *
A[2][2];
448 R[2][0] =
B[2][0] *
A[0][0] +
B[2][1] *
A[1][0] +
B[2][2] *
A[2][0];
449 R[2][1] =
B[2][0] *
A[0][1] +
B[2][1] *
A[1][1] +
B[2][2] *
A[2][1];
450 R[2][2] =
B[2][0] *
A[0][2] +
B[2][1] *
A[1][2] +
B[2][2] *
A[2][2];
464 const float m1[3][3],
465 const float m2[3][3],
466 const float m3[3][3])
473 const float m1[3][3],
474 const float m2[3][3],
475 const float m3[3][3],
476 const float m4[3][3])
485 const float m1[3][3],
486 const float m2[3][3],
487 const float m3[3][3],
488 const float m4[3][3],
489 const float m5[3][3])
499 const float m1[3][3],
500 const float m2[3][3],
501 const float m3[3][3],
502 const float m4[3][3],
503 const float m5[3][3],
504 const float m6[3][3])
515 const float m1[3][3],
516 const float m2[3][3],
517 const float m3[3][3],
518 const float m4[3][3],
519 const float m5[3][3],
520 const float m6[3][3],
521 const float m7[3][3])
533 const float m1[3][3],
534 const float m2[3][3],
535 const float m3[3][3],
536 const float m4[3][3],
537 const float m5[3][3],
538 const float m6[3][3],
539 const float m7[3][3],
540 const float m8[3][3])
564 const float m1[4][4],
565 const float m2[4][4],
566 const float m3[4][4])
573 const float m1[4][4],
574 const float m2[4][4],
575 const float m3[4][4],
576 const float m4[4][4])
585 const float m1[4][4],
586 const float m2[4][4],
587 const float m3[4][4],
588 const float m4[4][4],
589 const float m5[4][4])
599 const float m1[4][4],
600 const float m2[4][4],
601 const float m3[4][4],
602 const float m4[4][4],
603 const float m5[4][4],
604 const float m6[4][4])
615 const float m1[4][4],
616 const float m2[4][4],
617 const float m3[4][4],
618 const float m4[4][4],
619 const float m5[4][4],
620 const float m6[4][4],
621 const float m7[4][4])
633 const float m1[4][4],
634 const float m2[4][4],
635 const float m3[4][4],
636 const float m4[4][4],
637 const float m5[4][4],
638 const float m6[4][4],
639 const float m7[4][4],
640 const float m8[4][4])
661 float temp[3], warped[3];
668 r[0] = warped[0] / warped[2];
669 r[1] = warped[1] / warped[2];
679 const float x = r[0];
680 const float y = r[1];
682 r[0] =
x *
M[0][0] +
y *
M[1][0] +
M[2][0] * r[2] +
M[3][0];
683 r[1] =
x *
M[0][1] +
y *
M[1][1] +
M[2][1] * r[2] +
M[3][1];
684 r[2] =
x *
M[0][2] +
y *
M[1][2] +
M[2][2] * r[2] +
M[3][2];
687void mul_v3_m4v3(
float r[3],
const float mat[4][4],
const float vec[3])
689 const float x = vec[0];
690 const float y = vec[1];
692 r[0] =
x * mat[0][0] +
y * mat[1][0] + mat[2][0] * vec[2] + mat[3][0];
693 r[1] =
x * mat[0][1] +
y * mat[1][1] + mat[2][1] * vec[2] + mat[3][1];
694 r[2] =
x * mat[0][2] +
y * mat[1][2] + mat[2][2] * vec[2] + mat[3][2];
699 const double x = vec[0];
700 const double y = vec[1];
702 r[0] =
x * mat[0][0] +
y * mat[1][0] + mat[2][0] * vec[2] + mat[3][0];
703 r[1] =
x * mat[0][1] +
y * mat[1][1] + mat[2][1] * vec[2] + mat[3][1];
704 r[2] =
x * mat[0][2] +
y * mat[1][2] + mat[2][2] * vec[2] + mat[3][2];
708 const double x = vec[0];
709 const double y = vec[1];
711 r[0] =
x * mat[0][0] +
y * mat[1][0] + mat[2][0] * vec[2] + mat[3][0];
712 r[1] =
x * mat[0][1] +
y * mat[1][1] + mat[2][1] * vec[2] + mat[3][1];
713 r[2] =
x * mat[0][2] +
y * mat[1][2] + mat[2][2] * vec[2] + mat[3][2];
714 r[3] =
x * mat[0][3] +
y * mat[1][3] + mat[2][3] * vec[2] + mat[3][3];
717void mul_v2_m4v3(
float r[2],
const float mat[4][4],
const float vec[3])
719 const float x = vec[0];
721 r[0] =
x * mat[0][0] + vec[1] * mat[1][0] + mat[2][0] * vec[2] + mat[3][0];
722 r[1] =
x * mat[0][1] + vec[1] * mat[1][1] + mat[2][1] * vec[2] + mat[3][1];
725void mul_v2_m2v2(
float r[2],
const float mat[2][2],
const float vec[2])
727 const float x = vec[0];
729 r[0] = mat[0][0] *
x + mat[1][0] * vec[1];
730 r[1] = mat[0][1] *
x + mat[1][1] * vec[1];
740 const float x = r[0];
741 const float y = r[1];
743 r[0] =
x * mat[0][0] +
y * mat[1][0] + mat[2][0] * r[2];
744 r[1] =
x * mat[0][1] +
y * mat[1][1] + mat[2][1] * r[2];
745 r[2] =
x * mat[0][2] +
y * mat[1][2] + mat[2][2] * r[2];
750 const float x = vec[0];
751 const float y = vec[1];
753 r[0] =
x * mat[0][0] +
y * mat[1][0] + mat[2][0] * vec[2];
754 r[1] =
x * mat[0][1] +
y * mat[1][1] + mat[2][1] * vec[2];
755 r[2] =
x * mat[0][2] +
y * mat[1][2] + mat[2][2] * vec[2];
760 const double x = vec[0];
761 const double y = vec[1];
763 r[0] =
x * mat[0][0] +
y * mat[1][0] + mat[2][0] * vec[2];
764 r[1] =
x * mat[0][1] +
y * mat[1][1] + mat[2][1] * vec[2];
765 r[2] =
x * mat[0][2] +
y * mat[1][2] + mat[2][2] * vec[2];
800 const float x =
v[0];
801 const float y =
v[1];
802 const float z =
v[2];
804 r[0] =
x * mat[0][0] +
y * mat[1][0] +
z * mat[2][0] + mat[3][0] *
v[3];
805 r[1] =
x * mat[0][1] +
y * mat[1][1] +
z * mat[2][1] + mat[3][1] *
v[3];
806 r[2] =
x * mat[0][2] +
y * mat[1][2] +
z * mat[2][2] + mat[3][2] *
v[3];
807 r[3] =
x * mat[0][3] +
y * mat[1][3] +
z * mat[2][3] + mat[3][3] *
v[3];
818 r[0] =
v[0] *
M[0][0] +
v[1] *
M[1][0] +
M[2][0] *
v[2] +
M[3][0];
819 r[1] =
v[0] *
M[0][1] +
v[1] *
M[1][1] +
M[2][1] *
v[2] +
M[3][1];
820 r[2] =
v[0] *
M[0][2] +
v[1] *
M[1][2] +
M[2][2] *
v[2] +
M[3][2];
821 r[3] =
v[0] *
M[0][3] +
v[1] *
M[1][3] +
M[2][3] *
v[2] +
M[3][3];
829 r[0] =
M[0][0] * t[0] +
M[1][0] * t[1] +
M[2][0] * t[2];
830 r[1] =
M[0][1] * t[0] +
M[1][1] * t[1] +
M[2][1] * t[2];
831 r[2] =
M[0][2] * t[0] +
M[1][2] * t[1] +
M[2][2] * t[2];
839 r[0] =
M[0][0] * t[0] +
M[1][0] * t[1] +
M[2][0] * t[2];
840 r[1] =
M[0][1] * t[0] +
M[1][1] * t[1] +
M[2][1] * t[2];
841 r[2] =
M[0][2] * t[0] +
M[1][2] * t[1] +
M[2][2] * t[2];
849 r[0] =
M[0][0] * t[0] +
M[1][0] * t[1] +
M[2][0] * t[2];
850 r[1] =
M[0][1] * t[0] +
M[1][1] * t[1] +
M[2][1] * t[2];
865 const float x = r[0];
866 const float y = r[1];
868 r[0] =
x *
M[0][0] +
y *
M[0][1] +
M[0][2] * r[2];
869 r[1] =
x *
M[1][0] +
y *
M[1][1] +
M[1][2] * r[2];
870 r[2] =
x *
M[2][0] +
y *
M[2][1] +
M[2][2] * r[2];
875 const float x = r[0];
876 const float y = r[1];
878 r[0] =
x *
M[0][0] +
y *
M[0][1] +
M[0][2] * r[2];
879 r[1] =
x *
M[1][0] +
y *
M[1][1] +
M[1][2] * r[2];
880 r[2] =
x *
M[2][0] +
y *
M[2][1] +
M[2][2] * r[2];
887 for (i = 0; i < 3; i++) {
888 for (j = 0; j < 3; j++) {
898 for (i = 0; i < 4; i++) {
899 for (j = 0; j < 4; j++) {
909 for (i = 0; i < 3; i++) {
910 for (j = 0; j < 3; j++) {
920 for (i = 0; i < 3; i++) {
921 for (j = 0; j < 3; j++) {
931 for (i = 0; i < 3; i++) {
932 for (j = 0; j < 3; j++) {
942 for (i = 0; i < 4; i++) {
943 for (j = 0; j < 4; j++) {
953 for (i = 0; i < 3; i++) {
954 for (j = 0; j < 3; j++) {
955 R[i][j] =
A[i][j] +
B[i][j];
964 for (i = 0; i < 4; i++) {
965 for (j = 0; j < 4; j++) {
966 R[i][j] =
A[i][j] +
B[i][j];
975 for (i = 0; i < 3; i++) {
976 for (j = 0; j < 3; j++) {
977 R[i][j] =
A[i][j] +
B[i][j] * f;
986 for (i = 0; i < 4; i++) {
987 for (j = 0; j < 4; j++) {
988 R[i][j] =
A[i][j] +
B[i][j] * f;
997 for (i = 0; i < 3; i++) {
998 for (j = 0; j < 3; j++) {
999 R[i][j] =
A[i][j] -
B[i][j];
1006 return (m[0][0] * (m[1][1] * m[2][2] - m[1][2] * m[2][1]) -
1007 m[1][0] * (m[0][1] * m[2][2] - m[0][2] * m[2][1]) +
1008 m[2][0] * (m[0][1] * m[1][2] - m[0][2] * m[1][1]));
1013 return (m[0][0] * (m[1][1] * m[2][2] - m[1][2] * m[2][1]) -
1014 m[1][0] * (m[0][1] * m[2][2] - m[0][2] * m[2][1]) +
1015 m[2][0] * (m[0][1] * m[1][2] - m[0][2] * m[1][1]));
1020 const float det =
determinant_m2(mat[0][0], mat[1][0], mat[0][1], mat[1][1]);
1023 bool success = (det != 0.0f);
1036 float mat_tmp[3][3];
1055 success = (det != 0.0f);
1057 if (det != 0.0f) [[likely]] {
1059 for (a = 0; a < 3; a++) {
1060 for (
b = 0;
b < 3;
b++) {
1071 float mat_tmp[4][4];
1080#ifndef MATH_STANDALONE
1088 float tempmat[4][4];
1095 for (i = 0; i < 4; i++) {
1096 for (j = 0; j < 4; j++) {
1100 for (i = 0; i < 4; i++) {
1105 for (i = 0; i < 4; i++) {
1106 for (j = 0; j < 4; j++) {
1107 tempmat[i][j] = mat[i][j];
1111 for (i = 0; i < 4; i++) {
1115 for (j = i + 1; j < 4; j++) {
1123 for (k = 0; k < 4; k++) {
1124 SWAP(
float, tempmat[i][k], tempmat[maxj][k]);
1129 if (tempmat[i][i] == 0.0f) [[unlikely]] {
1132 temp = double(tempmat[i][i]);
1133 for (k = 0; k < 4; k++) {
1134 tempmat[i][k] =
float(
double(tempmat[i][k]) / temp);
1137 for (j = 0; j < 4; j++) {
1139 temp = tempmat[j][i];
1140 for (k = 0; k < 4; k++) {
1141 tempmat[j][k] -=
float(
double(tempmat[i][k]) * temp);
1152#ifndef MATH_STANDALONE
1163 float loc_a[3], rot_a[3][3], size_a[3];
1164 float loc_b[3], rot_b[3][3], size_b[3];
1165 float loc_r[3], rot_r[3][3], size_r[3];
1179 float loc_a[3], rot_a[3][3], size_a[3];
1180 float loc_b[3], rot_b[3][3], size_b[3];
1181 float loc_r[3], rot_r[3][3], size_r[3];
1292bool compare_m4m4(
const float mat1[4][4],
const float mat2[4][4],
float limit)
1481 if (len_sq_v1 > 0.0f) {
1491 float norm_v2[3], norm_v3[3], tmp[3];
1494 float cos_angle =
dot_v3v3(norm_v2, norm_v3);
1495 float abs_cos_angle =
fabsf(cos_angle);
1498 if (abs_cos_angle > 1e-4f && abs_cos_angle < 1.0f -
FLT_EPSILON) {
1564 enum {
X = 1 << 0,
Y = 1 << 1,
Z = 1 << 2 };
1566 for (
int i = 0; i < 3; i++) {
1572 if (
ELEM(flag, 0,
X |
Y |
Z)) {
1608 for (
int i = 0; i < 3; i++) {
1609 if (flag & (1 << i)) {
1611 mat[i][i] = unit_length;
1621 float *unpacked[3] = {m[0], m[1], m[2]};
1626 float *unpacked[3] = {m[0], m[1], m[2]};
1640 for (i = 0; i < 3; i++) {
1641 for (j = 0; j < i; j++) {
1655 for (i = 0; i < 4; i++) {
1656 for (j = 0; j < i; j++) {
1671 for (i = 0; i < 3; i++) {
1688 for (i = 0; i < 4; i++) {
1702 for (
int row = 0; row < 4; row++) {
1703 for (
int col = 0; col < 4; col++) {
1704 if (m[row][col] != (row == col ? 1.0f : 0.0f)) {
1715 const float eps = 1e-7f;
1717 float l1, l2, l3, l4, l5, l6;
1748 for (i = 0; i < 2; i++) {
1756 for (i = 0; i < 3; i++) {
1764 for (i = 0; i < 3; i++) {
1772 for (i = 0; i < 3; i++) {
1774 if (r_scale[i] != 0.0f) {
1775 R[i][3] /= r_scale[i];
1782 for (i = 0; i < 3; i++) {
1793 for (i = 0; i < 3; i++) {
1795 rmat[i][3] = (
len != 0.0f) ? (mat[i][3] /
len) : mat[i][3];
1802 const float r00 =
M[1][1];
1803 const float r01 = -
M[0][1];
1804 const float r10 = -
M[1][0];
1805 const float r11 =
M[0][0];
1815 const float m00 =
M[0][0], m01 =
M[0][1], m02 =
M[0][2];
1816 const float m10 =
M[1][0], m11 =
M[1][1], m12 =
M[1][2];
1817 const float m20 =
M[2][0], m21 =
M[2][1], m22 =
M[2][2];
1819 R[0][0] = m11 * m22 - m12 * m21;
1820 R[0][1] = -m01 * m22 + m02 * m21;
1821 R[0][2] = m01 * m12 - m02 * m11;
1823 R[1][0] = -m10 * m22 + m12 * m20;
1824 R[1][1] = m00 * m22 - m02 * m20;
1825 R[1][2] = -m00 * m12 + m02 * m10;
1827 R[2][0] = m10 * m21 - m11 * m20;
1828 R[2][1] = -m00 * m21 + m01 * m20;
1829 R[2][2] = m00 * m11 - m01 * m10;
1834 float a1, a2, a3, a4, b1, b2, b3, b4;
1835 float c1, c2, c3, c4, d1, d2, d3, d4;
1880 return a * d -
b * c;
1884 float a1,
float a2,
float a3,
float b1,
float b2,
float b3,
float c1,
float c2,
float c3)
1897 float a1, a2, a3, a4, b1, b2, b3, b4, c1, c2, c3, c4, d1, d2, d3, d4;
1989 float volume = size[0] * size[1] * size[2];
1991 if (volume != 0.0f) {
2054void mat4_decompose(
float loc[3],
float quat[4],
float size[3],
const float wmat[4][4])
2070#ifndef MATH_STANDALONE
2077 float W[3][3], S[3][3],
V[3][3], Vt[3][3];
2092 R[0][0] =
R[1][1] =
R[2][2] =
scale;
2093 R[0][1] =
R[0][2] = 0.0;
2094 R[1][0] =
R[1][2] = 0.0;
2095 R[2][0] =
R[2][1] = 0.0;
2100 R[0][0] =
R[1][1] =
R[2][2] =
scale;
2102 R[0][1] =
R[0][2] =
R[0][3] = 0.0;
2103 R[1][0] =
R[1][2] =
R[1][3] = 0.0;
2104 R[2][0] =
R[2][1] =
R[2][3] = 0.0;
2105 R[3][0] =
R[3][1] =
R[3][2] = 0.0;
2110 mat[3][0] += (Tx * mat[0][0] + Ty * mat[1][0] + Tz * mat[2][0]);
2111 mat[3][1] += (Tx * mat[0][1] + Ty * mat[1][1] + Tz * mat[2][1]);
2112 mat[3][2] += (Tx * mat[0][2] + Ty * mat[1][2] + Tz * mat[2][2]);
2124 for (
int col = 0; col < 4; col++) {
2125 float temp = angle_cos * mat[1][col] + angle_sin * mat[2][col];
2126 mat[2][col] = -angle_sin * mat[1][col] + angle_cos * mat[2][col];
2132 for (
int col = 0; col < 4; col++) {
2133 float temp = angle_cos * mat[0][col] - angle_sin * mat[2][col];
2134 mat[2][col] = angle_sin * mat[0][col] + angle_cos * mat[2][col];
2140 for (
int col = 0; col < 4; col++) {
2141 float temp = angle_cos * mat[0][col] + angle_sin * mat[1][col];
2142 mat[1][col] = -angle_sin * mat[0][col] + angle_cos * mat[1][col];
2174 const float dst[3][3],
2175 const float src[3][3],
2176 const float srcweight)
2178 float srot[3][3], drot[3][3];
2179 float squat[4], dquat[4], fquat[4];
2180 float sscale[3], dscale[3], fsize[3];
2181 float rmat[3][3], smat[3][3];
2200 const float dst[4][4],
2201 const float src[4][4],
2202 const float srcweight)
2204 float sloc[3], dloc[3], floc[3];
2205 float srot[3][3], drot[3][3];
2206 float squat[4], dquat[4], fquat[4];
2207 float sscale[3], dscale[3], fsize[3];
2225#ifndef MATH_STANDALONE
2231 float U_A[3][3], U_B[3][3],
U[3][3];
2232 float quat_A[4], quat_B[4], quat[4];
2235 float P_A[3][3], P_B[3][3],
P[3][3];
2263 for (i = 0; i < 3; i++) {
2273 float A3[3][3], B3[3][3], R3[3][3];
2276 float loc_A[3], loc_B[3], loc[3];
2323 const float rot[3][3],
2324 const float size[3])
2334 const float size[3])
2336 float rmat[3][3], smat[3][3], tmat[3][3];
2356 float R[4][4],
const float loc[3],
const float eul[3],
const float size[3],
const short order)
2358 float rmat[3][3], smat[3][3], tmat[3][3];
2379 const float quat[4],
2380 const float size[3])
2382 float rmat[3][3], smat[3][3], tmat[3][3];
2410 printf(
"%f %f %f\n", m[0][0], m[1][0], m[2][0]);
2411 printf(
"%f %f %f\n", m[0][1], m[1][1], m[2][1]);
2412 printf(
"%f %f %f\n", m[0][2], m[1][2], m[2][2]);
2419 printf(
"%f %f %f %f\n", m[0][0], m[1][0], m[2][0], m[3][0]);
2420 printf(
"%f %f %f %f\n", m[0][1], m[1][1], m[2][1], m[3][1]);
2421 printf(
"%f %f %f %f\n", m[0][2], m[1][2], m[2][2], m[3][2]);
2422 printf(
"%f %f %f %f\n", m[0][3], m[1][3], m[2][3], m[3][3]);
2426void svd_m4(
float U[4][4],
float s[4],
float V[4][4],
float A_[4][4])
2432 float work1[4], work2[4];
2438 float *work = work1;
2442 int i = 0, j = 0, k = 0, p, pp, iter;
2447 int nct =
min_ii(m - 1, n);
2454 for (k = 0; k <
max_ii(nct, nrt); k++) {
2461 for (i = k; i < m; i++) {
2466 if (
A[k][k] < 0.0f) {
2469 invsk = 1.0f / s[k];
2470 for (i = k; i < m; i++) {
2477 for (j = k + 1; j < n; j++) {
2478 if ((k < nct) && (s[k] != 0.0f)) {
2483 for (i = k; i < m; i++) {
2484 t +=
A[i][k] *
A[i][j];
2487 for (i = k; i < m; i++) {
2488 A[i][j] += t *
A[i][k];
2502 for (i = k; i < m; i++) {
2512 for (i = k + 1; i < n; i++) {
2517 if (
e[k + 1] < 0.0f) {
2520 invek = 1.0f /
e[k];
2521 for (i = k + 1; i < n; i++) {
2527 if ((k + 1 < m) && (
e[k] != 0.0f)) {
2532 for (i = k + 1; i < m; i++) {
2535 for (j = k + 1; j < n; j++) {
2536 for (i = k + 1; i < m; i++) {
2537 work[i] +=
e[j] *
A[i][j];
2540 invek1 = 1.0f /
e[k + 1];
2541 for (j = k + 1; j < n; j++) {
2542 float t = -
e[j] * invek1;
2543 for (i = k + 1; i < m; i++) {
2544 A[i][j] += t * work[i];
2552 for (i = k + 1; i < n; i++) {
2562 s[nct] =
A[nct][nct];
2568 e[nrt] =
A[nrt][p - 1];
2574 for (j = nct; j < nu; j++) {
2575 for (i = 0; i < m; i++) {
2580 for (k = nct - 1; k >= 0; k--) {
2582 for (j = k + 1; j < nu; j++) {
2584 for (i = k; i < m; i++) {
2585 t +=
U[i][k] *
U[i][j];
2588 for (i = k; i < m; i++) {
2589 U[i][j] += t *
U[i][k];
2592 for (i = k; i < m; i++) {
2595 U[k][k] = 1.0f +
U[k][k];
2596 for (i = 0; i < k - 1; i++) {
2601 for (i = 0; i < m; i++) {
2610 for (k = n - 1; k >= 0; k--) {
2611 if ((k < nrt) && (
e[k] != 0.0f)) {
2612 for (j = k + 1; j < nu; j++) {
2614 for (i = k + 1; i < n; i++) {
2615 t +=
V[i][k] *
V[i][j];
2617 t = -t /
V[k + 1][k];
2618 for (i = k + 1; i < n; i++) {
2619 V[i][j] += t *
V[i][k];
2623 for (i = 0; i < n; i++) {
2653 for (k = p - 2; k >= -1; k--) {
2667 for (ks = p - 1; ks >= k; ks--) {
2672 t = (ks != p ?
fabsf(
e[ks]) : 0.0f) + (ks != k + 1 ?
fabsf(
e[ks - 1]) : 0.0f);
2681 else if (ks == p - 1) {
2700 for (j = p - 2; j >= k; j--) {
2701 float t =
hypotf(s[j], f);
2702 float invt = 1.0f / t;
2703 float cs = s[j] * invt;
2704 float sn = f * invt;
2708 e[j - 1] = cs *
e[j - 1];
2711 for (i = 0; i < n; i++) {
2712 t = cs *
V[i][j] + sn *
V[i][p - 1];
2713 V[i][p - 1] = -sn *
V[i][j] + cs *
V[i][p - 1];
2725 for (j = k; j < p; j++) {
2726 float t =
hypotf(s[j], f);
2727 float invt = 1.0f / t;
2728 float cs = s[j] * invt;
2729 float sn = f * invt;
2734 for (i = 0; i < m; i++) {
2735 t = cs *
U[i][j] + sn *
U[i][k - 1];
2736 U[i][k - 1] = -sn *
U[i][j] + cs *
U[i][k - 1];
2752 float invscale = 1.0f /
scale;
2753 float sp = s[p - 1] * invscale;
2754 float spm1 = s[p - 2] * invscale;
2755 float epm1 =
e[p - 2] * invscale;
2756 float sk = s[k] * invscale;
2757 float ek =
e[k] * invscale;
2758 float b = ((spm1 + sp) * (spm1 - sp) + epm1 * epm1) * 0.5f;
2759 float c = (sp * epm1) * (sp * epm1);
2762 if ((
b != 0.0f) || (c != 0.0f)) {
2767 shift = c / (
b + shift);
2769 f = (sk + sp) * (sk - sp) + shift;
2774 for (j = k; j < p - 1; j++) {
2777 float cs = (t == 0.0f) ? 0.0f : f / t;
2778 float sn = (t == 0.0f) ? 0.0f : g / t;
2782 f = cs * s[j] + sn *
e[j];
2783 e[j] = cs *
e[j] - sn * s[j];
2785 s[j + 1] = cs * s[j + 1];
2787 for (i = 0; i < n; i++) {
2788 t = cs *
V[i][j] + sn *
V[i][j + 1];
2789 V[i][j + 1] = -sn *
V[i][j] + cs *
V[i][j + 1];
2795 cs = (t == 0.0f) ? 0.0f : f / t;
2796 sn = (t == 0.0f) ? 0.0f : g / t;
2798 f = cs *
e[j] + sn * s[j + 1];
2799 s[j + 1] = -sn *
e[j] + cs * s[j + 1];
2801 e[j + 1] = cs *
e[j + 1];
2803 for (i = 0; i < m; i++) {
2804 t = cs *
U[i][j] + sn *
U[i][j + 1];
2805 U[i][j + 1] = -sn *
U[i][j] + cs *
U[i][j + 1];
2821 s[k] = (s[k] < 0.0f ? -s[k] : 0.0f);
2823 for (i = 0; i <= pp; i++) {
2832 if (s[k] >= s[k + 1]) {
2839 for (i = 0; i < n; i++) {
2841 V[i][k + 1] =
V[i][k];
2846 for (i = 0; i < m; i++) {
2848 U[i][k + 1] =
U[i][k];
2866 float A[4][4],
V[4][4],
W[4], Wm[4][4],
U[4][4];
2875 for (i = 0; i < 4; i++) {
2876 Wm[i][i] = (
W[i] < epsilon) ? 0.0f : 1.0f /
W[i];
2888 float mat_tmp[4][4], tmpinv[4][4];
2905 float mat_tmp[4][4];
2912 mat_tmp[0][0] += 1e-8f;
2913 mat_tmp[1][1] += 1e-8f;
2914 mat_tmp[2][2] += 1e-8f;
2942 float mat_tmp[4][4];
2955 float mat_tmp[3][3];
2972 const float local[4][4],
2973 const float target[4][4])
2975 float itarget[4][4];
2982 const float local[4][4],
2983 const float target[4][4])
#define mul_m4_series(...)
#define mul_m3_series(...)
#define BLI_assert_unreachable()
SIMD_FORCE_INLINE const btScalar & z() const
Return the z value.
SIMD_FORCE_INLINE const btScalar & w() const
Return the w value.
SIMD_FORCE_INLINE btScalar angle(const btVector3 &v) const
Return the angle between this and another vector.
MatBase< C, R > inverse(MatBase< C, R >) RET
VecBase< float, D > normalize(VecOp< float, D >) RET
float3x3 scale(float3x3 mat, float2 scale)
ccl_device_inline dual1 len(const ccl_private dual< T > &a)
bool EIG_invert_m4_m4(float inverse[4][4], const float matrix[4][4])
void transpose_m3_m4(float R[3][3], const float M[4][4])
BLI_assert(slot->slot_subtype.map==BMO_OP_SLOT_SUBTYPE_MAP_FLT)
void loc_quat_size_to_mat4(float R[4][4], const float loc[3], const float quat[4], const float size[3])
void _va_mul_m4_series_3(float r[4][4], const float m1[4][4], const float m2[4][4]) ATTR_NONNULL()
void mul_m4_m4m4_split_channels(float R[4][4], const float A[4][4], const float B[4][4])
void mul_m3_v3(const float M[3][3], float r[3])
void orthogonalize_m3(float R[3][3], int axis)
float determinant_m4_mat3_array(const float m[4][4])
void mat4_to_loc_quat(float loc[3], float quat[4], const float wmat[4][4])
bool is_uniform_scaled_m4(const float m[4][4])
void eul_to_mat3(float mat[3][3], const float eul[3])
void mul_m3_m3_pre(float R[3][3], const float A[3][3])
void mat4_to_loc_rot_size(float loc[3], float rot[3][3], float size[3], const float wmat[4][4])
void orthogonalize_m4(float R[4][4], int axis)
void negate_m4(float R[4][4])
static bool orthogonalize_m3_zero_axes_impl(float *mat[3], const float unit_length)
bool is_identity_m4(const float m[4][4])
void _va_mul_m3_series_7(float r[3][3], const float m1[3][3], const float m2[3][3], const float m3[3][3], const float m4[3][3], const float m5[3][3], const float m6[3][3]) ATTR_NONNULL()
MINLINE void copy_v3_v3(float r[3], const float a[3])
void mul_m4_fl(float R[4][4], float f)
void negate_m3(float R[3][3])
void copy_m3_m4(float m1[3][3], const float m2[4][4])
void mul_m4_m4_pre(float R[4][4], const float A[4][4])
MINLINE void add_v3_v3v3(float r[3], const float a[3], const float b[3])
void _va_mul_m4_series_8(float r[4][4], const float m1[4][4], const float m2[4][4], const float m3[4][4], const float m4[4][4], const float m5[4][4], const float m6[4][4], const float m7[4][4]) ATTR_NONNULL()
void copy_m3_m3(float m1[3][3], const float m2[3][3])
void _va_mul_m3_series_4(float r[3][3], const float m1[3][3], const float m2[3][3], const float m3[3][3]) ATTR_NONNULL()
bool invert_m4_m4_fallback(float inverse[4][4], const float mat[4][4])
void negate_mat3_m4(float R[4][4])
void copy_m4_m3(float m1[4][4], const float m2[3][3])
void BLI_svd_m3(const float m3[3][3], float r_U[3][3], float r_S[3], float r_V[3][3])
Compute the SVD (Singular Values Decomposition) of given 3D matrix (m3 = USV*).
void mat3_normalized_to_quat(float q[4], const float mat[3][3])
float mat4_to_scale(const float mat[4][4])
bool invert_m3_m3(float inverse[3][3], const float mat[3][3])
void mul_v3_m4v3(float r[3], const float mat[4][4], const float vec[3])
void mul_m3_m4m3(float R[3][3], const float A[4][4], const float B[3][3])
MINLINE void copy_v2_v2(float r[2], const float a[2])
void mul_m3_m3_post(float R[3][3], const float B[3][3])
void mul_project_m4_v3(const float mat[4][4], float vec[3])
MINLINE float mul_project_m4_v3_zfac(const float mat[4][4], const float co[3]) ATTR_WARN_UNUSED_RESULT
void normalize_m3(float R[3][3]) ATTR_NONNULL()
bool compare_m4m4(const float mat1[4][4], const float mat2[4][4], float limit)
void BLI_space_transform_from_matrices(struct SpaceTransform *data, const float local[4][4], const float target[4][4])
bool invert_m4_m4(float inverse[4][4], const float mat[4][4])
void mul_v2_m3v3(float r[2], const float M[3][3], const float a[3])
bool is_uniform_scaled_m3(const float m[3][3])
void interp_m4_m4m4(float R[4][4], const float A[4][4], const float B[4][4], float t)
void _va_mul_m3_series_3(float r[3][3], const float m1[3][3], const float m2[3][3]) ATTR_NONNULL()
void mul_mat3_m4_fl(float R[4][4], float f)
float determinant_m2(float a, float b, float c, float d)
void _va_mul_m3_series_9(float r[3][3], const float m1[3][3], const float m2[3][3], const float m3[3][3], const float m4[3][3], const float m5[3][3], const float m6[3][3], const float m7[3][3], const float m8[3][3]) ATTR_NONNULL()
void BLI_space_transform_invert(const struct SpaceTransform *data, float co[3])
void mul_v3_mat3_m4v3(float r[3], const float mat[4][4], const float vec[3])
void blend_m4_m4m4(float out[4][4], const float dst[4][4], const float src[4][4], float srcweight)
void copy_m2_m2(float m1[2][2], const float m2[2][2])
bool is_negative_m4(const float mat[4][4])
void mul_m4_m4m4(float R[4][4], const float A[4][4], const float B[4][4])
void _va_mul_m3_series_8(float r[3][3], const float m1[3][3], const float m2[3][3], const float m3[3][3], const float m4[3][3], const float m5[3][3], const float m6[3][3], const float m7[3][3]) ATTR_NONNULL()
bool invert_m4(float mat[4][4])
bool orthogonalize_m3_zero_axes(float m[3][3], float unit_length)
void translate_m4(float mat[4][4], float Tx, float Ty, float Tz)
MINLINE int max_ii(int a, int b)
void mul_m3_v2(const float m[3][3], float r[2])
ATTR_WARN_UNUSED_RESULT const BMVert * v
void mul_m3_m4m4(float R[3][3], const float A[4][4], const float B[4][4])
void unit_m2(float m[2][2])
bool has_zero_axis_m4(const float matrix[4][4])
MINLINE void copy_v3_v3_db(double r[3], const double a[3])
float determinant_m3_array(const float m[3][3])
void mat3_polar_decompose(const float mat3[3][3], float r_U[3][3], float r_P[3][3])
void normalize_m2_m2(float R[2][2], const float M[2][2]) ATTR_NONNULL()
void mat3_to_rot_size(float rot[3][3], float size[3], const float mat3[3][3])
MINLINE void mul_v3_fl(float r[3], float f)
MINLINE bool is_zero_v4(const float v[4]) ATTR_WARN_UNUSED_RESULT
void normalize_m4(float R[4][4]) ATTR_NONNULL()
MINLINE bool compare_v4v4(const float v1[4], const float v2[4], float limit) ATTR_WARN_UNUSED_RESULT
void mul_m4_m4m4_aligned_scale(float R[4][4], const float A[4][4], const float B[4][4])
void _va_mul_m4_series_5(float r[4][4], const float m1[4][4], const float m2[4][4], const float m3[4][4], const float m4[4][4]) ATTR_NONNULL()
MINLINE void zero_v4(float r[4])
void eulO_to_mat3(float M[3][3], const float e[3], short order)
void copy_m3_m3d(float m1[3][3], const double m2[3][3])
void mul_transposed_m3_v3(const float M[3][3], float r[3])
void mul_m4_v3(const float M[4][4], float r[3])
void quat_to_mat3(float m[3][3], const float q[4])
void mul_v3_project_m4_v3(float r[3], const float mat[4][4], const float vec[3])
void transpose_m3_m3(float R[3][3], const float M[3][3])
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
bool is_orthogonal_m3(const float m[3][3])
MINLINE bool equals_v4v4(const float v1[4], const float v2[4]) ATTR_WARN_UNUSED_RESULT
void add_m4_m4m4(float R[4][4], const float A[4][4], const float B[4][4])
void size_to_mat4(float R[4][4], const float size[3])
void adjoint_m3_m3(float R[3][3], const float M[3][3])
void mul_v4_m4v3_db(double r[4], const double mat[4][4], const double vec[3])
void transpose_m3(float R[3][3])
void copy_m4_m4_db(double m1[4][4], const double m2[4][4])
MINLINE void cross_v3_v3v3(float r[3], const float a[3], const float b[3])
void mat3_normalized_to_quat_fast(float q[4], const float mat[3][3])
void loc_eul_size_to_mat4(float R[4][4], const float loc[3], const float eul[3], const float size[3])
void mul_m4_m4m3(float R[4][4], const float A[4][4], const float B[3][3])
BMesh const char void * data
void interp_qt_qtqt(float q[4], const float a[4], const float b[4], float t)
bool is_orthonormal_m3(const float m[3][3])
void adjoint_m2_m2(float R[2][2], const float M[2][2])
void BLI_space_transform_global_from_matrices(struct SpaceTransform *data, const float local[4][4], const float target[4][4])
void blend_m3_m3m3(float out[3][3], const float dst[3][3], const float src[3][3], float srcweight)
void _va_mul_m4_series_7(float r[4][4], const float m1[4][4], const float m2[4][4], const float m3[4][4], const float m4[4][4], const float m5[4][4], const float m6[4][4]) ATTR_NONNULL()
MINLINE void negate_v3(float r[3])
void mul_v2_m2v2(float r[2], const float mat[2][2], const float vec[2])
bool equals_m4m4(const float mat1[4][4], const float mat2[4][4])
void loc_eulO_size_to_mat4(float R[4][4], const float loc[3], const float eul[3], const float size[3], short order)
void mul_m3_m3m4(float R[3][3], const float A[3][3], const float B[4][4])
void unit_m4(float m[4][4])
void interp_v3_v3v3(float r[3], const float a[3], const float b[3], float t)
bool orthogonalize_m4_zero_axes(float m[4][4], float unit_length)
void copy_m3d_m3(double m1[3][3], const float m2[3][3])
void transform_pivot_set_m4(float mat[4][4], const float pivot[3])
void mul_m2_v2(const float mat[2][2], float vec[2])
void mul_v3_m4v3_db(double r[3], const double mat[4][4], const double vec[3])
void mul_v3_m3v3_db(double r[3], const double M[3][3], const double a[3])
void normalize_m4_ex(float R[4][4], float r_scale[3]) ATTR_NONNULL()
MINLINE float len_v3(const float a[3]) ATTR_WARN_UNUSED_RESULT
void _va_mul_m3_series_6(float r[3][3], const float m1[3][3], const float m2[3][3], const float m3[3][3], const float m4[3][3], const float m5[3][3]) ATTR_NONNULL()
void mat4_to_size_fix_shear(float size[3], const float M[4][4])
void mul_m4_v4(const float mat[4][4], float r[4])
void invert_m3_m3_safe_ortho(float inverse[3][3], const float mat[3][3])
bool is_zero_m4(const float mat[4][4])
static void orthogonalize_stable(float v1[3], float v2[3], float v3[3], bool normalize)
void mul_m3_v3_db(const double M[3][3], double r[3])
void loc_rot_size_to_mat4(float R[4][4], const float loc[3], const float rot[3][3], const float size[3])
void unit_m4_db(double m[4][4])
void ortho_v3_v3(float out[3], const float v[3])
void print_m3(const char *str, const float m[3][3])
void normalize_m3_m3(float R[3][3], const float M[3][3]) ATTR_NONNULL()
void mul_mat3_m4_v3(const float mat[4][4], float r[3])
void copy_m4d_m4(double m1[4][4], const float m2[4][4])
MINLINE float normalize_v3_v3(float r[3], const float a[3])
void mat4_to_size(float size[3], const float M[4][4])
bool invert_m3(float mat[3][3])
void invert_m4_m4_safe(float inverse[4][4], const float mat[4][4])
void mul_v4_m4v3(float r[4], const float M[4][4], const float v[3])
void mul_v2_m3v2(float r[2], const float m[3][3], const float v[2])
MINLINE void mul_v3_v3fl(float r[3], const float a[3], float f)
void transpose_m4_m4(float R[4][4], const float M[4][4])
void scale_m3_fl(float R[3][3], float scale)
MINLINE float normalize_v3(float n[3])
void pseudoinverse_m4_m4(float inverse[4][4], const float mat[4][4], float epsilon)
void mul_m3_fl(float R[3][3], float f)
void rotate_m4(float mat[4][4], char axis, float angle)
void transpose_m4(float R[4][4])
void interp_m3_m3m3(float R[3][3], const float A[3][3], const float B[3][3], float t)
void unit_m3(float m[3][3])
ATTR_WARN_UNUSED_RESULT const BMVert * v2
bool is_orthonormal_m4(const float m[4][4])
MINLINE void copy_v3_fl(float r[3], float f)
void _va_mul_m3_series_5(float r[3][3], const float m1[3][3], const float m2[3][3], const float m3[3][3], const float m4[3][3]) ATTR_NONNULL()
MINLINE float max_ff(float a, float b)
MINLINE float normalize_v3_length(float n[3], float unit_length)
void mul_m4_m4_post(float R[4][4], const float B[4][4])
MINLINE float len_squared_v3(const float v[3]) ATTR_WARN_UNUSED_RESULT
void swap_m4m4(float m1[4][4], float m2[4][4])
bool is_orthogonal_m4(const float m[4][4])
void rescale_m4(float mat[4][4], const float scale[3])
void pseudoinverse_m3_m3(float inverse[3][3], const float mat[3][3], float epsilon)
void mul_v2_m4v3(float r[2], const float mat[4][4], const float vec[3])
MINLINE float dot_v4v4(const float a[4], const float b[4]) ATTR_WARN_UNUSED_RESULT
void size_to_mat3(float R[3][3], const float size[3])
void zero_m4(float m[4][4])
void zero_m3(float m[3][3])
void _va_mul_m4_series_4(float r[4][4], const float m1[4][4], const float m2[4][4], const float m3[4][4]) ATTR_NONNULL()
void madd_m3_m3m3fl(float R[3][3], const float A[3][3], const float B[3][3], float f)
MINLINE void copy_v4_v4(float r[4], const float a[4])
void mul_m4db_m4db_m4fl(double R[4][4], const double A[4][4], const float B[4][4])
float mat4_to_size_max_axis(const float M[4][4])
void print_m4(const char *str, const float m[4][4])
void _va_mul_m4_series_9(float r[4][4], const float m1[4][4], const float m2[4][4], const float m3[4][4], const float m4[4][4], const float m5[4][4], const float m6[4][4], const float m7[4][4], const float m8[4][4]) ATTR_NONNULL()
void BLI_space_transform_apply(const struct SpaceTransform *data, float co[3])
void mul_m3_m3m3(float R[3][3], const float A[3][3], const float B[3][3])
void _va_mul_m4_series_6(float r[4][4], const float m1[4][4], const float m2[4][4], const float m3[4][4], const float m4[4][4], const float m5[4][4]) ATTR_NONNULL()
void copy_m4_m4(float m1[4][4], const float m2[4][4])
void scale_m4_fl(float R[4][4], float scale)
void mat3_to_size(float size[3], const float M[3][3])
void shuffle_m4(float R[4][4], const int index[4])
float mat4_to_volume_scale(const float mat[4][4])
void BLI_space_transform_apply_normal(const struct SpaceTransform *data, float no[3])
void normalize_m4_m4(float rmat[4][4], const float mat[4][4]) ATTR_NONNULL()
MINLINE void mul_v3_v3v3(float r[3], const float v1[3], const float v2[3])
void mul_v3_m3v3(float r[3], const float M[3][3], const float a[3])
void madd_m4_m4m4fl(float R[4][4], const float A[4][4], const float B[4][4], float f)
bool is_negative_m3(const float mat[3][3])
bool invert_m2_m2(float inverse[2][2], const float mat[2][2])
MINLINE int min_ii(int a, int b)
void sub_m3_m3m3(float R[3][3], const float A[3][3], const float B[3][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
void mul_v2_project_m4_v3(float r[2], const float mat[4][4], const float vec[3])
void mat4_decompose(float loc[3], float quat[4], float size[3], const float wmat[4][4])
void svd_m4(float U[4][4], float s[4], float V[4][4], float A_[4][4])
void orthogonalize_m4_stable(float R[4][4], int axis, bool normalize)
float determinant_m3(float a1, float a2, float a3, float b1, float b2, float b3, float c1, float c2, float c3)
float mat3_to_scale(const float mat[3][3])
void mul_v3_mat3_m4v3_db(double r[3], const double mat[4][4], const double vec[3])
void mat3_to_quat(float q[4], const float mat[3][3])
ATTR_WARN_UNUSED_RESULT const BMVert const BMEdge * e
void mul_m4_m3m4(float R[4][4], const float A[3][3], const float B[4][4])
void invert_m4_m4_safe_ortho(float inverse[4][4], const float mat[4][4])
void mul_v4_m4v4(float r[4], const float mat[4][4], const float v[4])
void BLI_space_transform_invert_normal(const struct SpaceTransform *data, float no[3])
void add_m3_m3m3(float R[3][3], const float A[3][3], const float B[3][3])
void adjoint_m4_m4(float R[4][4], const float M[4][4])
bool equals_m3m3(const float mat1[3][3], const float mat2[3][3])
void mul_transposed_mat3_m4_v3(const float M[4][4], float r[3])
float determinant_m4(const float m[4][4])
KERNEL_FEATURE_LIGHT_PASSES KERNEL_FEATURE_PATH_GUIDING float
CCL_NAMESPACE_BEGIN struct Window V