mirror of https://github.com/CGAL/cgal
557 lines
16 KiB
C++
557 lines
16 KiB
C++
// Copyright (c) 1998 INRIA Sophia-Antipolis (France).
|
|
// All rights reserved.
|
|
//
|
|
// This file is part of CGAL (www.cgal.org); you may redistribute it under
|
|
// the terms of the Q Public License version 1.0.
|
|
// See the file LICENSE.QPL distributed with CGAL.
|
|
//
|
|
// Licensees holding a valid commercial license may use this file in
|
|
// accordance with the commercial license agreement provided with the software.
|
|
//
|
|
// This file is provided AS IS with NO WARRANTY OF ANY KIND, INCLUDING THE
|
|
// WARRANTY OF DESIGN, MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
|
|
//
|
|
// $URL$
|
|
// $Id$
|
|
//
|
|
//
|
|
// Author(s) : Olivier Devillers <Olivivier.Devillers@sophia.inria.fr>
|
|
// Mariette Yvinec <Mariette.Yvinec@sophia.inria.fr>
|
|
|
|
#ifndef CGAL_TRIANGULATION_HIERARCHY_2_H
|
|
#define CGAL_TRIANGULATION_HIERARCHY_2_H
|
|
|
|
#include <CGAL/basic.h>
|
|
#include <CGAL/Triangulation_short_names_2.h>
|
|
#include <CGAL/Random.h>
|
|
#include <CGAL/Triangulation_hierarchy_vertex_base_2.h>
|
|
#include <map>
|
|
|
|
CGAL_BEGIN_NAMESPACE
|
|
|
|
// parameterization of the hierarchy
|
|
//const float Triangulation_hierarchy_2__ratio = 30.0;
|
|
const int Triangulation_hierarchy_2__ratio = 30;
|
|
const int Triangulation_hierarchy_2__minsize = 20;
|
|
const int Triangulation_hierarchy_2__maxlevel = 5;
|
|
// maximal number of points is 30^5 = 24 millions !
|
|
|
|
template < class Tr>
|
|
class Triangulation_hierarchy_2
|
|
: public Tr
|
|
{
|
|
public:
|
|
typedef Tr Tr_Base;
|
|
typedef typename Tr_Base::Geom_traits Geom_traits;
|
|
typedef typename Tr_Base::Point Point;
|
|
typedef typename Tr_Base::size_type size_type;
|
|
typedef typename Tr_Base::Vertex_handle Vertex_handle;
|
|
typedef typename Tr_Base::Face_handle Face_handle;
|
|
typedef typename Tr_Base::Vertex Vertex;
|
|
typedef typename Tr_Base::Locate_type Locate_type;
|
|
typedef typename Tr_Base::Finite_vertices_iterator Finite_vertices_iterator;
|
|
//typedef typename Tr_Base::Finite_faces_iterator Finite_faces_iterator;
|
|
|
|
#ifndef CGAL_CFG_USING_BASE_MEMBER_BUG_2
|
|
using Tr_Base::geom_traits;
|
|
#endif
|
|
|
|
private:
|
|
// here is the stack of triangulations which form the hierarchy
|
|
Tr_Base* hierarchy[Triangulation_hierarchy_2__maxlevel];
|
|
Random random; // random generator
|
|
|
|
public:
|
|
Triangulation_hierarchy_2(const Geom_traits& traits = Geom_traits());
|
|
Triangulation_hierarchy_2(const Triangulation_hierarchy_2& tr);
|
|
|
|
template<class InputIterator>
|
|
Triangulation_hierarchy_2(InputIterator first, InputIterator beyond,
|
|
const Geom_traits& traits = Geom_traits())
|
|
: Tr_Base(traits), random((long)0)
|
|
{
|
|
hierarchy[0] = this;
|
|
for(int i=1;i<Triangulation_hierarchy_2__maxlevel;++i)
|
|
hierarchy[i] = new Tr_Base(traits);
|
|
|
|
insert (first, beyond);
|
|
}
|
|
|
|
Triangulation_hierarchy_2 &operator=(const Triangulation_hierarchy_2& tr);
|
|
~Triangulation_hierarchy_2();
|
|
|
|
//Helping
|
|
void copy_triangulation(const Triangulation_hierarchy_2 &tr);
|
|
void swap(Triangulation_hierarchy_2 &tr);
|
|
void clear();
|
|
|
|
// CHECKING
|
|
bool is_valid(bool verbose = false, int level = 0) const;
|
|
|
|
// INSERT REMOVE
|
|
Vertex_handle insert(const Point &p, Face_handle start = Face_handle() );
|
|
Vertex_handle insert(const Point& p,
|
|
Locate_type lt,
|
|
Face_handle loc, int li );
|
|
Vertex_handle push_back(const Point &p);
|
|
|
|
template < class InputIterator >
|
|
int insert(InputIterator first, InputIterator last)
|
|
{
|
|
int n = this->number_of_vertices();
|
|
|
|
std::vector<Point> points (first, last);
|
|
std::random_shuffle (points.begin(), points.end());
|
|
CGAL::spatial_sort (points.begin(), points.end(), geom_traits());
|
|
|
|
// hints[i] is the face of the previously inserted point in level i.
|
|
// Thanks to spatial sort, they are better hints than what the hierarchy
|
|
// would give us.
|
|
Face_handle hints[Triangulation_hierarchy_2__maxlevel];
|
|
for (typename std::vector<Point>::const_iterator p = points.begin(), end = points.end();
|
|
p != end; ++p)
|
|
{
|
|
int vertex_level = random_level();
|
|
|
|
Vertex_handle v = hierarchy[0]->insert (*p, hints[0]);
|
|
hints[0] = v->face();
|
|
|
|
Vertex_handle prev = v;
|
|
|
|
for (int level = 1; level <= vertex_level; ++level) {
|
|
v = hierarchy[level]->insert (*p, hints[level]);
|
|
hints[level] = v->face();
|
|
|
|
v->set_down (prev);
|
|
prev->set_up (v);
|
|
prev = v;
|
|
}
|
|
}
|
|
|
|
return this->number_of_vertices() - n;
|
|
}
|
|
|
|
void remove_degree_3(Vertex_handle v);
|
|
void remove_first(Vertex_handle v);
|
|
void remove_second(Vertex_handle v);
|
|
void remove(Vertex_handle v);
|
|
|
|
//LOCATE
|
|
Face_handle
|
|
locate(const Point& p,
|
|
Locate_type& lt,
|
|
int& li,
|
|
Face_handle start = Face_handle()) const;
|
|
|
|
Face_handle
|
|
locate(const Point &p,
|
|
Face_handle start = Face_handle()) const;
|
|
|
|
private:
|
|
void locate_in_all(const Point& p,
|
|
Locate_type& lt,
|
|
int& li,
|
|
Face_handle loc,
|
|
Face_handle
|
|
pos[Triangulation_hierarchy_2__maxlevel]) const;
|
|
int random_level();
|
|
|
|
// helping function to copy_triangulation
|
|
// the version to be used with Tag_true is templated to avoid
|
|
// systematique instanciation
|
|
template <class Tag>
|
|
void add_hidden_vertices_into_map(Tag,
|
|
std::map<Vertex_handle,Vertex_handle >& V)
|
|
{
|
|
for (typename Tr_Base::Hidden_vertices_iterator
|
|
it=hierarchy[0]->hidden_vertices_begin();
|
|
it != hierarchy[0]->hidden_vertices_end(); ++it) {
|
|
if (it->up() != Vertex_handle()) V[ it->up()->down() ] = it;
|
|
}
|
|
}
|
|
|
|
|
|
void add_hidden_vertices_into_map(Tag_false ,
|
|
std::map<Vertex_handle,Vertex_handle >& )
|
|
{return;}
|
|
};
|
|
|
|
|
|
|
|
template <class Tr >
|
|
Triangulation_hierarchy_2<Tr>::
|
|
Triangulation_hierarchy_2(const Geom_traits& traits)
|
|
: Tr_Base(traits), random((long)0)
|
|
{
|
|
hierarchy[0] = this;
|
|
for(int i=1;i<Triangulation_hierarchy_2__maxlevel;++i)
|
|
hierarchy[i] = new Tr_Base(traits);
|
|
}
|
|
|
|
|
|
// copy constructor duplicates vertices and faces
|
|
template <class Tr>
|
|
Triangulation_hierarchy_2<Tr>::
|
|
Triangulation_hierarchy_2(const Triangulation_hierarchy_2<Tr> &tr)
|
|
: Tr_Base(), random((long)0)
|
|
{
|
|
// create an empty triangulation to be able to delete it !
|
|
hierarchy[0] = this;
|
|
for(int i=1;i<Triangulation_hierarchy_2__maxlevel;++i)
|
|
hierarchy[i] = new Tr_Base(tr.geom_traits());
|
|
copy_triangulation(tr);
|
|
}
|
|
|
|
|
|
//Assignement
|
|
template <class Tr>
|
|
Triangulation_hierarchy_2<Tr> &
|
|
Triangulation_hierarchy_2<Tr>::
|
|
operator=(const Triangulation_hierarchy_2<Tr> &tr)
|
|
{
|
|
copy_triangulation(tr);
|
|
return *this;
|
|
}
|
|
|
|
|
|
template <class Tr>
|
|
void
|
|
Triangulation_hierarchy_2<Tr>::
|
|
copy_triangulation(const Triangulation_hierarchy_2<Tr> &tr)
|
|
{
|
|
{
|
|
for(int i=0;i<Triangulation_hierarchy_2__maxlevel;++i)
|
|
hierarchy[i]->copy_triangulation(*tr.hierarchy[i]);
|
|
}
|
|
|
|
|
|
//up and down have been copied in straightforward way
|
|
// compute a map at lower level
|
|
std::map<Vertex_handle, Vertex_handle > V;
|
|
{
|
|
for( Finite_vertices_iterator it=hierarchy[0]->finite_vertices_begin();
|
|
it != hierarchy[0]->finite_vertices_end(); ++it) {
|
|
if (it->up() != Vertex_handle()) V[ it->up()->down() ] = it;
|
|
}
|
|
}
|
|
typename Tr_Base::Weighted_tag tag;
|
|
add_hidden_vertices_into_map(tag,V);
|
|
|
|
{
|
|
for(int i=1;i<Triangulation_hierarchy_2__maxlevel;++i) {
|
|
for( Finite_vertices_iterator it=hierarchy[i]->finite_vertices_begin();
|
|
it != hierarchy[i]->finite_vertices_end(); ++it) {
|
|
// down pointer goes in original instead in copied triangulation
|
|
it->set_down(V[it->down()]);
|
|
// make reverse link
|
|
it->down()->set_up(it);
|
|
// I think the next line is unnecessary (my)
|
|
// make map for next level
|
|
if (it->up()!= Vertex_handle() ) V[ it->up()->down() ] = it;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
/* template <class Tr> */
|
|
/* void */
|
|
/* Triangulation_hierarchy_2<Tr>:: */
|
|
/* add_hidden_vertices_into_map(Tag_false, */
|
|
/* std::map<Vertex_handle,Vertex_handle >& V) { */
|
|
/* return; */
|
|
/* } */
|
|
|
|
|
|
/* template <class Tr> */
|
|
/* void */
|
|
/* Triangulation_hierarchy_2<Tr>:: */
|
|
/* add_hidden_vertices_into_map(Tag_true, */
|
|
/* std::map<Vertex_handle,Vertex_handle >& V) */
|
|
/* { */
|
|
/* for (typename Tr_Base::Hidden_vertices_iterator */
|
|
/* it=hierarchy[0]->hidden_vertices_begin(); */
|
|
/* it != hierarchy[0]->hidden_vertices_end(); ++it) { */
|
|
/* if (it->up() != Vertex_handle()) V[ it->up()->down() ] = it; */
|
|
/* } */
|
|
/* } */
|
|
|
|
|
|
template <class Tr>
|
|
void
|
|
Triangulation_hierarchy_2<Tr>::
|
|
swap(Triangulation_hierarchy_2<Tr> &tr)
|
|
{
|
|
Tr_Base* temp;
|
|
Tr_Base::swap(tr);
|
|
for(int i= 1; i<Triangulation_hierarchy_2__maxlevel; ++i){
|
|
temp = hierarchy[i];
|
|
hierarchy[i] = tr.hierarchy[i];
|
|
tr.hierarchy[i]= temp;
|
|
}
|
|
}
|
|
|
|
template <class Tr>
|
|
Triangulation_hierarchy_2<Tr>::
|
|
~Triangulation_hierarchy_2()
|
|
{
|
|
clear();
|
|
for(int i= 1; i<Triangulation_hierarchy_2__maxlevel; ++i){
|
|
delete hierarchy[i];
|
|
}
|
|
}
|
|
|
|
template <class Tr>
|
|
void
|
|
Triangulation_hierarchy_2<Tr>::
|
|
clear()
|
|
{
|
|
for(int i=0;i<Triangulation_hierarchy_2__maxlevel;++i)
|
|
hierarchy[i]->clear();
|
|
}
|
|
|
|
|
|
template <class Tr>
|
|
bool
|
|
Triangulation_hierarchy_2<Tr>::
|
|
is_valid(bool verbose, int level) const
|
|
{
|
|
bool result = true;
|
|
int i;
|
|
Finite_vertices_iterator it;
|
|
//verify correctness of triangulation at all levels
|
|
for(i=0;i<Triangulation_hierarchy_2__maxlevel;++i) {
|
|
if(verbose) // pirnt number of vertices at each level
|
|
std::cout << "number_of_vertices "
|
|
<< hierarchy[i]->number_of_vertices() << std::endl;
|
|
result = result && hierarchy[i]->is_valid(verbose,level);
|
|
}
|
|
//verify that lower level has no down pointers
|
|
for( it = hierarchy[0]->finite_vertices_begin();
|
|
it != hierarchy[0]->finite_vertices_end(); ++it)
|
|
result = result && ( it->down() == Vertex_handle());
|
|
//verify that other levels have down pointer and reciprocal link is fine
|
|
for(i=1;i<Triangulation_hierarchy_2__maxlevel;++i)
|
|
for( it = hierarchy[i]->finite_vertices_begin();
|
|
it != hierarchy[i]->finite_vertices_end(); ++it)
|
|
result = result &&
|
|
( &*(it->down()->up()) == &*(it) );
|
|
//verify that levels have up pointer and reciprocal link is fine
|
|
for(i=0;i<Triangulation_hierarchy_2__maxlevel-1;++i)
|
|
for( it = hierarchy[i]->finite_vertices_begin();
|
|
it != hierarchy[i]->finite_vertices_end(); ++it)
|
|
result = result && ( it->up() == Vertex_handle() ||
|
|
&*it == &*(it->up())->down() );
|
|
return result;
|
|
}
|
|
|
|
|
|
template <class Tr>
|
|
typename Triangulation_hierarchy_2<Tr>::Vertex_handle
|
|
Triangulation_hierarchy_2<Tr>::
|
|
insert(const Point &p, Face_handle loc)
|
|
{
|
|
int vertex_level = random_level();
|
|
Locate_type lt;
|
|
int i;
|
|
// locate using hierarchy
|
|
Face_handle positions[Triangulation_hierarchy_2__maxlevel];
|
|
locate_in_all(p,lt,i,loc,positions);
|
|
Vertex_handle vertex=hierarchy[0]->Tr_Base::insert(p,lt,positions[0],i);
|
|
Vertex_handle previous=vertex;
|
|
Vertex_handle first = vertex;
|
|
|
|
int level = 1;
|
|
while (level <= vertex_level ){
|
|
vertex=hierarchy[level]->Tr_Base::insert(p,positions[level]);
|
|
vertex->set_down(previous);// link with level above
|
|
previous->set_up(vertex);
|
|
previous=vertex;
|
|
level++;
|
|
}
|
|
return first;
|
|
}
|
|
|
|
template <class Tr>
|
|
typename Triangulation_hierarchy_2<Tr>::Vertex_handle
|
|
Triangulation_hierarchy_2<Tr>::
|
|
insert(const Point& p,
|
|
Locate_type lt,
|
|
Face_handle loc,
|
|
int li )
|
|
{
|
|
int vertex_level = random_level();
|
|
//insert at level 0
|
|
Vertex_handle vertex=hierarchy[0]->Tr_Base::insert(p,lt,loc,li);
|
|
Vertex_handle previous=vertex;
|
|
Vertex_handle first = vertex;
|
|
|
|
if (vertex_level > 0) {
|
|
// locate using hierarchy
|
|
Locate_type ltt;
|
|
int lii;
|
|
Face_handle positions[Triangulation_hierarchy_2__maxlevel];
|
|
locate_in_all(p,ltt,lii,loc,positions);
|
|
//insert in higher levels
|
|
int level = 1;
|
|
while (level <= vertex_level ){
|
|
vertex=hierarchy[level]->Tr_Base::insert(p,positions[level]);
|
|
vertex->set_down(previous);// link with level above
|
|
previous->set_up(vertex);
|
|
previous=vertex;
|
|
level++;
|
|
}
|
|
}
|
|
return first;
|
|
}
|
|
|
|
|
|
template <class Tr>
|
|
inline
|
|
typename Triangulation_hierarchy_2<Tr>::Vertex_handle
|
|
Triangulation_hierarchy_2<Tr>::
|
|
push_back(const Point &p)
|
|
{
|
|
return insert(p);
|
|
}
|
|
|
|
template <class Tr>
|
|
void
|
|
Triangulation_hierarchy_2<Tr>::
|
|
remove(Vertex_handle v )
|
|
{
|
|
Vertex_handle u=v->up();
|
|
int l = 0 ;
|
|
while(1){
|
|
hierarchy[l++]->remove(v);
|
|
if (u == Vertex_handle()) break;
|
|
if(l>Triangulation_hierarchy_2__maxlevel) break;
|
|
v=u; u=v->up();
|
|
}
|
|
}
|
|
|
|
template <class Tr>
|
|
inline void
|
|
Triangulation_hierarchy_2<Tr>::
|
|
remove_degree_3(Vertex_handle v )
|
|
{
|
|
remove(v);
|
|
}
|
|
|
|
template <class Tr>
|
|
inline void
|
|
Triangulation_hierarchy_2<Tr>::
|
|
remove_first(Vertex_handle v )
|
|
{
|
|
remove(v);
|
|
}
|
|
|
|
template <class Tr>
|
|
inline void
|
|
Triangulation_hierarchy_2<Tr>::
|
|
remove_second(Vertex_handle v )
|
|
{
|
|
remove(v);
|
|
}
|
|
|
|
|
|
template <class Tr>
|
|
typename Triangulation_hierarchy_2<Tr>::Face_handle
|
|
Triangulation_hierarchy_2<Tr>::
|
|
locate(const Point& p, Locate_type& lt, int& li, Face_handle loc) const
|
|
{
|
|
Face_handle positions[Triangulation_hierarchy_2__maxlevel];
|
|
locate_in_all(p,lt,li,loc,positions);
|
|
return positions[0];
|
|
}
|
|
|
|
template <class Tr>
|
|
typename Triangulation_hierarchy_2<Tr>::Face_handle
|
|
Triangulation_hierarchy_2<Tr>::
|
|
locate(const Point& p, Face_handle loc ) const
|
|
{
|
|
Locate_type lt;
|
|
int li;
|
|
return locate(p, lt, li, loc);
|
|
}
|
|
|
|
template <class Tr>
|
|
void
|
|
Triangulation_hierarchy_2<Tr>::
|
|
locate_in_all(const Point& p,
|
|
Locate_type& lt,
|
|
int& li,
|
|
Face_handle loc,
|
|
Face_handle pos[Triangulation_hierarchy_2__maxlevel]) const
|
|
{
|
|
Face_handle position;
|
|
Vertex_handle nearest;
|
|
int level = Triangulation_hierarchy_2__maxlevel;
|
|
typename Geom_traits::Compare_distance_2
|
|
closer = this->geom_traits().compare_distance_2_object();
|
|
|
|
// find the highest level with enough vertices that is at the same time 2D
|
|
while ( (hierarchy[--level]->number_of_vertices()
|
|
< static_cast<size_type> (Triangulation_hierarchy_2__minsize ))
|
|
|| (hierarchy[level]->dimension()<2) ){
|
|
if ( ! level) break; // do not go below 0
|
|
}
|
|
if((level>0) && (hierarchy[level]->dimension()<2)){
|
|
level--;
|
|
}
|
|
|
|
for (int i=level+1; i<Triangulation_hierarchy_2__maxlevel;++i) pos[i]=0;
|
|
while(level > 0) {
|
|
pos[level]=position=hierarchy[level]->locate(p,position);
|
|
// locate at that level from "position"
|
|
// result is stored in "position" for the next level
|
|
// find the nearest between vertices 0 and 1
|
|
if (hierarchy[level]->is_infinite(position->vertex(0))){
|
|
|
|
nearest = position->vertex(1);
|
|
}
|
|
else if (hierarchy[level]->is_infinite(position->vertex(1))){
|
|
nearest = position->vertex(0);
|
|
} else if ( closer(p,
|
|
position->vertex(0)->point(),
|
|
position->vertex(1)->point()) == SMALLER){
|
|
nearest = position->vertex(0);
|
|
}
|
|
else{
|
|
nearest = position->vertex(1);
|
|
}
|
|
// compare to vertex 2, but only if the triangulation is 2D, because otherwise vertex(2) is NULL
|
|
if ( (hierarchy[level]->dimension()==2) && (! hierarchy[level]->is_infinite(position->vertex(2)))){
|
|
if ( closer( p,
|
|
position->vertex(2)->point(),
|
|
nearest->point()) == SMALLER ){
|
|
nearest = position->vertex(2);
|
|
}
|
|
}
|
|
// go at the same vertex on level below
|
|
nearest = nearest->down();
|
|
position = nearest->face(); // incident face
|
|
--level;
|
|
}
|
|
pos[0]=hierarchy[0]->locate(p,lt,li,loc == Face_handle() ? position : loc); // at level 0
|
|
}
|
|
|
|
|
|
template <class Tr>
|
|
int
|
|
Triangulation_hierarchy_2<Tr>::
|
|
random_level()
|
|
{
|
|
int l = 0;
|
|
while (1) {
|
|
if ( random(Triangulation_hierarchy_2__ratio) ) break;
|
|
++l;
|
|
}
|
|
if (l >= Triangulation_hierarchy_2__maxlevel)
|
|
l = Triangulation_hierarchy_2__maxlevel -1;
|
|
return l;
|
|
}
|
|
|
|
CGAL_END_NAMESPACE
|
|
|
|
#endif // CGAL_TRIANGULATION_HIERARCHY_2_H
|