cgal/Boolean_set_operations_2/include/CGAL/connect_holes.h

453 lines
19 KiB
C++

// Copyright (c) 2007 Tel-Aviv University (Israel).
// 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) : Ron Wein <wein@post.tau.ac.il>
#ifndef CGAL_CONNECT_HOLES_H
#define CGAL_CONNECT_HOLES_H
#include <CGAL/basic.h>
#include <CGAL/Polygon_with_holes_2.h>
#include <CGAL/Arrangement_2.h>
#include <CGAL/Arr_segment_traits_2.h>
#include <CGAL/Arr_vertical_decomposition_2.h>
#include <CGAL/Boolean_set_operations_2/Gps_default_dcel.h>
#include <CGAL/General_polygon_set_2.h>
#include <CGAL/Gps_segment_traits_2.h>
#include <list>
#include <set>
#include <iostream>
#include <assert.h>
CGAL_BEGIN_NAMESPACE
template <class HANDLE>
struct _Less_handle
{
bool operator() (const HANDLE& vh1, const HANDLE& vh2) const
{
return (&(*vh1) < &(*vh2));
}
};
/*bool is_adjacent_hole(const Halfedge_handle he, Arrangement_2 arr) {
return ((!he->twin()->face()->contained())
&& (he->twin()->face() != arr.unbounded_face()))
}*/
/*!
* Connect the given polygon with holes, turning it into a sequence of
* points, where the holes are connceted to the outer boundary using
* zero-width passages.
* For example:
* Input Output
* +----------------------------+ +-----*---------------*------+
* | | | | | |
* | +------+ +--+ | | +------+ +--+ |
* | | | | | | | | | | | |
* | +------+ \ | | | +----*-+ \ | |
* | \| | | | \| |
* | +----+ | | +----+ |
* | / | | | / | |
* | +------+ | | +------+ |
* | | | |
* +----------------------------+ +----------------------------+
*
* \param pwh The polygon with holes.
* \param oi Output: An output iterator for the points.
* \pre The polygons has an outer boundary.
* \return A past-the-end iterator of the points.
*/
template <class Kernel, class Container, class OutputIterator>
OutputIterator connect_holes(const Polygon_with_holes_2<Kernel,
Container>& pwh,
OutputIterator oi)
{
typedef Polygon_2<Kernel,Container> Polygon_2;
typedef Polygon_with_holes_2<Kernel,Container> Polygon_with_holes_2;
typedef Arr_segment_traits_2<Kernel> Traits_2;
typedef typename Kernel::Point_2 Point_2;
typedef typename Traits_2::X_monotone_curve_2 Segment_2;
typedef CGAL::Gps_default_dcel<Traits_2> dcel;
typedef General_polygon_set_2<Gps_segment_traits_2<Kernel, Container, Traits_2> , dcel>
General_polygon_set_2;
typedef Arrangement_2<Gps_segment_traits_2<Kernel, Container, Traits_2>, dcel> Arrangement_2;
typedef typename Arrangement_2::Vertex_handle Vertex_handle;
typedef typename Arrangement_2::Vertex_const_handle Vertex_const_handle;
typedef typename Arrangement_2::Halfedge_handle Halfedge_handle;
typedef typename Arrangement_2::Halfedge_const_handle Halfedge_const_handle;
typedef typename Arrangement_2::Face_handle Face_handle;
CGAL_precondition (! pwh.is_unbounded());
// In case the polygon has not holes, just go over its outer boundary
// and report the points along it.
const Polygon_2& outer_pgn = pwh.outer_boundary();
typename Polygon_2::Vertex_circulator first_v, curr_v, next_v;
if (! pwh.has_holes())
{
first_v = curr_v = outer_pgn.vertices_circulator();
do
{
*oi = *curr_v;
++oi;
++curr_v;
} while (curr_v != first_v);
return (oi);
}
// Construct the arrangement of all segments.
General_polygon_set_2 gps(pwh);
Arrangement_2 arr = gps.arrangement();
// The resulting arrangment contains a single holes in the unbounded face,
// which comprises a face f, with several holes in its interior.
// Go over these holes and pick the topmost vertex in each hole.
const Face_handle uf = arr.unbounded_face();
typename Arrangement_2::Hole_iterator f_hole_it = uf->holes_begin();
const Face_handle f = (*f_hole_it)->twin()->face();
typename Arrangement_2::Ccb_halfedge_circulator
first, circ;
Kernel ker;
typename Kernel::Compare_y_2 comp_y = ker.compare_y_2_object();
typename Kernel::Compare_x_2 comp_x = ker.compare_x_2_object();
Vertex_handle v_top;
Comparison_result res;
std::set<Vertex_const_handle,
_Less_handle<Vertex_const_handle> > top_vertices;
/*traversal of arrangement face holes - a hole in the face
in arranements is disjoint from te outer boundary (different from BOP
where the hole can have vertices along the outer boundary). We look for
holes only inside faces that are part of the point set. This
guarantees that if the input PWH had holes with vertices on the outer
boundary they will not be connected by additional vertical segments to
the outer boundary or another hole's vertex/edge.
*/
typename Arrangement_2::Face_const_handle fit;
//std::cout << arr.number_of_faces() << " faces:" << std::endl;
typename Arrangement_2::Hole_const_iterator f_hole_itc;
for (fit = arr.faces_begin(); fit != arr.faces_end() ; ++fit)
if (fit->contained()) {
for (f_hole_itc = fit->holes_begin(); f_hole_itc != fit->holes_end(); ++f_hole_itc){
// Locate the topmost vertex in the current hole. In case of two (or more)
// vertices with maximal y-coordinate, select the leftmost one.
first = circ = (arr.non_const_handle(*f_hole_itc));
v_top = circ->target();
do
{
++circ;
res = comp_y (circ->target()->point(), v_top->point());
if (res == CGAL::LARGER ||
(res == CGAL::EQUAL &&
comp_x (circ->target()->point(), v_top->point()) == CGAL::SMALLER))
{
v_top = circ->target();
}
} while (circ != first);
// std::cout << "inserted top vertex at " << v_top->point() <<std::endl;
top_vertices.insert (Vertex_const_handle (v_top));
}
}
// Perform "vertical ray shooting" from each arrangement vertex, locating
// the features that lie below and above it.
typedef std::list<std::pair<Vertex_const_handle,
std::pair<Object, Object> > > Ray_shoot_list;
Ray_shoot_list vrs_list;
typename Ray_shoot_list::iterator vrs_iter;
decompose (arr, std::back_inserter (vrs_list));
// Go over the results of the batched vertical ray-shooting query.
Vertex_const_handle v;
Vertex_handle v_above;
Halfedge_const_handle he;
Halfedge_handle he_above;
typename Kernel::Direction_2 dir_up (0, 1);
typename Kernel::Construct_ray_2 ray = ker.construct_ray_2_object();
typename Kernel::Construct_segment_2 segment =
ker.construct_segment_2_object();
typename Kernel::Intersect_2 intersect = ker.intersect_2_object();
Object obj;
Point_2 ip;
bool assign_success;
for (vrs_iter = vrs_list.begin(); vrs_iter != vrs_list.end(); ++vrs_iter)
{
if (top_vertices.find (vrs_iter->first) == top_vertices.end())
continue;
v_top = arr.non_const_handle (vrs_iter->first);
// In case the current vertex is a top vertex in one of the holes,
// add a vertical segment connecting it with the feature above it.
if (CGAL::assign (v, vrs_iter->second.second))
{
// v_top lies below a vertex v_above: Connect these two vertices.
v_above = arr.non_const_handle (v);
arr.insert_at_vertices (Segment_2 (v_top->point(), v_above->point()),
v_top, v_above);
//added for debugging
//std::cout << "connected ((" << v_top->point() << "),( " << v_above->point() << "))" <<std::endl;
}
else if (CGAL::assign (he, vrs_iter->second.second))
{
// v_top lies below the interior of the hafledge he_above:
// Find the intersection of this halfegde with a vertical ray
// emanating from v_top.
he_above = arr.non_const_handle (he);
obj = intersect (ray (v_top->point(), dir_up),
segment (he_above->source()->point(),
he_above->target()->point()));
assign_success = CGAL::assign (ip, obj);
CGAL_assertion (assign_success);
if (assign_success)
{
// Split he_above at the computed intersection point.
arr.split_edge (he_above,
Segment_2 (he_above->source()->point(), ip),
Segment_2 (ip, he_above->target()->point()));
// Now he_above is split such that it becomes the predecessor
// halfedge for the insertion of the vertical segment connecting
// v_top and ip.
arr.insert_at_vertices (Segment_2 (v_top->point(), ip),
he_above, v_top);
//added for debugging
//std::cout << "connected ((" << v_top->point() << "),( " << ip << "))" <<std::endl;
}
}
else
{
// We should never reach here.
CGAL_error_msg("top vertex is located in an unbounded face.");
}
}
// The holes of the face f are now all connected to it outer boundary.
// Go over this boundary and report the vertices along it.
// Note that we start with a vertex located on the original outer boundary.
typedef typename Arrangement_2::Halfedge_const_iterator
Halfedge_const_iterator;
/*define two states - one is searching for a key vertice
(one that ispart of a hole that hasn't been traversed, degree>2).
Once one is found, switch state and traverse the hole until returning
to this vertice. Then return to search mode*/
bool marking_hole_state = false;
/*flags used for printing the edges for debugging purposes
bool skip_print = false;
bool antenna_trav = false;
*/
//marker of first vertex of hole that is being traversed
Vertex_handle hole_start, empty_handle;
//create a container for marking holes that are/had been traversed
//change to hash map
std::set<Face_handle, _Less_handle<Face_handle> > traversed_holes;
std::set<Vertex_const_handle,
_Less_handle<Vertex_const_handle> > outer_vertices;
f_hole_it = uf->holes_begin();
Halfedge_const_handle he_han = *f_hole_it;
if (he_han->face() != uf)
he_han = he_han->twin();
assert(he_han->face() == uf);
//std::cout << "outer boundary:" <<std::endl;
outer_vertices.insert(he_han->target());
//std::cout << "(" << he_han->target()->point() << ")" <<std::endl;
Halfedge_const_handle begin = he_han;
he_han = he_han->next();
assert(he_han->face() == uf);
while (he_han != begin) {
//insert vertice to outer boundary set
outer_vertices.insert(he_han->target());
//std::cout << "(" << he_han->target()->point() << ")" <<std::endl;
he_han = he_han->next();
assert(he_han->face() == uf);
}
//std::cout << "outer boundary finished" <<std::endl;
first = f->outer_ccb();
//std::cout << "first edge is ((" << first->source()->point() << "),(" << first->target()->point() << "))" <<std::endl;
Halfedge_const_iterator start, curr, next;
start = first;
while (start->twin()->face() != uf)
start = start->next();
//std::cout << "start edge is ((" << start->source()->point() << "),(" << start->target()->point() << "))" <<std::endl;
curr = start;
do
{
/*traverse_hole (next for any vertice besides vertices on
the outer boundary with deg>2. check hole on every step and
mark new holes (if two holes are connected by a vertex)
This is true also for traversing starting with an antenna halfedge*/
if (marking_hole_state) {
/*Add current hole to search structure.
we traverse the hole fully an if we "incidently" traverse
another hole as well (joined by a vertice) both will be traversed
completely*/
//case we are starting to traverse an antenna
if (curr->face() == curr->twin()->face()) {
/*antenna_trav = true ;
std::cout << "curr edge is ((" << curr->source()->point() << "),( " << curr->target()->point() << "))" <<std::endl;*/
*oi = curr->target()->point();
++oi;
curr = curr->next();
}
//Traversal of the hole
while (hole_start != arr.non_const_handle(curr->target())) {
traversed_holes.insert(arr.non_const_handle(curr->twin()->face()));
//std::cout << "curr edge is ((" << curr->source()->point() << "),( " << curr->target()->point() << "))" <<std::endl;
*oi = curr->target()->point();
++oi;
//"turn inside" instead of next if target is located on outer boundary
if ((curr->target()->degree()>2) && //add is on outer boundary instead
(outer_vertices.find(curr->target()) != outer_vertices.end())) {
curr = curr->twin()->prev()->twin();
} else {//regular advance
curr = curr->next();
}
} //exited loop target is the hole marking start vertex
hole_start=empty_handle;
marking_hole_state=false;
//check all of the edges that (curr->taget()==edge->source())
//to determine next move
} else
{//search for next hole
/*Treatment of 4 possible cases (should be narrowed to 3 even though
first two cannot co-exist here as vertices with degree of 2 that are
not on the uf will be encountered when traversing holes (different
state) */
next = curr->next();
/*target() is a simple vertice with a single possible edge on path.
add it to output and continue searching for a hole*/
if (curr->target()->degree()==2) {
//std::cout << "curr edge is ((" << curr->source()->point() << "),( " << curr->target()->point() << "))" <<std::endl;
//insert target point to result output iterator
*oi = curr->target()->point();
++oi;
curr = curr->next();
//can be erased
marking_hole_state=false;
hole_start=empty_handle;
continue;
}
/*the case next is on the outer boundary meaning we finished handling
holes connected to the target vertex. Add the target to the output, and
continue searching for next hole*/
if (next->twin()->face() == uf) {
/*if (!skip_print)
std::cout << "curr edge is ((" << curr->source()->point() << "),( " << curr->target()->point() << "))" <<std::endl;
else {
skip_print=false;
antenna_trav=false;
}*/
*oi = curr->target()->point();
++oi;
curr = curr->next();
//can be erased
marking_hole_state=false;
hole_start=empty_handle;
continue;
}
/*if next is a boundary of a hole that has not been traversed,
or an antenna (which should also be completely traversed until
returning to the source vertex).
Target must be added to output and state changed */
/*Consult Efi may need to add
//if ((next->twin->face() != uf) && (next->twin()->face()->contained()))
if somehow next->twin()->face is a contained polygon or uf it
will never be found
*/
if ((traversed_holes.find(arr.non_const_handle(next->twin()->face())) == traversed_holes.end())
//case of antenna
|| (next->face()==next->twin()->face())) {
/*if (!skip_print)
std::cout << "curr edge is ((" << curr->source()->point() << "),( " << curr->target()->point() << "))" <<std::endl;
else {
skip_print=false;
//can be reached after an antenna
antenna_trav=false;
}*/
//insert target point to result output iterator
*oi = curr->target()->point();
++oi;
hole_start = arr.non_const_handle(curr->target());
marking_hole_state=true;
curr = curr->next();
continue;
} else {
/*the case where target() is a part of several holes, and next is a
boundary of a hole that has been traversed. This requires
to continue "traversal alongside all edges whose target is also
curr->target() to keep looking for a hole that hasn't been traversed.
we do not insert the target to the output set to avoid duplication
with cases 2 and 3*/
/*bypass traversed hole from inside*/
/*print debugging:
the current edge needs to be printed now before moving on, but the
current (target) vertex will be inserted to output iterator in case 2*/
/*if (traversed_holes.find(arr.non_const_handle(curr->twin()->face())) == traversed_holes.end())
std::cout << "curr edge is ((" << curr->source()->point() << "),( " << curr->target()->point() << "))" <<std::endl;
//case this is the last half edge of an antenna
if (antenna_trav == true) {
std::cout << "curr edge is ((" << curr->source()->point() << "),( " << curr->target()->point() << "))" <<std::endl;
antenna_trav = false;
}
skip_print = true;*/
curr = next->twin()->next()->twin();
//can erase
marking_hole_state=false;
hole_start=empty_handle;
continue;
//now curr->target() has remained the same but curr->next() will
//be adjacent to a different hole or curr->next->twin->face()
//will be the unbounded face
}
}
} while (curr != start);
return (oi);
}
CGAL_END_NAMESPACE
#endif