overlaps_sphere_sphere.hpp

#ifndef PASTELGEOMETRY_OVERLAPS_SPHERE_SPHERE_HPP
#define PASTELGEOMETRY_OVERLAPS_SPHERE_SPHERE_HPP

#include "pastel/geometry/overlap/overlaps_sphere_sphere.h"
#include "pastel/geometry/shape/sphere.h"

namespace Pastel
{

    template <typename Real, integer N>
    bool overlaps(
        const Sphere<Real, N>& aSphere,
        const Sphere<Real, N>& bSphere)
    {
        PENSURE_OP(aSphere.n(), ==, bSphere.n());

        // Two spheres intersect if the distance
        // between their center points is
        // less than or equal to the sum of their radii.

        Real centerDistance2 =
            dot(bSphere.position() - aSphere.position());
        Real radiusSum2 =
            square(aSphere.radius() + bSphere.radius());

        if (centerDistance2 >= radiusSum2)
        {
            if (centerDistance2 > radiusSum2 ||
                aSphere.topology() == Topology::Open ||
                bSphere.topology() == Topology::Open)
            {
                return false;
            }
        }

        return true;
    }

}

#endif