52 #ifndef OPENMESH_GEOMETRY_QUADRIC_HH
53 #define OPENMESH_GEOMETRY_QUADRIC_HH
59 #include <OpenMesh/Core/Geometry/VectorT.hh>
60 #include <OpenMesh/Core/Utils/GenProg.hh>
77 template <
class Scalar>
81 typedef Scalar value_type;
90 QuadricT(Scalar _a, Scalar _b, Scalar _c, Scalar _d,
91 Scalar _e, Scalar _f, Scalar _g,
94 : a_(_a), b_(_b), c_(_c), d_(_d),
95 e_(_e), f_(_f), g_(_g),
103 QuadricT( Scalar _a=0.0, Scalar _b=0.0, Scalar _c=0.0, Scalar _d=0.0 )
104 : a_(_a*_a), b_(_a*_b), c_(_a*_c), d_(_a*_d),
105 e_(_b*_b), f_(_b*_c), g_(_b*_d),
106 h_(_c*_c), i_(_c*_d),
110 template <
class _Po
int>
113 set_distance_to_point(_pt);
116 template <
class _Normal,
class _Po
int>
117 QuadricT(
const _Normal& _n,
const _Point& _p)
119 set_distance_to_plane(_n,_p);
123 void set(Scalar _a, Scalar _b, Scalar _c, Scalar _d,
124 Scalar _e, Scalar _f, Scalar _g,
125 Scalar _h, Scalar _i,
128 a_ = _a; b_ = _b; c_ = _c; d_ = _d;
129 e_ = _e; f_ = _f; g_ = _g;
135 template <
class _Po
int>
136 void set_distance_to_point(
const _Point& _pt)
138 set(1, 0, 0, -_pt[0],
145 void set_distance_to_plane(Scalar _a, Scalar _b, Scalar _c, Scalar _d)
147 a_ = _a*_a; b_ = _a*_b; c_ = _a*_c; d_ = _a*_d;
148 e_ = _b*_b; f_ = _b*_c; g_ = _b*_d;
149 h_ = _c*_c; i_ = _c*_d;
155 template <
class _Normal,
class _Po
int>
156 void set_distance_to_plane(
const _Normal& _n,
const _Point& _p)
158 set_distance_to_plane(_n[0], _n[1], _n[2], -
dot(_n,_p));
162 void clear() { a_ = b_ = c_ = d_ = e_ = f_ = g_ = h_ = i_ = j_ = 0.0; }
167 a_ += _q.a_; b_ += _q.b_; c_ += _q.c_; d_ += _q.d_;
168 e_ += _q.e_; f_ += _q.f_; g_ += _q.g_;
169 h_ += _q.h_; i_ += _q.i_;
178 a_ *= _s; b_ *= _s; c_ *= _s; d_ *= _s;
179 e_ *= _s; f_ *= _s; g_ *= _s;
187 template <
class _Vec4>
190 Scalar x(_v[0]), y(_v[1]), z(_v[2]), w(_v[3]);
191 return _Vec4(x*a_ + y*b_ + z*c_ + w*d_,
192 x*b_ + y*e_ + z*f_ + w*g_,
193 x*c_ + y*f_ + z*h_ + w*i_,
194 x*d_ + y*g_ + z*i_ + w*j_);
198 template <
class _Vec>
201 return evaluate(_v, GenProg::Int2Type<_Vec::size_>());
204 Scalar a()
const {
return a_; }
205 Scalar b()
const {
return b_; }
206 Scalar c()
const {
return c_; }
207 Scalar d()
const {
return d_; }
208 Scalar e()
const {
return e_; }
209 Scalar f()
const {
return f_; }
210 Scalar g()
const {
return g_; }
211 Scalar h()
const {
return h_; }
212 Scalar i()
const {
return i_; }
213 Scalar j()
const {
return j_; }
215 Scalar xx()
const {
return a_; }
216 Scalar xy()
const {
return b_; }
217 Scalar xz()
const {
return c_; }
218 Scalar xw()
const {
return d_; }
219 Scalar yy()
const {
return e_; }
220 Scalar yz()
const {
return f_; }
221 Scalar yw()
const {
return g_; }
222 Scalar zz()
const {
return h_; }
223 Scalar zw()
const {
return i_; }
224 Scalar ww()
const {
return j_; }
229 template <
class _Vec3>
230 Scalar
evaluate(
const _Vec3& _v, GenProg::Int2Type<3>)
const
232 Scalar x(_v[0]), y(_v[1]), z(_v[2]);
233 return a_*x*x + 2.0*b_*x*y + 2.0*c_*x*z + 2.0*d_*x
234 + e_*y*y + 2.0*f_*y*z + 2.0*g_*y
240 template <
class _Vec4>
241 Scalar
evaluate(
const _Vec4& _v, GenProg::Int2Type<4>)
const
243 Scalar x(_v[0]), y(_v[1]), z(_v[2]), w(_v[3]);
244 return a_*x*x + 2.0*b_*x*y + 2.0*c_*x*z + 2.0*d_*x*w
245 + e_*y*y + 2.0*f_*y*z + 2.0*g_*y*w
246 + h_*z*z + 2.0*i_*z*w
252 Scalar a_, b_, c_, d_,
260 typedef QuadricT<float> Quadricf;
263 typedef QuadricT<double> Quadricd;
270 #endif // OPENMESH_GEOMETRY_HH defined
/class QuadricT Geometry/QuadricT.hh
Definition: QuadricT.hh:78
QuadricT(Scalar _a, Scalar _b, Scalar _c, Scalar _d, Scalar _e, Scalar _f, Scalar _g, Scalar _h, Scalar _i, Scalar _j)
construct with upper triangle of symmetrix 4x4 matrix
Definition: QuadricT.hh:90
Scalar operator()(const _Vec &_v) const
evaluate quadric Q at (3D or 4D) vector v: v*Q*v
Definition: QuadricT.hh:199
Scalar evaluate(const _Vec4 &_v, GenProg::Int2Type< 4 >) const
evaluate quadric Q at 4D vector v: v*Q*v
Definition: QuadricT.hh:241
osg::Vec3f::ValueType dot(const osg::Vec3f &_v1, const osg::Vec3f &_v2)
Adapter for osg vector member computing a scalar product.
Definition: VectorAdapter.hh:174
void clear()
set all entries to zero
Definition: QuadricT.hh:162
QuadricT< Scalar > & operator*=(Scalar _s)
multiply by scalar
Definition: QuadricT.hh:176
QuadricT< Scalar > & operator+=(const QuadricT< Scalar > &_q)
add quadrics
Definition: QuadricT.hh:165
QuadricT(Scalar _a=0.0, Scalar _b=0.0, Scalar _c=0.0, Scalar _d=0.0)
constructor from given plane equation: ax+by+cz+d_=0
Definition: QuadricT.hh:103
_Vec4 operator*(const _Vec4 &_v) const
multiply 4D vector from right: Q*v
Definition: QuadricT.hh:188
Scalar evaluate(const _Vec3 &_v, GenProg::Int2Type< 3 >) const
evaluate quadric Q at 3D vector v: v*Q*v
Definition: QuadricT.hh:230