697 lines
20 KiB
C++
697 lines
20 KiB
C++
// 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
|