28 const float s = 1.0f - t;
30 r[0] = s * a[0] + t *
b[0];
31 r[1] = s * a[1] + t *
b[1];
35 float r[2],
const float a[2],
const float b[2],
const float c[2],
const float t[3])
37 r[0] = a[0] * t[0] +
b[0] * t[1] + c[0] * t[2];
38 r[1] = a[1] * t[0] +
b[1] * t[1] + c[1] * t[2];
43 const float s = 1.0f - t;
45 r[0] = s * a[0] + t *
b[0];
46 r[1] = s * a[1] + t *
b[1];
47 r[2] = s * a[2] + t *
b[2];
52 const float s = 1.0f - t;
54 r[0] = s * a[0] + t *
b[0];
55 r[1] = s * a[1] + t *
b[1];
56 r[2] = s * a[2] + t *
b[2];
57 r[3] = s * a[3] + t *
b[3];
76 target[0] =
w[0] * a[0] +
w[1] *
b[0];
77 target[1] =
w[0] * a[1] +
w[1] *
b[1];
78 target[2] =
w[0] * a[2] +
w[1] *
b[2];
112 float q0[2], q1[2], q2[2], r0[2], r1[2];
125 float p[3],
const float v1[3],
const float v2[3],
const float v3[3],
const float w[3])
127 p[0] = v1[0] *
w[0] +
v2[0] *
w[1] + v3[0] *
w[2];
128 p[1] = v1[1] *
w[0] +
v2[1] *
w[1] + v3[1] *
w[2];
129 p[2] = v1[2] *
w[0] +
v2[2] *
w[1] + v3[2] *
w[2];
139 p[0] = v1[0] *
w[0] +
v2[0] *
w[1] + v3[0] *
w[2] + v4[0] *
w[3];
140 p[1] = v1[1] *
w[0] +
v2[1] *
w[1] + v3[1] *
w[2] + v4[1] *
w[3];
141 p[2] = v1[2] *
w[0] +
v2[2] *
w[1] + v3[2] *
w[2] + v4[2] *
w[3];
145 float p[4],
const float v1[4],
const float v2[4],
const float v3[4],
const float w[3])
147 p[0] = v1[0] *
w[0] +
v2[0] *
w[1] + v3[0] *
w[2];
148 p[1] = v1[1] *
w[0] +
v2[1] *
w[1] + v3[1] *
w[2];
149 p[2] = v1[2] *
w[0] +
v2[2] *
w[1] + v3[2] *
w[2];
150 p[3] = v1[3] *
w[0] +
v2[3] *
w[1] + v3[3] *
w[2];
160 p[0] = v1[0] *
w[0] +
v2[0] *
w[1] + v3[0] *
w[2] + v4[0] *
w[3];
161 p[1] = v1[1] *
w[0] +
v2[1] *
w[1] + v3[1] *
w[2] + v4[1] *
w[3];
162 p[2] = v1[2] *
w[0] +
v2[2] *
w[1] + v3[2] *
w[2] + v4[2] *
w[3];
163 p[3] = v1[3] *
w[0] +
v2[3] *
w[1] + v3[3] *
w[2] + v4[3] *
w[3];
167 float p[3],
const float v1[3],
const float v2[3],
const float v3[3],
const float uv[2])
169 p[0] = v1[0] + ((
v2[0] - v1[0]) * uv[0]) + ((v3[0] - v1[0]) * uv[1]);
170 p[1] = v1[1] + ((
v2[1] - v1[1]) * uv[0]) + ((v3[1] - v1[1]) * uv[1]);
171 p[2] = v1[2] + ((
v2[2] - v1[2]) * uv[0]) + ((v3[2] - v1[2]) * uv[1]);
176 const float s = 1.0f - t;
178 target[0] = char(
floorf(s * a[0] + t *
b[0]));
179 target[1] = char(
floorf(s * a[1] + t *
b[1]));
180 target[2] = char(
floorf(s * a[2] + t *
b[2]));
185 r[0] = 0.5f * (a[0] +
b[0]);
186 r[1] = 0.5f * (a[1] +
b[1]);
187 r[2] = 0.5f * (a[2] +
b[2]);
192 r[0] = 0.5f * (a[0] +
b[0]);
193 r[1] = 0.5f * (a[1] +
b[1]);
198 v[0] = (v1[0] +
v2[0] + v3[0]) / 3.0f;
199 v[1] = (v1[1] +
v2[1] + v3[1]) / 3.0f;
204 v[0] = (v1[0] +
v2[0] + v3[0]) / 3.0f;
205 v[1] = (v1[1] +
v2[1] + v3[1]) / 3.0f;
206 v[2] = (v1[2] +
v2[2] + v3[2]) / 3.0f;
210 float v[3],
const float v1[3],
const float v2[3],
const float v3[3],
const float v4[3])
212 v[0] = (v1[0] +
v2[0] + v3[0] + v4[0]) / 4.0f;
213 v[1] = (v1[1] +
v2[1] + v3[1] + v4[1]) / 4.0f;
214 v[2] = (v1[2] +
v2[2] + v3[2] + v4[2]) / 4.0f;
219 const float factor = 1.0f /
float(vec_arr_num);
222 for (
uint i = 0; i < vec_arr_num; i++) {
254 float vec1[3], vec2[3];
264float cos_v3v3v3(
const float p1[3],
const float p2[3],
const float p3[3])
266 float vec1[3], vec2[3];
278 float vec1[3], vec2[3];
288 float vec1[2], vec2[2];
290 vec1[0] =
b[0] - a[0];
291 vec1[1] =
b[1] - a[1];
293 vec2[0] =
b[0] - c[0];
294 vec2[1] =
b[1] - c[1];
302float cos_v2v2v2(
const float p1[2],
const float p2[2],
const float p3[2])
304 float vec1[2], vec2[2];
316 float vec1[2], vec2[2];
332 const float perp_dot = (v1[1] *
v2[0]) - (v1[0] *
v2[1]);
370 float v1_proj[3], v2_proj[3];
381 float v1_proj[3], v2_proj[3], tproj[3];
404 float vec1[3], vec2[3];
417 float vec1[3], vec2[3];
425void angle_tri_v3(
float angles[3],
const float v1[3],
const float v2[3],
const float v3[3])
427 float ed1[3], ed2[3], ed3[3];
440 angles[2] =
float(
M_PI) - (angles[0] + angles[1]);
444 float angles[4],
const float v1[3],
const float v2[3],
const float v3[3],
const float v4[3])
446 float ed1[3], ed2[3], ed3[3], ed4[3];
471 for (i = 0; i <
len; i++) {
510 const float mul =
dot_v2v2(p, v_proj);
518 const float mul =
dot_v3v3(p, v_proj);
532 const float mul =
dot_v3v3(p, v_plane);
551 float d_12[3], d_23[3];
563 const float dot2 = 2.0f *
dot_v3v3(
v, normal);
574 const float d = 1.0f /
sqrtf(f);
581 r_n2[0] = -n[2] * r_n1[1];
582 r_n2[1] = n[2] * r_n1[0];
583 r_n2[2] = n[0] * r_n1[1] - n[1] * r_n1[0];
587 r_n1[0] = (n[2] < 0.0f) ? -1.0f : 1.0f;
588 r_n1[1] = r_n1[2] = r_n2[0] = r_n2[2] = 0.0f;
601 out[0] = -
v[1] -
v[2];
607 out[1] = -
v[0] -
v[2];
613 out[2] = -
v[0] -
v[1];
633 r[0] = co * p[0] - si * p[1];
634 r[1] = si * p[0] + co * p[1];
648 out[0] = ((costheta + (1 - costheta) * axis[0] * axis[0]) * p[0]) +
649 (((1 - costheta) * axis[0] * axis[1] - axis[2] * sintheta) * p[1]) +
650 (((1 - costheta) * axis[0] * axis[2] + axis[1] * sintheta) * p[2]);
652 out[1] = (((1 - costheta) * axis[0] * axis[1] + axis[2] * sintheta) * p[0]) +
653 ((costheta + (1 - costheta) * axis[1] * axis[1]) * p[1]) +
654 (((1 - costheta) * axis[1] * axis[2] - axis[0] * sintheta) * p[2]);
656 out[2] = (((1 - costheta) * axis[0] * axis[2] - axis[1] * sintheta) * p[0]) +
657 (((1 - costheta) * axis[1] * axis[2] + axis[0] * sintheta) * p[1]) +
658 ((costheta + (1 - costheta) * axis[2] * axis[2]) * p[2]);
690 printf(
"%s: %.8f %.8f %.8f %.8f\n",
str,
v[0],
v[1],
v[2],
v[3]);
705 min[0] = std::min(
min[0], vec[0]);
706 min[1] = std::min(
min[1], vec[1]);
707 min[2] = std::min(
min[2], vec[2]);
708 min[3] = std::min(
min[3], vec[3]);
710 max[0] = std::max(
max[0], vec[0]);
711 max[1] = std::max(
max[1], vec[1]);
712 max[2] = std::max(
max[2], vec[2]);
713 max[3] = std::max(
max[3], vec[3]);
718 min[0] = std::min(
min[0], vec[0]);
719 min[1] = std::min(
min[1], vec[1]);
720 min[2] = std::min(
min[2], vec[2]);
722 max[0] = std::max(
max[0], vec[0]);
723 max[1] = std::max(
max[1], vec[1]);
724 max[2] = std::max(
max[2], vec[2]);
729 min[0] = std::min(
min[0], vec[0]);
730 min[1] = std::min(
min[1], vec[1]);
732 max[0] = std::max(
max[0], vec[0]);
733 max[1] = std::max(
max[1], vec[1]);
763#define SWAP_AXIS(a, b) \
765 SWAP(float, v[a], v[b]); \
766 SWAP(int, r_axis_order[a], r_axis_order[b]); \
801double dot_vn_vn(
const float *array_src_a,
const float *array_src_b,
const int size)
804 const float *array_pt_a = array_src_a + (size - 1);
805 const float *array_pt_b = array_src_b + (size - 1);
808 d += double(*(array_pt_a--) * *(array_pt_b--));
816 const float *array_pt =
array + (size - 1);
819 d +=
sqr_db(
double(*(array_pt)--));
830 mul_vn_vn_fl(array_tar, array_src, size, 1.0f / d_sqrt);
833 std::fill_n(array_tar, size, 0.0f);
844void range_vn_fl(
float *array_tar,
const int size,
const float start,
const float step)
846 float *array_pt = array_tar + (size - 1);
849 *(array_pt--) = start +
step *
float(i);
855 float *array_pt = array_tar + (size - 1);
858 *(array_pt--) *= -1.0f;
862void negate_vn_vn(
float *array_tar,
const float *array_src,
const int size)
864 float *tar = array_tar + (size - 1);
865 const float *src = array_src + (size - 1);
868 *(tar--) = -*(src--);
872void mul_vn_vn(
float *array_tar,
const float *array_src,
const int size)
874 float *tar = array_tar + (size - 1);
875 const float *src = array_src + (size - 1);
878 *(tar--) *= *(src--);
883 const float *array_src_a,
884 const float *array_src_b,
887 float *tar = array_tar + (size - 1);
888 const float *src_a = array_src_a + (size - 1);
889 const float *src_b = array_src_b + (size - 1);
892 *(tar--) = *(src_a--) * *(src_b--);
896void mul_vn_fl(
float *array_tar,
const int size,
const float f)
898 float *array_pt = array_tar + (size - 1);
905void mul_vn_vn_fl(
float *array_tar,
const float *array_src,
const int size,
const float f)
907 float *tar = array_tar + (size - 1);
908 const float *src = array_src + (size - 1);
911 *(tar--) = *(src--) * f;
915void add_vn_vn(
float *array_tar,
const float *array_src,
const int size)
917 float *tar = array_tar + (size - 1);
918 const float *src = array_src + (size - 1);
921 *(tar--) += *(src--);
926 const float *array_src_a,
927 const float *array_src_b,
930 float *tar = array_tar + (size - 1);
931 const float *src_a = array_src_a + (size - 1);
932 const float *src_b = array_src_b + (size - 1);
935 *(tar--) = *(src_a--) + *(src_b--);
939void sub_vn_vn(
float *array_tar,
const float *array_src,
const int size)
941 float *tar = array_tar + (size - 1);
942 const float *src = array_src + (size - 1);
945 *(tar--) -= *(src--);
950 const float *array_src_a,
951 const float *array_src_b,
954 float *tar = array_tar + (size - 1);
955 const float *src_a = array_src_a + (size - 1);
956 const float *src_b = array_src_b + (size - 1);
959 *(tar--) = *(src_a--) - *(src_b--);
963void interp_vn_vn(
float *array_tar,
const float *array_src,
const float t,
const int size)
965 const float s = 1.0f - t;
966 float *tar = array_tar + (size - 1);
967 const float *src = array_src + (size - 1);
970 *(tar) = (s * *(tar)) + (t * *(src));
982void add_vn_vn_d(
double *array_tar,
const double *array_src,
const int size)
984 double *tar = array_tar + (size - 1);
985 const double *src = array_src + (size - 1);
988 *(tar--) += *(src--);
993 const double *array_src_a,
994 const double *array_src_b,
997 double *tar = array_tar + (size - 1);
998 const double *src_a = array_src_a + (size - 1);
999 const double *src_b = array_src_b + (size - 1);
1002 *(tar--) = *(src_a--) + *(src_b--);
1006void mul_vn_db(
double *array_tar,
const int size,
const double f)
1008 double *array_pt = array_tar + (size - 1);
1017 const double s = 1.0f - t;
1019 target[0] = s * a[0] + t *
b[0];
1020 target[1] = s * a[1] + t *
b[1];
1021 target[2] = s * a[2] + t *
b[2];
1026 const double s = 1.0f - t;
1028 target[0] = s * a[0] + t *
b[0];
1029 target[1] = s * a[1] + t *
b[1];
#define BLI_ASSERT_UNIT_V2(v)
#define BLI_ASSERT_UNIT_V3(v)
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.
VecBase< float, D > step(VecOp< float, D >, VecOp< float, D >) RET
ccl_device_inline dual1 len(const ccl_private dual< T > &a)
MINLINE void madd_v3_v3v3fl(float r[3], const float a[3], const float b[3], float f)
BLI_assert(slot->slot_subtype.map==BMO_OP_SLOT_SUBTYPE_MAP_FLT)
void mul_vn_fl(float *array_tar, int size, float f)
MINLINE void negate_v3_v3(float r[3], const float a[3])
void mid_v3_v3v3_angle_weighted(float r[3], const float a[3], const float b[3])
float angle_normalized_v3v3(const float v1[3], const float v2[3]) ATTR_WARN_UNUSED_RESULT
float normalize_vn_vn(float *array_tar, const float *array_src, int size)
void mid_v2_v2v2v2(float v[2], const float v1[2], const float v2[2], const float v3[2])
void angle_quad_v3(float angles[4], const float v1[3], const float v2[3], const float v3[3], const float v4[3])
MINLINE bool is_zero_v2(const float v[2]) ATTR_WARN_UNUSED_RESULT
bool interp_v3_v3v3_slerp(float target[3], const float a[3], const float b[3], float t) ATTR_WARN_UNUSED_RESULT
MINLINE float safe_asinf(float a)
void rotate_normalized_v3_v3v3fl(float out[3], const float p[3], const float axis[3], float angle)
void interp_v4_v4v4v4(float p[4], const float v1[4], const float v2[4], const float v3[4], const float w[3])
void mid_v3_v3v3v3v3(float v[3], const float v1[3], const float v2[3], const float v3[3], const float v4[3])
MINLINE void copy_v3_v3(float r[3], const float a[3])
void sub_vn_vnvn(float *array_tar, const float *array_src_a, const float *array_src_b, int size)
float angle_v2v2v2(const float a[2], const float b[2], const float c[2]) ATTR_WARN_UNUSED_RESULT
void minmax_v3v3_v3(float min[3], float max[3], const float vec[3])
void add_vn_vn(float *array_tar, const float *array_src, int size)
MINLINE void add_v3_v3v3(float r[3], const float a[3], const float b[3])
float normalize_vn(float *array_tar, int size)
void mid_v3_v3v3v3(float v[3], const float v1[3], const float v2[3], const float v3[3])
void mul_vn_vn_fl(float *array_tar, const float *array_src, int size, float f)
MINLINE double sqr_db(double f)
void interp_v2_v2v2v2(float r[2], const float a[2], const float b[2], const float c[2], const float t[3])
void interp_v4_v4v4(float r[4], const float a[4], const float b[4], float t)
MINLINE void negate_v2_v2(float r[2], const float a[2])
void project_v3_v3v3_normalized(float out[3], const float p[3], const float v_proj[3])
void mul_vn_db(double *array_tar, int size, double f)
float angle_v3v3v3(const float a[3], const float b[3], const float c[3]) ATTR_WARN_UNUSED_RESULT
void print_vn(const char *str, const float v[], int n)
void project_v2_v2v2_normalized(float out[2], const float p[2], const float v_proj[2])
void project_v3_plane(float out[3], const float plane_no[3], const float plane_co[3])
float angle_v3v3(const float a[3], const float b[3]) ATTR_WARN_UNUSED_RESULT
void angle_tri_v3(float angles[3], const float v1[3], const float v2[3], const float v3[3])
void ortho_v2_v2(float out[2], const float v[2])
float angle_signed_v2v2(const float v1[2], const float v2[2]) ATTR_WARN_UNUSED_RESULT
MINLINE void sub_v2_v2v2(float r[2], const float a[2], const float b[2])
void interp_v2_v2v2_db(double target[2], const double a[2], const double b[2], double t)
void interp_vn_vn(float *array_tar, const float *array_src, float t, int size)
MINLINE float normalize_v2(float n[2])
void interp_dot_slerp(float t, float cosom, float r_w[2])
void project_plane_normalized_v3_v3v3(float out[3], const float p[3], const float v_plane[3])
ATTR_WARN_UNUSED_RESULT const BMVert * v
void add_vn_vn_d(double *array_tar, const double *array_src, int size)
void print_v3(const char *str, const float v[3])
void range_vn_fl(float *array_tar, int size, float start, float step)
float angle_signed_on_axis_v3v3_v3(const float v1[3], const float v2[3], const float axis[3]) ATTR_WARN_UNUSED_RESULT
MINLINE void mul_v3_fl(float r[3], float f)
void project_v3_v3v3(float out[3], const float p[3], const float v_proj[3])
float angle_on_axis_v3v3v3_v3(const float v1[3], const float v2[3], const float v3[3], const float axis[3]) ATTR_WARN_UNUSED_RESULT
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
float angle_normalized_v2v2(const float a[2], const float b[2]) ATTR_WARN_UNUSED_RESULT
void interp_v3_v3v3v3_uv(float p[3], const float v1[3], const float v2[3], const float v3[3], const float uv[2])
double dot_vn_vn(const float *array_src_a, const float *array_src_b, int size) ATTR_WARN_UNUSED_RESULT
void dist_ensure_v3_v3fl(float v1[3], const float v2[3], float dist)
float angle_signed_on_axis_v3v3v3_v3(const float v1[3], const float v2[3], const float v3[3], const float axis[3]) ATTR_WARN_UNUSED_RESULT
MINLINE void cross_v3_v3v3(float r[3], const float a[3], const float b[3])
void rotate_v2_v2fl(float r[2], const float p[2], float angle)
void minmax_v2v2_v2(float min[2], float max[2], const float vec[2])
MINLINE int axis_dominant_v3_single(const float vec[3])
void interp_v3_v3v3v3v3(float p[3], const float v1[3], const float v2[3], const float v3[3], const float v4[3], const float w[4])
double len_squared_vn(const float *array, int size) ATTR_WARN_UNUSED_RESULT
void project_v2_v2v2(float out[2], const float p[2], const float v_proj[2])
void mul_vn_vn(float *array_tar, const float *array_src, int size)
void interp_v3_v3v3(float r[3], const float a[3], const float b[3], float t)
float cos_v2v2v2(const float p1[2], const float p2[2], const float p3[2]) ATTR_WARN_UNUSED_RESULT
void minmax_v4v4_v4(float min[4], float max[4], const float vec[4])
void print_v4(const char *str, const float v[4])
MINLINE void mul_v2_v2fl(float r[2], const float a[2], float f)
MINLINE void zero_v3(float r[3])
void dist_ensure_v2_v2fl(float v1[2], const float v2[2], float dist)
MINLINE float dot_v2v2(const float a[2], const float b[2]) ATTR_WARN_UNUSED_RESULT
void reflect_v3_v3v3(float out[3], const float v[3], const float normal[3])
void add_vn_vnvn(float *array_tar, const float *array_src_a, const float *array_src_b, int size)
MINLINE bool equals_v2v2(const float v1[2], const float v2[2]) ATTR_WARN_UNUSED_RESULT
void print_v2(const char *str, const float v[2])
void ortho_v3_v3(float out[3], const float v[3])
void project_plane_v3_v3v3(float out[3], const float p[3], const float v_plane[3])
MINLINE float normalize_v3_v3(float r[3], const float a[3])
void interp_v3_v3v3_slerp_safe(float target[3], const float a[3], const float b[3], float t)
MINLINE void mul_v3_v3fl(float r[3], const float a[3], float f)
MINLINE float normalize_v3(float n[3])
MINLINE float len_squared_v2(const float v[2]) ATTR_WARN_UNUSED_RESULT
void interp_v3_v3v3_db(double target[3], const double a[3], const double b[3], double t)
MINLINE void sub_v3_v3v3(float r[3], const float a[3], const float b[3])
void mid_v3_v3v3(float r[3], const float a[3], const float b[3])
void sub_vn_vn(float *array_tar, const float *array_src, int size)
ATTR_WARN_UNUSED_RESULT const BMVert * v2
float angle_on_axis_v3v3_v3(const float v1[3], const float v2[3], const float axis[3]) ATTR_WARN_UNUSED_RESULT
void interp_v2_v2v2(float r[2], const float a[2], const float b[2], float t)
void interp_v3_v3v3_uchar(unsigned char target[3], const unsigned char a[3], const unsigned char b[3], float t)
MINLINE float len_v2v2(const float v1[2], const float v2[2]) ATTR_WARN_UNUSED_RESULT
void bisect_v3_v3v3v3(float r[3], const float a[3], const float b[3], const float c[3])
void mid_v2_v2v2(float r[2], const float a[2], const float b[2])
void negate_vn(float *array_tar, int size)
void axis_sort_v3(const float axis_values[3], int r_axis_order[3])
MINLINE float len_squared_v3(const float v[3]) ATTR_WARN_UNUSED_RESULT
void interp_v2_v2v2v2v2_cubic(float p[2], const float v1[2], const float v2[2], const float v3[2], const float v4[2], float u)
void negate_vn_vn(float *array_tar, const float *array_src, int size)
float angle_v2v2(const float a[2], const float b[2]) ATTR_WARN_UNUSED_RESULT
void mul_vn_vnvn(float *array_tar, const float *array_src_a, const float *array_src_b, int size)
void interp_v3_v3v3v3(float p[3], const float v1[3], const float v2[3], const float v3[3], const float w[3])
void ortho_basis_v3v3_v3(float r_n1[3], float r_n2[3], const float n[3])
MINLINE float len_v3v3(const float a[3], const float b[3]) ATTR_WARN_UNUSED_RESULT
void interp_v4_v4v4v4v4(float p[4], const float v1[4], const float v2[4], const float v3[4], const float v4[4], const float w[4])
MINLINE float dot_v3v3(const float a[3], const float b[3]) ATTR_WARN_UNUSED_RESULT
float cos_v3v3v3(const float p1[3], const float p2[3], const float p3[3]) ATTR_WARN_UNUSED_RESULT
MINLINE void zero_v2(float r[2])
MINLINE bool is_zero_v3(const float v[3]) ATTR_WARN_UNUSED_RESULT
void mid_v3_v3_array(float r[3], const float(*vec_arr)[3], unsigned int vec_arr_num)
void rotate_v3_v3v3fl(float r[3], const float p[3], const float axis[3], float angle)
MINLINE void madd_v2_v2v2fl(float r[2], const float a[2], const float b[2], float f)
void angle_poly_v3(float *angles, const float *verts[3], int len)
void add_vn_vnvn_d(double *array_tar, const double *array_src_a, const double *array_src_b, int size)
KERNEL_FEATURE_LIGHT_PASSES KERNEL_FEATURE_PATH_GUIDING float