DriverPlatform-V3.1/ECOM_commonTools/boost/geometry/algorithms/detail/disjoint.hpp

// Boost.Geometry (aka GGL, Generic Geometry Library)

// Copyright (c) 2007-2012 Barend Gehrels, Amsterdam, the Netherlands.
// Copyright (c) 2008-2012 Bruno Lalande, Paris, France.
// Copyright (c) 2009-2012 Mateusz Loskot, London, UK.

// Parts of Boost.Geometry are redesigned from Geodan's Geographic Library
// (geolib/GGL), copyright (c) 1995-2010 Geodan, Amsterdam, the Netherlands.

// 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_ALGORITHMS_DETAIL_DISJOINT_HPP
#define BOOST_GEOMETRY_ALGORITHMS_DETAIL_DISJOINT_HPP

// Note: contrary to most files, the geometry::detail::disjoint namespace
// is partly implemented in a separate file, to avoid circular references
// disjoint -> get_turns -> disjoint

#include <cstddef>

#include <boost/range.hpp>

#include <boost/geometry/core/access.hpp>
#include <boost/geometry/core/coordinate_dimension.hpp>
#include <boost/geometry/core/reverse_dispatch.hpp>

#include <boost/geometry/algorithms/covered_by.hpp>

#include <boost/geometry/util/math.hpp>



namespace boost { namespace geometry
{


#ifndef DOXYGEN_NO_DETAIL
namespace detail { namespace disjoint
{


struct disjoint_interrupt_policy
{
    static bool const enabled = true;
    bool has_intersections;

    inline disjoint_interrupt_policy()
        : has_intersections(false)
    {}

    template <typename Range>
    inline bool apply(Range const& range)
    {
        // If there is any IP in the range, it is NOT disjoint
        if (boost::size(range) > 0)
        {
            has_intersections = true;
            return true;
        }
        return false;
    }
};



template
<
    typename Point1, typename Point2,
    std::size_t Dimension, std::size_t DimensionCount
>
struct point_point
{
    static inline bool apply(Point1 const& p1, Point2 const& p2)
    {
        if (! geometry::math::equals(get<Dimension>(p1), get<Dimension>(p2)))
        {
            return true;
        }
        return point_point
            <
                Point1, Point2,
                Dimension + 1, DimensionCount
            >::apply(p1, p2);
    }
};


template <typename Point1, typename Point2, std::size_t DimensionCount>
struct point_point<Point1, Point2, DimensionCount, DimensionCount>
{
    static inline bool apply(Point1 const& , Point2 const& )
    {
        return false;
    }
};


template
<
    typename Point, typename Box,
    std::size_t Dimension, std::size_t DimensionCount
>
struct point_box
{
    static inline bool apply(Point const& point, Box const& box)
    {
        if (get<Dimension>(point) < get<min_corner, Dimension>(box)
            || get<Dimension>(point) > get<max_corner, Dimension>(box))
        {
            return true;
        }
        return point_box
            <
                Point, Box,
                Dimension + 1, DimensionCount
            >::apply(point, box);
    }
};


template <typename Point, typename Box, std::size_t DimensionCount>
struct point_box<Point, Box, DimensionCount, DimensionCount>
{
    static inline bool apply(Point const& , Box const& )
    {
        return false;
    }
};


template
<
    typename Box1, typename Box2,
    std::size_t Dimension, std::size_t DimensionCount
>
struct box_box
{
    static inline bool apply(Box1 const& box1, Box2 const& box2)
    {
        if (get<max_corner, Dimension>(box1) < get<min_corner, Dimension>(box2))
        {
            return true;
        }
        if (get<min_corner, Dimension>(box1) > get<max_corner, Dimension>(box2))
        {
            return true;
        }
        return box_box
            <
                Box1, Box2,
                Dimension + 1, DimensionCount
            >::apply(box1, box2);
    }
};


template <typename Box1, typename Box2, std::size_t DimensionCount>
struct box_box<Box1, Box2, DimensionCount, DimensionCount>
{
    static inline bool apply(Box1 const& , Box2 const& )
    {
        return false;
    }
};

// Segment - Box intersection
// Based on Ray-AABB intersection
// http://www.siggraph.org/education/materials/HyperGraph/raytrace/rtinter3.htm

// TODO - later maybe move to strategy::intersects and add a policy to conditionally extract intersection points

template <typename Point, typename Box, size_t I>
struct segment_box_intersection_dim
{
    //BOOST_STATIC_ASSERT(I < dimension<Box>::value);
    //BOOST_STATIC_ASSERT(I < dimension<Point>::value);
    //BOOST_STATIC_ASSERT(dimension<Point>::value == dimension<Box>::value);

    typedef typename coordinate_type<Point>::type point_coordinate;

    template <typename RelativeDistance> static inline
    bool apply(Point const& p0, Point const& p1, Box const& b, RelativeDistance & t_near, RelativeDistance & t_far)
    {
        //// WARNING! - RelativeDistance must be IEEE float for this to work (division by 0)
        //BOOST_STATIC_ASSERT(boost::is_float<RelativeDistance>::value);
        //// Ray origin is in segment point 0
        //RelativeDistance ray_d = geometry::get<I>(p1) - geometry::get<I>(p0);
        //RelativeDistance tn = ( geometry::get<min_corner, I>(b) - geometry::get<I>(p0) ) / ray_d;
        //RelativeDistance tf = ( geometry::get<max_corner, I>(b) - geometry::get<I>(p0) ) / ray_d;

        // TODO - should we support also unsigned integers?
        BOOST_STATIC_ASSERT(!boost::is_unsigned<point_coordinate>::value);
        point_coordinate ray_d = geometry::get<I>(p1) - geometry::get<I>(p0);
        RelativeDistance tn, tf;
        if ( is_zero(ray_d) )
        {
            tn = dist_div_by_zero<RelativeDistance>(geometry::get<min_corner, I>(b) - geometry::get<I>(p0));
            tf = dist_div_by_zero<RelativeDistance>(geometry::get<max_corner, I>(b) - geometry::get<I>(p0));
        }
        else
        {
            tn = static_cast<RelativeDistance>(geometry::get<min_corner, I>(b) - geometry::get<I>(p0)) / ray_d;
            tf = static_cast<RelativeDistance>(geometry::get<max_corner, I>(b) - geometry::get<I>(p0)) / ray_d;
        }

        if ( tf < tn )
            ::std::swap(tn, tf);

        if ( t_near < tn )
            t_near = tn;
        if ( tf < t_far )
            t_far = tf;

        return 0 <= t_far && t_near <= t_far && t_near <= 1;
    }

    template <typename R, typename T> static inline
    R dist_div_by_zero(T const& val)
    {
        if ( is_zero(val) )
            return 0;
        else if ( val < 0 )
            return -(::std::numeric_limits<R>::max)();
        else
            return (::std::numeric_limits<R>::max)();
    }

    template <typename T> static inline
    bool is_zero(T const& val)
    {
        // ray_d == 0 is here because eps of rational<int> is 0 which isn't < than 0
        return val == 0 || math::abs(val) < ::std::numeric_limits<T>::epsilon();
    }
};

template <typename Point, typename Box, size_t CurrentDimension>
struct segment_box_intersection_impl
{
    BOOST_STATIC_ASSERT(0 < CurrentDimension);

    typedef segment_box_intersection_dim<Point, Box, CurrentDimension - 1> for_dim;

    template <typename RelativeDistance>
    static inline bool apply(Point const& p0, Point const& p1, Box const& b,
                             RelativeDistance & t_near, RelativeDistance & t_far)
    {
        return segment_box_intersection_impl<Point, Box, CurrentDimension - 1>::apply(p0, p1, b, t_near, t_far)
            && for_dim::apply(p0, p1, b, t_near, t_far);
    }
};

template <typename Point, typename Box>
struct segment_box_intersection_impl<Point, Box, 1>
{
    typedef segment_box_intersection_dim<Point, Box, 0> for_dim;

    template <typename RelativeDistance>
    static inline bool apply(Point const& p0, Point const& p1, Box const& b,
                             RelativeDistance & t_near, RelativeDistance & t_far)
    {
        return for_dim::apply(p0, p1, b, t_near, t_far);
    }
};

template <typename Point, typename Box>
struct segment_box_intersection
{
    typedef segment_box_intersection_impl<Point, Box, dimension<Box>::value> impl;

    static inline bool apply(Point const& p0, Point const& p1, Box const& b)
    {
        typedef
        typename geometry::promote_floating_point<
            typename geometry::select_most_precise<
                typename coordinate_type<Point>::type,
                typename coordinate_type<Box>::type
            >::type
        >::type relative_distance_type;

        relative_distance_type t_near = -(::std::numeric_limits<relative_distance_type>::max)();
        relative_distance_type t_far = (::std::numeric_limits<relative_distance_type>::max)();

        // relative_distance = 0 < t_near ? t_near : 0;

        return impl::apply(p0, p1, b, t_near, t_far);
    }
};

template
<
    typename Geometry1, typename Geometry2
>
struct reverse_covered_by
{
    static inline bool apply(Geometry1 const& geometry1, Geometry2 const& geometry2)
    {
        return ! geometry::covered_by(geometry1, geometry2);
    }
};



/*!
    \brief Internal utility function to detect of boxes are disjoint
    \note Is used from other algorithms, declared separately
        to avoid circular references
 */
template <typename Box1, typename Box2>
inline bool disjoint_box_box(Box1 const& box1, Box2 const& box2)
{
    return box_box
        <
            Box1, Box2,
            0, dimension<Box1>::type::value
        >::apply(box1, box2);
}



/*!
    \brief Internal utility function to detect of points are disjoint
    \note To avoid circular references
 */
template <typename Point1, typename Point2>
inline bool disjoint_point_point(Point1 const& point1, Point2 const& point2)
{
    return point_point
        <
            Point1, Point2,
            0, dimension<Point1>::type::value
        >::apply(point1, point2);
}


}} // namespace detail::disjoint
#endif // DOXYGEN_NO_DETAIL


#ifndef DOXYGEN_NO_DETAIL
namespace detail { namespace equals
{

/*!
    \brief Internal utility function to detect of points are disjoint
    \note To avoid circular references
 */
template <typename Point1, typename Point2>
inline bool equals_point_point(Point1 const& point1, Point2 const& point2)
{
    return ! detail::disjoint::disjoint_point_point(point1, point2);
}


}} // namespace detail::equals
#endif // DOXYGEN_NO_DETAIL

}} // namespace boost::geometry

#endif // BOOST_GEOMETRY_ALGORITHMS_DETAIL_DISJOINT_HPP