distance_segment_sphere.hpp

#ifndef PASTELGEOMETRY_DISTANCE_SEGMENT_SPHERE_HPP
#define PASTELGEOMETRY_DISTANCE_SEGMENT_SPHERE_HPP

#include "pastel/geometry/distance/distance_segment_sphere.h"
#include "pastel/geometry/distance/distance_segment_point.h"

#include <cmath>

namespace Pastel
{

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

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

        Real centerDistance2 =
            Pastel::distance2(segment, sphere.position());

        if (centerDistance2 <= square(sphere.radius()))
        {
            return 0;
        }

        return square(std::sqrt(centerDistance2) - sphere.radius());
    }

}

#endif