boost/polygon/segment_concept.hpp
// Boost.Polygon library segment_concept.hpp header file // Copyright (c) Intel Corporation 2008. // Copyright (c) 2008-2012 Simonson Lucanus. // Copyright (c) 2012-2012 Andrii Sydorchuk. // See http://www.boost.org for updates, documentation, and revision history. // Use, modification and distribution is subject to the Boost Software License, // Version 1.0. (See accompanying file LICENSE_1_0.txt or copy at // http://www.boost.org/LICENSE_1_0.txt) #ifndef BOOST_POLYGON_SEGMENT_CONCEPT_HPP #define BOOST_POLYGON_SEGMENT_CONCEPT_HPP #include "isotropy.hpp" #include "segment_traits.hpp" #include "rectangle_concept.hpp" namespace boost { namespace polygon { struct segment_concept {}; template <typename ConceptType> struct is_segment_concept { typedef gtl_no type; }; template <> struct is_segment_concept<segment_concept> { typedef gtl_yes type; }; template <typename ConceptType> struct is_mutable_segment_concept { typedef gtl_no type; }; template <> struct is_mutable_segment_concept<segment_concept> { typedef gtl_yes type; }; template <typename GeometryType, typename BoolType> struct segment_distance_type_by_concept { typedef void type; }; template <typename GeometryType> struct segment_distance_type_by_concept<GeometryType, gtl_yes> { typedef typename coordinate_traits< typename segment_traits<GeometryType>::coordinate_type >::coordinate_distance type; }; template <typename GeometryType> struct segment_distance_type { typedef typename segment_distance_type_by_concept< GeometryType, typename is_segment_concept< typename geometry_concept<GeometryType>::type >::type >::type type; }; template <typename GeometryType, typename BoolType> struct segment_point_type_by_concept { typedef void type; }; template <typename GeometryType> struct segment_point_type_by_concept<GeometryType, gtl_yes> { typedef typename segment_traits<GeometryType>::point_type type; }; template <typename GeometryType> struct segment_point_type { typedef typename segment_point_type_by_concept< GeometryType, typename is_segment_concept< typename geometry_concept<GeometryType>::type >::type >::type type; }; template <typename GeometryType, typename BoolType> struct segment_coordinate_type_by_concept { typedef void type; }; template <typename GeometryType> struct segment_coordinate_type_by_concept<GeometryType, gtl_yes> { typedef typename segment_traits<GeometryType>::coordinate_type type; }; template <typename GeometryType> struct segment_coordinate_type { typedef typename segment_coordinate_type_by_concept< GeometryType, typename is_segment_concept< typename geometry_concept<GeometryType>::type >::type >::type type; }; struct y_s_get : gtl_yes {}; template <typename Segment> typename enable_if< typename gtl_and< y_s_get, typename is_segment_concept< typename geometry_concept<Segment>::type >::type >::type, typename segment_point_type<Segment>::type>::type get(const Segment& segment, direction_1d dir) { return segment_traits<Segment>::get(segment, dir); } struct y_s_set : gtl_yes {}; template <typename Segment, typename Point> typename enable_if< typename gtl_and_3< y_s_set, typename is_mutable_segment_concept< typename geometry_concept<Segment>::type >::type, typename is_point_concept< typename geometry_concept<Point>::type >::type >::type, void>::type set(Segment& segment, direction_1d dir, const Point& point) { segment_mutable_traits<Segment>::set(segment, dir, point); } struct y_s_construct : gtl_yes {}; template <typename Segment, typename Point1, typename Point2> typename enable_if< typename gtl_and_4< y_s_construct, typename is_mutable_segment_concept< typename geometry_concept<Segment>::type >::type, typename is_point_concept< typename geometry_concept<Point1>::type >::type, typename is_point_concept< typename geometry_concept<Point2>::type >::type >::type, Segment>::type construct(const Point1& low, const Point2& high) { return segment_mutable_traits<Segment>::construct(low, high); } struct y_s_copy_construct : gtl_yes {}; template <typename Segment1, typename Segment2> typename enable_if< typename gtl_and_3< y_s_copy_construct, typename is_mutable_segment_concept< typename geometry_concept<Segment1>::type >::type, typename is_segment_concept< typename geometry_concept<Segment2>::type >::type >::type, Segment1>::type copy_construct(const Segment2& segment) { return construct<Segment1>(get(segment, LOW), get(segment, HIGH)); } struct y_s_assign : gtl_yes {}; template <typename Segment1, typename Segment2> typename enable_if< typename gtl_and_3< y_s_assign, typename is_mutable_segment_concept< typename geometry_concept<Segment1>::type >::type, typename is_segment_concept< typename geometry_concept<Segment2>::type >::type >::type, Segment1>::type& assign(Segment1& segment1, const Segment2& segment2) { return segment1 = copy_construct<Segment1>(segment2); } struct y_s_equivalence : gtl_yes {}; template <typename Segment1, typename Segment2> typename enable_if< typename gtl_and_3< y_s_equivalence, typename is_segment_concept< typename geometry_concept<Segment1>::type >::type, typename is_segment_concept< typename geometry_concept<Segment2>::type >::type >::type, bool>::type equivalence(const Segment1& segment1, const Segment2& segment2) { return get(segment1, LOW) == get(segment2, LOW) && get(segment1, HIGH) == get(segment2, HIGH); } struct y_s_low : gtl_yes {}; template <typename Segment> typename enable_if< typename gtl_and< y_s_low, typename is_segment_concept< typename geometry_concept<Segment>::type >::type >::type, typename segment_point_type<Segment>::type>::type low(const Segment& segment) { return get(segment, LOW); } struct y_s_high : gtl_yes {}; template <typename Segment> typename enable_if< typename gtl_and< y_s_high, typename is_segment_concept< typename geometry_concept<Segment>::type >::type >::type, typename segment_point_type<Segment>::type>::type high(const Segment& segment) { return get(segment, HIGH); } struct y_s_center : gtl_yes {}; template <typename Segment> typename enable_if< typename gtl_and< y_s_center, typename is_segment_concept< typename geometry_concept<Segment>::type >::type >::type, typename segment_point_type<Segment>::type>::type center(const Segment& segment) { return construct<typename segment_point_type<Segment>::type>( (x(high(segment)) + x(low(segment)))/2, (y(high(segment)) + y(low(segment)))/2); } struct y_s_low2 : gtl_yes {}; template <typename Segment, typename Point> typename enable_if< typename gtl_and_3< y_s_low2, typename is_mutable_segment_concept< typename geometry_concept<Segment>::type >::type, typename is_point_concept< typename geometry_concept<Point>::type >::type >::type, void>::type low(Segment& segment, const Point& point) { set(segment, LOW, point); } struct y_s_high2 : gtl_yes {}; template <typename Segment, typename Point> typename enable_if< typename gtl_and_3< y_s_high2, typename is_mutable_segment_concept< typename geometry_concept<Segment>::type >::type, typename is_point_concept< typename geometry_concept<Point>::type >::type >::type, void>::type high(Segment& segment, const Point& point) { set(segment, HIGH, point); } struct y_s_orientation1 : gtl_yes {}; // -1 for CW, 0 for collinear and 1 for CCW. template <typename Segment1, typename Segment2> typename enable_if< typename gtl_and_3< y_s_orientation1, typename is_segment_concept< typename geometry_concept<Segment1>::type >::type, typename is_segment_concept< typename geometry_concept<Segment2>::type >::type >::type, int>::type orientation(const Segment1& segment1, const Segment2& segment2) { typedef typename coordinate_traits< typename segment_traits<Segment1>::coordinate_type >::manhattan_area_type int_x2; typedef typename coordinate_traits< typename segment_traits<Segment1>::coordinate_type >::unsigned_area_type uint_x2; int_x2 a1 = (int_x2)x(high(segment1)) - (int_x2)x(low(segment1)); int_x2 b1 = (int_x2)y(high(segment1)) - (int_x2)y(low(segment1)); int_x2 a2 = (int_x2)x(high(segment2)) - (int_x2)x(low(segment2)); int_x2 b2 = (int_x2)y(high(segment2)) - (int_x2)y(low(segment2)); int sign1 = 0; int sign2 = 0; if (a1 && b2) sign1 = ((a1 > 0) ^ (b2 > 0)) ? -1 : 1; if (a2 && b1) sign2 = ((a2 > 0) ^ (b1 > 0)) ? -1 : 1; if (sign1 != sign2) return (sign1 < sign2) ? -1 : 1; uint_x2 a3 = (uint_x2)(a1 < 0 ? -a1 : a1) * (uint_x2)(b2 < 0 ? -b2 : b2); uint_x2 b3 = (uint_x2)(b1 < 0 ? -b1 : b1) * (uint_x2)(a2 < 0 ? -a2 : a2); if (a3 == b3) return 0; return ((a3 < b3) ^ (sign1 == 1)) ? 1 : -1; } struct y_s_orientation2 : gtl_yes {}; // -1 for right, 0 for collinear and 1 for left. template <typename Segment, typename Point> typename enable_if< typename gtl_and_3< y_s_orientation2, typename is_segment_concept< typename geometry_concept<Segment>::type >::type, typename is_point_concept< typename geometry_concept<Point>::type >::type >::type, int>::type orientation(const Segment& segment, const Point& point) { Segment segment2 = construct<Segment>(high(segment), point); return orientation(segment, segment2); } struct y_s_contains : gtl_yes {}; template <typename Segment, typename Point> typename enable_if< typename gtl_and_3< y_s_contains, typename is_segment_concept< typename geometry_concept<Segment>::type >::type, typename is_point_concept< typename geometry_concept<Point>::type >::type >::type, bool>::type contains(const Segment& segment, const Point& point, bool consider_touch = true ) { if (orientation(segment, point)) return false; rectangle_data<typename segment_coordinate_type<Segment>::type> rect; set_points(rect, low(segment), high(segment)); if (!contains(rect, point, true)) return false; if (!consider_touch && (equivalence(low(segment), point) || equivalence(high(segment), point))) return false; return true; } struct y_s_contains2 : gtl_yes {}; template <typename Segment1, typename Segment2> typename enable_if< typename gtl_and_3< y_s_contains2, typename is_segment_concept< typename geometry_concept<Segment1>::type >::type, typename is_segment_concept< typename geometry_concept<Segment2>::type >::type >::type, bool>::type contains(const Segment1& segment1, const Segment2& segment2, bool consider_touch = true) { return contains(segment1, get(segment2, LOW), consider_touch) && contains(segment1, get(segment2, HIGH), consider_touch); } struct y_s_length : gtl_yes {}; template <typename Segment> typename enable_if< typename gtl_and< y_s_length, typename is_segment_concept< typename geometry_concept<Segment>::type >::type >::type, typename segment_distance_type<Segment>::type>::type length(const Segment& segment) { return euclidean_distance(low(segment), high(segment)); } struct y_s_scale_up : gtl_yes {}; template <typename Segment> typename enable_if< typename gtl_and< y_s_scale_up, typename is_mutable_segment_concept< typename geometry_concept<Segment>::type >::type >::type, Segment>::type& scale_up(Segment& segment, typename coordinate_traits< typename segment_coordinate_type<Segment>::type >::unsigned_area_type factor) { typename segment_point_type<Segment>::type l = low(segment); typename segment_point_type<Segment>::type h = high(segment); low(segment, scale_up(l, factor)); high(segment, scale_up(h, factor)); return segment; } struct y_s_scale_down : gtl_yes {}; template <typename Segment> typename enable_if< typename gtl_and< y_s_scale_down, typename is_mutable_segment_concept< typename geometry_concept<Segment>::type >::type >::type, Segment>::type& scale_down(Segment& segment, typename coordinate_traits< typename segment_coordinate_type<Segment>::type >::unsigned_area_type factor) { typename segment_point_type<Segment>::type l = low(segment); typename segment_point_type<Segment>::type h = high(segment); low(segment, scale_down(l, factor)); high(segment, scale_down(h, factor)); return segment; } struct y_s_scale : gtl_yes {}; template <typename Segment, typename Scale> typename enable_if< typename gtl_and< y_s_scale, typename is_mutable_segment_concept< typename geometry_concept<Segment>::type >::type >::type, Segment>::type& scale(Segment& segment, const Scale& sc) { typename segment_point_type<Segment>::type l = low(segment); typename segment_point_type<Segment>::type h = high(segment); low(segment, scale(l, sc)); high(segment, scale(h, sc)); return segment; } struct y_s_transform : gtl_yes {}; template <typename Segment, typename Transform> typename enable_if< typename gtl_and< y_s_transform, typename is_mutable_segment_concept< typename geometry_concept<Segment>::type >::type >::type, Segment>::type& transform(Segment& segment, const Transform& tr) { typename segment_point_type<Segment>::type l = low(segment); typename segment_point_type<Segment>::type h = high(segment); low(segment, transform(l, tr)); high(segment, transform(h, tr)); return segment; } struct y_s_move : gtl_yes {}; template <typename Segment> typename enable_if< typename gtl_and< y_s_move, typename is_mutable_segment_concept< typename geometry_concept<Segment>::type >::type >::type, Segment>::type& move(Segment& segment, orientation_2d orient, typename segment_coordinate_type<Segment>::type displacement) { typename segment_point_type<Segment>::type l = low(segment); typename segment_point_type<Segment>::type h = high(segment); low(segment, move(l, orient, displacement)); high(segment, move(h, orient, displacement)); return segment; } struct y_s_convolve : gtl_yes {}; template <typename Segment, typename Point> typename enable_if< typename gtl_and_3< y_s_convolve, typename is_mutable_segment_concept< typename geometry_concept<Segment>::type >::type, typename is_point_concept< typename geometry_concept<Point>::type >::type >::type, Segment>::type& convolve(Segment& segment, const Point& point) { typename segment_point_type<Segment>::type l = low(segment); typename segment_point_type<Segment>::type h = high(segment); low(segment, convolve(l, point)); high(segment, convolve(h, point)); return segment; } struct y_s_deconvolve : gtl_yes {}; template <typename Segment, typename Point> typename enable_if< typename gtl_and_3< y_s_deconvolve, typename is_mutable_segment_concept< typename geometry_concept<Segment>::type >::type, typename is_point_concept< typename geometry_concept<Point>::type >::type >::type, Segment>::type& deconvolve(Segment& segment, const Point& point) { typename segment_point_type<Segment>::type l = low(segment); typename segment_point_type<Segment>::type h = high(segment); low(segment, deconvolve(l, point)); high(segment, deconvolve(h, point)); return segment; } struct y_s_abuts1 : gtl_yes {}; template <typename Segment1, typename Segment2> typename enable_if< typename gtl_and_3< y_s_abuts1, typename is_segment_concept< typename geometry_concept<Segment1>::type >::type, typename is_segment_concept< typename geometry_concept<Segment2>::type >::type >::type, bool>::type abuts(const Segment1& segment1, const Segment2& segment2, direction_1d dir) { return dir.to_int() ? equivalence(low(segment2) , high(segment1)) : equivalence(low(segment1) , high(segment2)); } struct y_s_abuts2 : gtl_yes {}; template <typename Segment1, typename Segment2> typename enable_if< typename gtl_and_3< y_s_abuts2, typename is_segment_concept< typename geometry_concept<Segment1>::type >::type, typename is_segment_concept< typename geometry_concept<Segment2>::type >::type >::type, bool>::type abuts(const Segment1& segment1, const Segment2& segment2) { return abuts(segment1, segment2, HIGH) || abuts(segment1, segment2, LOW); } struct y_s_e_intersects : gtl_yes {}; template <typename Segment1, typename Segment2> typename enable_if< typename gtl_and_3< y_s_e_intersects, typename is_segment_concept< typename geometry_concept<Segment1>::type >::type, typename is_segment_concept< typename geometry_concept<Segment2>::type >::type >::type, bool >::type intersects(const Segment1& segment1, const Segment2& segment2, bool consider_touch = true) { rectangle_data<typename segment_coordinate_type<Segment1>::type> rect1, rect2; set_points(rect1, low(segment1), high(segment1)); set_points(rect2, low(segment2), high(segment2)); // Check if axis-parallel rectangles containing segments intersect. if (!intersects(rect1, rect2, true)) return false; int or1_1 = orientation(segment1, low(segment2)); int or1_2 = orientation(segment1, high(segment2)); if (or1_1 * or1_2 > 0) return false; int or2_1 = orientation(segment2, low(segment1)); int or2_2 = orientation(segment2, high(segment1)); if (or2_1 * or2_2 > 0) return false; if (consider_touch || (or1_1 && or1_2) || (or2_1 && or2_2)) return true; if (or1_1 || or1_2) return false; return intersects(vertical(rect1), vertical(rect2), false) || intersects(horizontal(rect1), horizontal(rect2), false); } struct y_s_e_dist : gtl_yes {}; template <typename Segment, typename Point> typename enable_if< typename gtl_and_3< y_s_e_dist, typename is_segment_concept< typename geometry_concept<Segment>::type >::type, typename is_point_concept< typename geometry_concept<Point>::type >::type >::type, typename segment_distance_type<Segment>::type>::type euclidean_distance(const Segment& segment, const Point& point) { typedef typename segment_distance_type<Segment>::type Unit; Unit x1 = x(low(segment)); Unit y1 = y(low(segment)); Unit x2 = x(high(segment)); Unit y2 = y(high(segment)); Unit X = x(point); Unit Y = y(point); Unit A = X - x1; Unit B = Y - y1; Unit C = x2 - x1; Unit D = y2 - y1; Unit param = (A * C + B * D); Unit length_sq = C * C + D * D; if (param > length_sq) { return euclidean_distance(high(segment), point); } else if (param < 0.0) { return euclidean_distance(low(segment), point); } if (length_sq == 0.0) return 0.0; Unit denom = std::sqrt(length_sq); Unit result = (A * D - C * B) / denom; return (result < 0.0) ? -result : result; } struct y_s_e_dist2 : gtl_yes {}; template <typename Segment1, typename Segment2> typename enable_if< typename gtl_and_3< y_s_e_dist2, typename is_segment_concept< typename geometry_concept<Segment1>::type >::type, typename is_segment_concept< typename geometry_concept<Segment2>::type >::type >::type, typename segment_distance_type<Segment1>::type>::type euclidean_distance(const Segment1& segment1, const Segment2& segment2) { if (intersects(segment1, segment2)) return 0.0; typename segment_distance_type<Segment1>::type result1 = euclidean_distance(segment1, low(segment2)), result2 = euclidean_distance(segment1, high(segment2)), result3 = euclidean_distance(segment2, low(segment1)), result4 = euclidean_distance(segment2, high(segment1)); if (result2 < result1) result1 = result2; if (result4 < result3) result3 = result4; return (result1 < result3) ? result1 : result3; } } // polygon } // boost #endif // BOOST_POLYGON_SEGMENT_CONCEPT_HPP