mirror of https://github.com/CGAL/cgal
Add static filter for Orientation_5
This commit is contained in:
Andreas Fabri
parent
e622f3e03e
commit
b9f983a515
|
|
@ -0,0 +1,279 @@
|
||||||
|
// Copyright (c) 20025 GeometryFactory (France).
|
||||||
|
// All rights reserved.
|
||||||
|
//
|
||||||
|
// This file is part of CGAL (www.cgal.org)
|
||||||
|
//
|
||||||
|
// $URL$
|
||||||
|
// $Id$
|
||||||
|
// SPDX-License-Identifier: LGPL-3.0-or-later OR LicenseRef-Commercial
|
||||||
|
//
|
||||||
|
//
|
||||||
|
// Author(s) : Andreas Fabri
|
||||||
|
|
||||||
|
#ifndef CGAL_INTERNAL_STATIC_FILTERS_ORIENTATION_5_H
|
||||||
|
#define CGAL_INTERNAL_STATIC_FILTERS_ORIENTATION_5_H
|
||||||
|
|
||||||
|
#include <CGAL/Profile_counter.h>
|
||||||
|
#include <CGAL/Filtered_kernel/internal/Static_filters/Static_filter_error.h>
|
||||||
|
#include <cmath>
|
||||||
|
|
||||||
|
namespace CGAL { namespace internal { namespace Static_filters_predicates {
|
||||||
|
|
||||||
|
template < typename K_base >
|
||||||
|
class Orientation_5
|
||||||
|
: public K_base::Orientation_5
|
||||||
|
{
|
||||||
|
typedef typename K_base::Orientation Orientation;
|
||||||
|
typedef typename K_base::Point_5 Point_5;
|
||||||
|
typedef typename K_base::Orientation_5 Base;
|
||||||
|
|
||||||
|
public:
|
||||||
|
using Base::operator();
|
||||||
|
|
||||||
|
Orientation
|
||||||
|
operator()(const Point_5 &p, const Point_5 &q,
|
||||||
|
const Point_5 &r, const Point_5 &s,
|
||||||
|
const Point_5 &t, const Point_5 &u) const
|
||||||
|
{
|
||||||
|
CGAL_BRANCH_PROFILER_5("semi-static failures/attempts/calls to : Orientation_5", tmp);
|
||||||
|
|
||||||
|
double p0, p1, p2, p3, p4, q0, q1, q2, q3, q4, r0, r1, r2, r3, r4, s0, s1, s2, s3, s4;
|
||||||
|
|
||||||
|
if (fit_in_double(p.c0(), po) && fit_in_double(p.c1(), p1) &&
|
||||||
|
fit_in_double(p.c2(), p2) && fit_in_double(p.c3(), p3) &&
|
||||||
|
fit_in_double(p.c4(), p4) &&
|
||||||
|
fit_in_double(q.c0(), q0) && fit_in_double(q.c1(), q1) &&
|
||||||
|
fit_in_double(q.c2(), q2) && fit_in_double(q.c3(), q3) &&
|
||||||
|
fit_in_double(q.c4(), q4) &&
|
||||||
|
fit_in_double(r.c0(), r0) && fit_in_double(r.c1(), r1) &&
|
||||||
|
fit_in_double(r.c2(), r2) && fit_in_double(r.c3(), r3) &&
|
||||||
|
fit_in_double(r.c4(), r4) &&
|
||||||
|
fit_in_double(s.c0(), s0) && fit_in_double(s.c1(), s1) &&
|
||||||
|
fit_in_double(s.c2(), s2) && fit_in_double(s.c3(), s3) &&
|
||||||
|
fit_in_double(s.c4(), s4))
|
||||||
|
{
|
||||||
|
double pq0;
|
||||||
|
pq0 = (q0 - p0);
|
||||||
|
double pq1;
|
||||||
|
pq1 = (q1 - p1);
|
||||||
|
double pq2;
|
||||||
|
pq2 = (q2 - p2);
|
||||||
|
double pq3;
|
||||||
|
pq3 = (q3 - p3);
|
||||||
|
double pq4;
|
||||||
|
pq4 = (q4 - p4);
|
||||||
|
double pr0;
|
||||||
|
pr0 = (r0 - p0);
|
||||||
|
double pr1;
|
||||||
|
pr1 = (r1 - p1);
|
||||||
|
double pr2;
|
||||||
|
pr2 = (r2 - p2);
|
||||||
|
double pr3;
|
||||||
|
pr3 = (r3 - p3);
|
||||||
|
double pr4;
|
||||||
|
pr4 = (r4 - p4);
|
||||||
|
double ps0;
|
||||||
|
ps0 = (s0 - p0);
|
||||||
|
double ps1;
|
||||||
|
ps1 = (s1 - p1);
|
||||||
|
double ps2;
|
||||||
|
ps2 = (s2 - p2);
|
||||||
|
double ps3;
|
||||||
|
ps3 = (s3 - p3);
|
||||||
|
double ps4;
|
||||||
|
ps4 = (s4 - p4);
|
||||||
|
double pt0;
|
||||||
|
pt0 = (t0 - p0);
|
||||||
|
double pt1;
|
||||||
|
pt1 = (t1 - p1);
|
||||||
|
double pt2;
|
||||||
|
pt2 = (t2 - p2);
|
||||||
|
double pt3;
|
||||||
|
pt3 = (t3 - p3);
|
||||||
|
double pt4;
|
||||||
|
pt4 = (t4 - p4);
|
||||||
|
double pu0;
|
||||||
|
pu0 = (t0 - p0);
|
||||||
|
double pu1;
|
||||||
|
pu1 = (u1 - p1);
|
||||||
|
double pu2;
|
||||||
|
pu2 = (u2 - p2);
|
||||||
|
double pu3;
|
||||||
|
pu3 = (u3 - p3);
|
||||||
|
double pu4;
|
||||||
|
pu4 = (u4 - p4);
|
||||||
|
double det;
|
||||||
|
det = determinant( pq0, pq1, pq2, pq3, pq4, pr0, pr1, pr2, pr3, pr4, ps0, ps1, ps2, ps3, ps4, pt0, pt1, pt2, pt3, pt4, pu0, pu1, pu2, pu3, pu4 );
|
||||||
|
Orientation result = ZERO;
|
||||||
|
double eps;
|
||||||
|
double max1 = CGAL::abs(pq0);
|
||||||
|
if( (max1 < CGAL::abs(pr0)) )
|
||||||
|
{
|
||||||
|
max1 = CGAL::abs(pr0);
|
||||||
|
}
|
||||||
|
if( (max1 < CGAL::abs(ps0)) )
|
||||||
|
{
|
||||||
|
max1 = CGAL::abs(ps0);
|
||||||
|
}
|
||||||
|
if( (max1 < CGAL::abs(pt0)) )
|
||||||
|
{
|
||||||
|
max1 = CGAL::abs(pt0);
|
||||||
|
}
|
||||||
|
if( (max1 < CGAL::abs(pu0)) )
|
||||||
|
{
|
||||||
|
max1 = CGAL::abs(pu0);
|
||||||
|
}
|
||||||
|
double max2 = CGAL::abs(pq1);
|
||||||
|
if( (max2 < CGAL::abs(pr1)) )
|
||||||
|
{
|
||||||
|
max2 = CGAL::abs(pr1);
|
||||||
|
}
|
||||||
|
if( (max2 < CGAL::abs(ps1)) )
|
||||||
|
{
|
||||||
|
max2 = CGAL::abs(ps1);
|
||||||
|
}
|
||||||
|
if( (max2 < CGAL::abs(pt1)) )
|
||||||
|
{
|
||||||
|
max2 = CGAL::abs(pt1);
|
||||||
|
}
|
||||||
|
if( (max2 < CGAL::abs(pu1)) )
|
||||||
|
{
|
||||||
|
max2 = CGAL::abs(pu1);
|
||||||
|
}
|
||||||
|
double max3 = CGAL::abs(pq2);
|
||||||
|
if( (max3 < CGAL::abs(pr2)) )
|
||||||
|
{
|
||||||
|
max3 = CGAL::abs(pr2);
|
||||||
|
}
|
||||||
|
if( (max3 < CGAL::abs(ps2)) )
|
||||||
|
{
|
||||||
|
max3 = CGAL::abs(ps2);
|
||||||
|
}
|
||||||
|
if( (max3 < CGAL::abs(pt2)) )
|
||||||
|
{
|
||||||
|
max3 = CGAL::abs(pt2);
|
||||||
|
}
|
||||||
|
if( (max3 < CGAL::abs(pu2)) )
|
||||||
|
{
|
||||||
|
max3 = CGAL::abs(pu2);
|
||||||
|
}
|
||||||
|
double max4 = CGAL::abs(pq3);
|
||||||
|
if( (max4 < CGAL::abs(pr3)) )
|
||||||
|
{
|
||||||
|
max4 = CGAL::abs(pr3);
|
||||||
|
}
|
||||||
|
if( (max4 < CGAL::abs(ps3)) )
|
||||||
|
{
|
||||||
|
max4 = CGAL::abs(ps3);
|
||||||
|
}
|
||||||
|
if( (max4 < CGAL::abs(pt3)) )
|
||||||
|
{
|
||||||
|
max4 = CGAL::abs(pt3);
|
||||||
|
}
|
||||||
|
if( (max4 < CGAL::abs(pu3)) )
|
||||||
|
{
|
||||||
|
max4 = CGAL::abs(pu3);
|
||||||
|
}
|
||||||
|
double max5 = CGAL::abs(pq4);
|
||||||
|
if( (max5 < CGAL::abs(pr4)) )
|
||||||
|
{
|
||||||
|
max5 = CGAL::abs(pr4);
|
||||||
|
}
|
||||||
|
if( (max5 < CGAL::abs(ps4)) )
|
||||||
|
{
|
||||||
|
max5 = CGAL::abs(ps4);
|
||||||
|
}
|
||||||
|
if( (max5 < CGAL::abs(pt4)) )
|
||||||
|
{
|
||||||
|
max5 = CGAL::abs(pt4);
|
||||||
|
}
|
||||||
|
if( (max5 < CGAL::abs(pu4)) )
|
||||||
|
{
|
||||||
|
max5 = CGAL::abs(pu4);
|
||||||
|
}
|
||||||
|
double lower_bound_1;
|
||||||
|
double upper_bound_1;
|
||||||
|
lower_bound_1 = max5;
|
||||||
|
upper_bound_1 = max5;
|
||||||
|
if( (max1 < lower_bound_1) )
|
||||||
|
{
|
||||||
|
lower_bound_1 = max1;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
if( (max1 > upper_bound_1) )
|
||||||
|
{
|
||||||
|
upper_bound_1 = max1;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
if( (max2 < lower_bound_1) )
|
||||||
|
{
|
||||||
|
lower_bound_1 = max2;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
if( (max2 > upper_bound_1) )
|
||||||
|
{
|
||||||
|
upper_bound_1 = max2;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
if( (max3 < lower_bound_1) )
|
||||||
|
{
|
||||||
|
lower_bound_1 = max3;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
if( (max3 > upper_bound_1) )
|
||||||
|
{
|
||||||
|
upper_bound_1 = max3;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
if( (max4 < lower_bound_1) )
|
||||||
|
{
|
||||||
|
lower_bound_1 = max4;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
if( (max4 > upper_bound_1) )
|
||||||
|
{
|
||||||
|
upper_bound_1 = max4;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
if( (lower_bound_1 < 9.99657131447050328602e-60) )
|
||||||
|
{
|
||||||
|
return Base::operator()(p, q, r, s, t, u);
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
if( (upper_bound_1 > 3.21387608851797912384e+60) )
|
||||||
|
{
|
||||||
|
return Base::operator()(p, q, r, s, t, u);
|
||||||
|
}
|
||||||
|
eps = (2.22889232457534740153e-13 * ((((max1 * max2) * max3) * max4) * max5));
|
||||||
|
if( (det > eps) )
|
||||||
|
{
|
||||||
|
result = POSITIVE;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
if( (det < -eps) )
|
||||||
|
{
|
||||||
|
result = NEGATIVE;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
return Base::operator()(p, q, r, s, t, u);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return result;
|
||||||
|
}
|
||||||
|
return Base::operator()(p, q, r, s, t, u);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
};
|
||||||
|
|
||||||
|
} } } // namespace CGAL::internal::Static_filters_predicates
|
||||||
|
|
||||||
|
#endif // CGAL_INTERNAL_STATIC_FILTERS_ORIENTATION_5_H
|
||||||
Loading…
Reference in New Issue