// Boost.Geometry (aka GGL, Generic Geometry Library) // Copyright (c) 2007-2014 Barend Gehrels, Amsterdam, the Netherlands. // Copyright (c) 2013-2017 Adam Wulkiewicz, Lodz, Poland. // This file was modified by Oracle on 2014, 2016, 2017, 2018, 2019. // Modifications copyright (c) 2014-2019, Oracle and/or its affiliates. // Contributed and/or modified by Menelaos Karavelas, on behalf of Oracle // Contributed and/or modified by Adam Wulkiewicz, on behalf of Oracle // 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_GEOMETRY_STRATEGIES_CARTESIAN_INTERSECTION_HPP #define BOOST_GEOMETRY_STRATEGIES_CARTESIAN_INTERSECTION_HPP #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #if defined(BOOST_GEOMETRY_DEBUG_ROBUSTNESS) # include #endif namespace boost { namespace geometry { namespace strategy { namespace intersection { /*! \see http://mathworld.wolfram.com/Line-LineIntersection.html */ template < typename CalculationType = void > struct cartesian_segments { typedef cartesian_tag cs_tag; typedef side::side_by_triangle side_strategy_type; static inline side_strategy_type get_side_strategy() { return side_strategy_type(); } template struct point_in_geometry_strategy { typedef strategy::within::cartesian_winding < typename point_type::type, typename point_type::type, CalculationType > type; }; template static inline typename point_in_geometry_strategy::type get_point_in_geometry_strategy() { typedef typename point_in_geometry_strategy < Geometry1, Geometry2 >::type strategy_type; return strategy_type(); } template struct area_strategy { typedef area::cartesian < CalculationType > type; }; template static inline typename area_strategy::type get_area_strategy() { typedef typename area_strategy::type strategy_type; return strategy_type(); } template struct distance_strategy { typedef distance::pythagoras < CalculationType > type; }; template static inline typename distance_strategy::type get_distance_strategy() { typedef typename distance_strategy::type strategy_type; return strategy_type(); } typedef envelope::cartesian envelope_strategy_type; static inline envelope_strategy_type get_envelope_strategy() { return envelope_strategy_type(); } typedef expand::cartesian_segment expand_strategy_type; static inline expand_strategy_type get_expand_strategy() { return expand_strategy_type(); } typedef within::cartesian_point_point point_in_point_strategy_type; static inline point_in_point_strategy_type get_point_in_point_strategy() { return point_in_point_strategy_type(); } typedef within::cartesian_point_point equals_point_point_strategy_type; static inline equals_point_point_strategy_type get_equals_point_point_strategy() { return equals_point_point_strategy_type(); } typedef disjoint::cartesian_box_box disjoint_box_box_strategy_type; static inline disjoint_box_box_strategy_type get_disjoint_box_box_strategy() { return disjoint_box_box_strategy_type(); } typedef disjoint::segment_box disjoint_segment_box_strategy_type; static inline disjoint_segment_box_strategy_type get_disjoint_segment_box_strategy() { return disjoint_segment_box_strategy_type(); } typedef covered_by::cartesian_point_box disjoint_point_box_strategy_type; typedef covered_by::cartesian_point_box covered_by_point_box_strategy_type; typedef within::cartesian_point_box within_point_box_strategy_type; typedef envelope::cartesian_box envelope_box_strategy_type; typedef expand::cartesian_box expand_box_strategy_type; template struct segment_intersection_info { private : typedef typename select_most_precise < CoordinateType, double >::type promoted_type; promoted_type comparable_length_a() const { return dx_a * dx_a + dy_a * dy_a; } promoted_type comparable_length_b() const { return dx_b * dx_b + dy_b * dy_b; } template void assign_a(Point& point, Segment1 const& a, Segment2 const& ) const { assign(point, a, dx_a, dy_a, robust_ra); } template void assign_b(Point& point, Segment1 const& , Segment2 const& b) const { assign(point, b, dx_b, dy_b, robust_rb); } template void assign(Point& point, Segment const& segment, CoordinateType const& dx, CoordinateType const& dy, SegmentRatio const& ratio) const { // Calculate the intersection point based on segment_ratio // Up to now, division was postponed. Here we divide using numerator/ // denominator. In case of integer this results in an integer // division. BOOST_GEOMETRY_ASSERT(ratio.denominator() != 0); typedef typename promote_integral::type calc_type; calc_type const numerator = boost::numeric_cast(ratio.numerator()); calc_type const denominator = boost::numeric_cast(ratio.denominator()); calc_type const dx_calc = boost::numeric_cast(dx); calc_type const dy_calc = boost::numeric_cast(dy); set<0>(point, get<0, 0>(segment) + boost::numeric_cast(numerator * dx_calc / denominator)); set<1>(point, get<0, 1>(segment) + boost::numeric_cast(numerator * dy_calc / denominator)); } public : template void calculate(Point& point, Segment1 const& a, Segment2 const& b) const { bool use_a = true; // Prefer one segment if one is on or near an endpoint bool const a_near_end = robust_ra.near_end(); bool const b_near_end = robust_rb.near_end(); if (a_near_end && ! b_near_end) { use_a = true; } else if (b_near_end && ! a_near_end) { use_a = false; } else { // Prefer shorter segment promoted_type const len_a = comparable_length_a(); promoted_type const len_b = comparable_length_b(); if (len_b < len_a) { use_a = false; } // else use_a is true but was already assigned like that } if (use_a) { assign_a(point, a, b); } else { assign_b(point, a, b); } } CoordinateType dx_a, dy_a; CoordinateType dx_b, dy_b; SegmentRatio robust_ra; SegmentRatio robust_rb; }; template static inline void cramers_rule(D const& dx_a, D const& dy_a, D const& dx_b, D const& dy_b, W const& wx, W const& wy, // out: ResultType& d, ResultType& da) { // Cramers rule d = geometry::detail::determinant(dx_a, dy_a, dx_b, dy_b); da = geometry::detail::determinant(dx_b, dy_b, wx, wy); // Ratio is da/d , collinear if d == 0, intersecting if 0 <= r <= 1 // IntersectionPoint = (x1 + r * dx_a, y1 + r * dy_a) } // Version for non-rescaled policies template < typename UniqueSubRange1, typename UniqueSubRange2, typename Policy > static inline typename Policy::return_type apply(UniqueSubRange1 const& range_p, UniqueSubRange2 const& range_q, Policy const& policy) { // Pass the same ranges both as normal ranges and as robust ranges return apply(range_p, range_q, policy, range_p, range_q); } // Main entry-routine, calculating intersections of segments p / q template < typename UniqueSubRange1, typename UniqueSubRange2, typename Policy, typename RobustUniqueSubRange1, typename RobustUniqueSubRange2 > static inline typename Policy::return_type apply(UniqueSubRange1 const& range_p, UniqueSubRange2 const& range_q, Policy const&, RobustUniqueSubRange1 const& robust_range_p, RobustUniqueSubRange2 const& robust_range_q) { typedef typename UniqueSubRange1::point_type point1_type; typedef typename UniqueSubRange2::point_type point2_type; BOOST_CONCEPT_ASSERT( (concepts::ConstPoint) ); BOOST_CONCEPT_ASSERT( (concepts::ConstPoint) ); // Get robust points (to be omitted later) typedef typename RobustUniqueSubRange1::point_type robust_point1_type; typedef typename RobustUniqueSubRange2::point_type robust_point2_type; point1_type const& p1 = range_p.at(0); point1_type const& p2 = range_p.at(1); point2_type const& q1 = range_q.at(0); point2_type const& q2 = range_q.at(1); robust_point1_type const& robust_a1 = robust_range_p.at(0); robust_point1_type const& robust_a2 = robust_range_p.at(1); robust_point2_type const& robust_b1 = robust_range_q.at(0); robust_point2_type const& robust_b2 = robust_range_q.at(1); using geometry::detail::equals::equals_point_point; bool const a_is_point = equals_point_point(robust_a1, robust_a2, point_in_point_strategy_type()); bool const b_is_point = equals_point_point(robust_b1, robust_b2, point_in_point_strategy_type()); if(a_is_point && b_is_point) { // Take either a or b model::referring_segment const d(p1, p2); return equals_point_point(robust_a1, robust_b2, point_in_point_strategy_type()) ? Policy::degenerate(d, true) : Policy::disjoint() ; } side_info sides; sides.set<0>(side_strategy_type::apply(robust_b1, robust_b2, robust_a1), side_strategy_type::apply(robust_b1, robust_b2, robust_a2)); if (sides.same<0>()) { // Both points are at same side of other segment, we can leave return Policy::disjoint(); } sides.set<1>(side_strategy_type::apply(robust_a1, robust_a2, robust_b1), side_strategy_type::apply(robust_a1, robust_a2, robust_b2)); if (sides.same<1>()) { // Both points are at same side of other segment, we can leave return Policy::disjoint(); } bool collinear = sides.collinear(); typedef typename select_most_precise < typename geometry::coordinate_type::type, typename geometry::coordinate_type::type >::type robust_coordinate_type; typedef segment_ratio ratio_type; segment_intersection_info < typename select_calculation_type::type, ratio_type > sinfo; sinfo.dx_a = get<0>(p2) - get<0>(p1); // distance in x-dir sinfo.dx_b = get<0>(q2) - get<0>(q1); sinfo.dy_a = get<1>(p2) - get<1>(p1); // distance in y-dir sinfo.dy_b = get<1>(q2) - get<1>(q1); robust_coordinate_type const robust_dx_a = get<0>(robust_a2) - get<0>(robust_a1); robust_coordinate_type const robust_dx_b = get<0>(robust_b2) - get<0>(robust_b1); robust_coordinate_type const robust_dy_a = get<1>(robust_a2) - get<1>(robust_a1); robust_coordinate_type const robust_dy_b = get<1>(robust_b2) - get<1>(robust_b1); // r: ratio 0-1 where intersection divides A/B // (only calculated for non-collinear segments) if (! collinear) { robust_coordinate_type robust_da0, robust_da; robust_coordinate_type robust_db0, robust_db; cramers_rule(robust_dx_a, robust_dy_a, robust_dx_b, robust_dy_b, get<0>(robust_a1) - get<0>(robust_b1), get<1>(robust_a1) - get<1>(robust_b1), robust_da0, robust_da); cramers_rule(robust_dx_b, robust_dy_b, robust_dx_a, robust_dy_a, get<0>(robust_b1) - get<0>(robust_a1), get<1>(robust_b1) - get<1>(robust_a1), robust_db0, robust_db); math::detail::equals_factor_policy policy(robust_dx_a, robust_dy_a, robust_dx_b, robust_dy_b); robust_coordinate_type const zero = 0; if (math::detail::equals_by_policy(robust_da0, zero, policy) || math::detail::equals_by_policy(robust_db0, zero, policy)) { // If this is the case, no rescaling is done for FP precision. // We set it to collinear, but it indicates a robustness issue. sides.set<0>(0,0); sides.set<1>(0,0); collinear = true; } else { sinfo.robust_ra.assign(robust_da, robust_da0); sinfo.robust_rb.assign(robust_db, robust_db0); } } // Declare segments, currently necessary for the policies // (segment_crosses, segment_colinear, degenerate, one_degenerate, etc) model::referring_segment const p(p1, p2); model::referring_segment const q(q1, q2); if (collinear) { std::pair const collinear_use_first = is_x_more_significant(geometry::math::abs(robust_dx_a), geometry::math::abs(robust_dy_a), geometry::math::abs(robust_dx_b), geometry::math::abs(robust_dy_b), a_is_point, b_is_point); if (collinear_use_first.second) { // Degenerate cases: segments of single point, lying on other segment, are not disjoint // This situation is collinear too if (collinear_use_first.first) { return relate_collinear<0, Policy, ratio_type>(p, q, robust_a1, robust_a2, robust_b1, robust_b2, a_is_point, b_is_point); } else { // Y direction contains larger segments (maybe dx is zero) return relate_collinear<1, Policy, ratio_type>(p, q, robust_a1, robust_a2, robust_b1, robust_b2, a_is_point, b_is_point); } } } return Policy::segments_crosses(sides, sinfo, p, q); } private: // first is true if x is more significant // second is true if the more significant difference is not 0 template static inline std::pair is_x_more_significant(RobustCoordinateType const& abs_robust_dx_a, RobustCoordinateType const& abs_robust_dy_a, RobustCoordinateType const& abs_robust_dx_b, RobustCoordinateType const& abs_robust_dy_b, bool const a_is_point, bool const b_is_point) { //BOOST_GEOMETRY_ASSERT_MSG(!(a_is_point && b_is_point), "both segments shouldn't be degenerated"); // for degenerated segments the second is always true because this function // shouldn't be called if both segments were degenerated if (a_is_point) { return std::make_pair(abs_robust_dx_b >= abs_robust_dy_b, true); } else if (b_is_point) { return std::make_pair(abs_robust_dx_a >= abs_robust_dy_a, true); } else { RobustCoordinateType const min_dx = (std::min)(abs_robust_dx_a, abs_robust_dx_b); RobustCoordinateType const min_dy = (std::min)(abs_robust_dy_a, abs_robust_dy_b); return min_dx == min_dy ? std::make_pair(true, min_dx > RobustCoordinateType(0)) : std::make_pair(min_dx > min_dy, true); } } template < std::size_t Dimension, typename Policy, typename RatioType, typename Segment1, typename Segment2, typename RobustPoint1, typename RobustPoint2 > static inline typename Policy::return_type relate_collinear(Segment1 const& a, Segment2 const& b, RobustPoint1 const& robust_a1, RobustPoint1 const& robust_a2, RobustPoint2 const& robust_b1, RobustPoint2 const& robust_b2, bool a_is_point, bool b_is_point) { if (a_is_point) { return relate_one_degenerate(a, get(robust_a1), get(robust_b1), get(robust_b2), true); } if (b_is_point) { return relate_one_degenerate(b, get(robust_b1), get(robust_a1), get(robust_a2), false); } return relate_collinear(a, b, get(robust_a1), get(robust_a2), get(robust_b1), get(robust_b2)); } /// Relate segments known collinear template < typename Policy, typename RatioType, typename Segment1, typename Segment2, typename RobustType1, typename RobustType2 > static inline typename Policy::return_type relate_collinear(Segment1 const& a, Segment2 const& b, RobustType1 oa_1, RobustType1 oa_2, RobustType2 ob_1, RobustType2 ob_2) { // Calculate the ratios where a starts in b, b starts in a // a1--------->a2 (2..7) // b1----->b2 (5..8) // length_a: 7-2=5 // length_b: 8-5=3 // b1 is located w.r.t. a at ratio: (5-2)/5=3/5 (on a) // b2 is located w.r.t. a at ratio: (8-2)/5=6/5 (right of a) // a1 is located w.r.t. b at ratio: (2-5)/3=-3/3 (left of b) // a2 is located w.r.t. b at ratio: (7-5)/3=2/3 (on b) // A arrives (a2 on b), B departs (b1 on a) // If both are reversed: // a2<---------a1 (7..2) // b2<-----b1 (8..5) // length_a: 2-7=-5 // length_b: 5-8=-3 // b1 is located w.r.t. a at ratio: (8-7)/-5=-1/5 (before a starts) // b2 is located w.r.t. a at ratio: (5-7)/-5=2/5 (on a) // a1 is located w.r.t. b at ratio: (7-8)/-3=1/3 (on b) // a2 is located w.r.t. b at ratio: (2-8)/-3=6/3 (after b ends) // If both one is reversed: // a1--------->a2 (2..7) // b2<-----b1 (8..5) // length_a: 7-2=+5 // length_b: 5-8=-3 // b1 is located w.r.t. a at ratio: (8-2)/5=6/5 (after a ends) // b2 is located w.r.t. a at ratio: (5-2)/5=3/5 (on a) // a1 is located w.r.t. b at ratio: (2-8)/-3=6/3 (after b ends) // a2 is located w.r.t. b at ratio: (7-8)/-3=1/3 (on b) RobustType1 const length_a = oa_2 - oa_1; // no abs, see above RobustType2 const length_b = ob_2 - ob_1; RatioType ra_from(oa_1 - ob_1, length_b); RatioType ra_to(oa_2 - ob_1, length_b); RatioType rb_from(ob_1 - oa_1, length_a); RatioType rb_to(ob_2 - oa_1, length_a); // use absolute measure to detect endpoints intersection // NOTE: it'd be possible to calculate bx_wrt_a using ax_wrt_b values int const a1_wrt_b = position_value(oa_1, ob_1, ob_2); int const a2_wrt_b = position_value(oa_2, ob_1, ob_2); int const b1_wrt_a = position_value(ob_1, oa_1, oa_2); int const b2_wrt_a = position_value(ob_2, oa_1, oa_2); // fix the ratios if necessary // CONSIDER: fixing ratios also in other cases, if they're inconsistent // e.g. if ratio == 1 or 0 (so IP at the endpoint) // but position value indicates that the IP is in the middle of the segment // because one of the segments is very long // In such case the ratios could be moved into the middle direction // by some small value (e.g. EPS+1ULP) if (a1_wrt_b == 1) { ra_from.assign(0, 1); rb_from.assign(0, 1); } else if (a1_wrt_b == 3) { ra_from.assign(1, 1); rb_to.assign(0, 1); } if (a2_wrt_b == 1) { ra_to.assign(0, 1); rb_from.assign(1, 1); } else if (a2_wrt_b == 3) { ra_to.assign(1, 1); rb_to.assign(1, 1); } if ((a1_wrt_b < 1 && a2_wrt_b < 1) || (a1_wrt_b > 3 && a2_wrt_b > 3)) //if ((ra_from.left() && ra_to.left()) || (ra_from.right() && ra_to.right())) { return Policy::disjoint(); } bool const opposite = math::sign(length_a) != math::sign(length_b); return Policy::segments_collinear(a, b, opposite, a1_wrt_b, a2_wrt_b, b1_wrt_a, b2_wrt_a, ra_from, ra_to, rb_from, rb_to); } /// Relate segments where one is degenerate template < typename Policy, typename RatioType, typename DegenerateSegment, typename RobustType1, typename RobustType2 > static inline typename Policy::return_type relate_one_degenerate(DegenerateSegment const& degenerate_segment, RobustType1 d, RobustType2 s1, RobustType2 s2, bool a_degenerate) { // Calculate the ratios where ds starts in s // a1--------->a2 (2..6) // b1/b2 (4..4) // Ratio: (4-2)/(6-2) RatioType const ratio(d - s1, s2 - s1); if (!ratio.on_segment()) { return Policy::disjoint(); } return Policy::one_degenerate(degenerate_segment, ratio, a_degenerate); } template static inline int position_value(ProjCoord1 const& ca1, ProjCoord2 const& cb1, ProjCoord2 const& cb2) { // S1x 0 1 2 3 4 // S2 |----------> return math::equals(ca1, cb1) ? 1 : math::equals(ca1, cb2) ? 3 : cb1 < cb2 ? ( ca1 < cb1 ? 0 : ca1 > cb2 ? 4 : 2 ) : ( ca1 > cb1 ? 0 : ca1 < cb2 ? 4 : 2 ); } }; #ifndef DOXYGEN_NO_STRATEGY_SPECIALIZATIONS namespace services { template struct default_strategy { typedef cartesian_segments type; }; } // namespace services #endif // DOXYGEN_NO_STRATEGY_SPECIALIZATIONS }} // namespace strategy::intersection namespace strategy { namespace within { namespace services { template struct default_strategy { typedef strategy::intersection::cartesian_segments<> type; }; template struct default_strategy { typedef strategy::intersection::cartesian_segments<> type; }; template struct default_strategy { typedef strategy::intersection::cartesian_segments<> type; }; template struct default_strategy { typedef strategy::intersection::cartesian_segments<> type; }; }} // within::services namespace covered_by { namespace services { template struct default_strategy { typedef strategy::intersection::cartesian_segments<> type; }; template struct default_strategy { typedef strategy::intersection::cartesian_segments<> type; }; template struct default_strategy { typedef strategy::intersection::cartesian_segments<> type; }; template struct default_strategy { typedef strategy::intersection::cartesian_segments<> type; }; }} // within::services } // strategy }} // namespace boost::geometry #endif // BOOST_GEOMETRY_STRATEGIES_CARTESIAN_INTERSECTION_HPP