distance_segment_segment.hpp

#ifndef PASTELGEOMETRY_DISTANCE_SEGMENT_SEGMENT_HPP
#define PASTELGEOMETRY_DISTANCE_SEGMENT_SEGMENT_HPP

#include "pastel/geometry/distance/distance_segment_segment.h"
#include "pastel/geometry/closest/closest_segment_segment.h"

namespace Pastel
{

    template <typename Real, integer N>
    Real distance(
        const Segment<Real, N>& aSegment,
        const Segment<Real, N>& bSegment)
    {
        return std::sqrt(distance2(aSegment, bSegment));
    }

    template <typename Real, integer N>
    Real distance2(
        const Segment<Real, N>& aSegment,
        const Segment<Real, N>& bSegment)
    {
        PENSURE_OP(aSegment.n(), ==, bSegment.n());

        Tuple<Real, 2> t = closest(aSegment, bSegment);
        return dot(bSegment.at(t[1]) - aSegment.at(t[0]));
    }

}

#endif