Blender V5.3
quadric.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
19
20#include <cstring>
21
22#include "BLI_math_base_c.hh"
23#include "BLI_math_matrix_c.hh"
24#include "BLI_math_vector_c.hh"
25#include "BLI_quadric.hh" /* own include */
26
27#include "BLI_strict_flags.hh" /* IWYU pragma: keep. Keep last. */
28
29namespace blender {
30
31#define QUADRIC_FLT_TOT (sizeof(Quadric) / sizeof(double))
32
33void BLI_quadric_from_plane(Quadric *q, const double v[4])
34{
35 q->a2 = v[0] * v[0];
36 q->b2 = v[1] * v[1];
37 q->c2 = v[2] * v[2];
38
39 q->ab = v[0] * v[1];
40 q->ac = v[0] * v[2];
41 q->bc = v[1] * v[2];
42
43 q->ad = v[0] * v[3];
44 q->bd = v[1] * v[3];
45 q->cd = v[2] * v[3];
46
47 q->d2 = v[3] * v[3];
48}
49
50#if 0 /* UNUSED */
51
52static void quadric_to_tensor_m3(const Quadric *q, double m[3][3])
53{
54 m[0][0] = q->a2;
55 m[0][1] = q->ab;
56 m[0][2] = q->ac;
57
58 m[1][0] = q->ab;
59 m[1][1] = q->b2;
60 m[1][2] = q->bc;
61
62 m[2][0] = q->ac;
63 m[2][1] = q->bc;
64 m[2][2] = q->c2;
65}
66
67#endif
68
78static bool quadric_to_tensor_m3_inverse(const Quadric *q, double m[3][3], double epsilon)
79{
80 const double det = (q->a2 * (q->b2 * q->c2 - q->bc * q->bc) -
81 q->ab * (q->ab * q->c2 - q->ac * q->bc) +
82 q->ac * (q->ab * q->bc - q->ac * q->b2));
83
84 if (fabs(det) > epsilon) {
85 const double invdet = 1.0 / det;
86
87 m[0][0] = (q->b2 * q->c2 - q->bc * q->bc) * invdet;
88 m[1][0] = (q->bc * q->ac - q->ab * q->c2) * invdet;
89 m[2][0] = (q->ab * q->bc - q->b2 * q->ac) * invdet;
90
91 m[0][1] = (q->ac * q->bc - q->ab * q->c2) * invdet;
92 m[1][1] = (q->a2 * q->c2 - q->ac * q->ac) * invdet;
93 m[2][1] = (q->ab * q->ac - q->a2 * q->bc) * invdet;
94
95 m[0][2] = (q->ab * q->bc - q->ac * q->b2) * invdet;
96 m[1][2] = (q->ac * q->ab - q->a2 * q->bc) * invdet;
97 m[2][2] = (q->a2 * q->b2 - q->ab * q->ab) * invdet;
98
99 return true;
100 }
101
102 return false;
103}
104
105void BLI_quadric_to_vector_v3(const Quadric *q, double v[3])
106{
107 v[0] = q->ad;
108 v[1] = q->bd;
109 v[2] = q->cd;
110}
111
113{
114 memset(q, 0, sizeof(*q));
115}
116
118{
119 add_vn_vn_d(reinterpret_cast<double *>(a),
120 reinterpret_cast<double *>(const_cast<Quadric *>(b)),
122}
123
125{
126 add_vn_vnvn_d(reinterpret_cast<double *>(r),
127 reinterpret_cast<const double *>(a),
128 reinterpret_cast<const double *>(b),
130}
131
132void BLI_quadric_mul(Quadric *a, const double scalar)
133{
134 mul_vn_db(reinterpret_cast<double *>(a), QUADRIC_FLT_TOT, scalar);
135}
136
137double BLI_quadric_evaluate(const Quadric *q, const double v[3])
138{
139 const double v00 = v[0] * v[0], v01 = v[0] * v[1], v02 = v[0] * v[2];
140 const double v11 = v[1] * v[1], v12 = v[1] * v[2];
141 const double v22 = v[2] * v[2];
142 return ((q->a2 * v00) + (q->ab * 2 * v01) + (q->ac * 2 * v02) + (q->ad * 2 * v[0]) + /* a */
143 (q->b2 * v11) + (q->bc * 2 * v12) + (q->bd * 2 * v[1]) + /* b */
144 (q->c2 * v22) + (q->cd * 2 * v[2]) + /* c */
145 (q->d2) /* d */
146 );
147}
148
149bool BLI_quadric_optimize(const Quadric *q, double v[3], const double epsilon)
150{
151 double m[3][3];
152
153 if (quadric_to_tensor_m3_inverse(q, m, epsilon)) {
155 mul_m3_v3_db(m, v);
157 return true;
158 }
159
160 return false;
161}
162
163} // namespace blender
ccl_device_inline dual3 fabs(const ccl_private dual3 &a)
Definition math_dual.h:241
BMesh Iterators.
void BLI_quadric_clear(Quadric *q)
Definition quadric.cc:112
void mul_vn_db(double *array_tar, int size, double f)
void BLI_quadric_from_plane(Quadric *q, const double v[4])
Definition quadric.cc:33
ATTR_WARN_UNUSED_RESULT const BMVert * v
void BLI_quadric_add_qu_ququ(Quadric *r, const Quadric *a, const Quadric *b)
Definition quadric.cc:124
void add_vn_vn_d(double *array_tar, const double *array_src, int size)
bool BLI_quadric_optimize(const Quadric *q, double v[3], double epsilon)
Definition quadric.cc:149
void BLI_quadric_to_vector_v3(const Quadric *q, double v[3])
Definition quadric.cc:105
static bool quadric_to_tensor_m3_inverse(const Quadric *q, double m[3][3], double epsilon)
Definition quadric.cc:78
void BLI_quadric_add_qu_qu(Quadric *a, const Quadric *b)
Definition quadric.cc:117
void mul_m3_v3_db(const double M[3][3], double r[3])
double BLI_quadric_evaluate(const Quadric *q, const double v[3])
Definition quadric.cc:137
MINLINE void negate_v3_db(double r[3])
void BLI_quadric_mul(Quadric *a, double scalar)
Definition quadric.cc:132
void add_vn_vnvn_d(double *array_tar, const double *array_src_a, const double *array_src_b, int size)
#define QUADRIC_FLT_TOT
Definition quadric.cc:31