closest_alignedbox_point.hpp

#ifndef PASTELGEOMETRY_CLOSEST_ALIGNEDBOX_POINT_HPP
#define PASTELGEOMETRY_CLOSEST_ALIGNEDBOX_POINT_HPP

#include "pastel/geometry/closest/closest_alignedbox_point.h"

namespace Pastel
{

    template <typename Real, integer N>
    Vector<Real, N> closest(
        const AlignedBox<Real, N>& box,
        const Vector<Real, N>& point)
    {
        Vector<Real, N> result(point);

        const Vector<Real, N>& min = box.min();
        const Vector<Real, N>& max = box.max();

        integer n = point.size();

        for (integer i = 0;i < n;++i)
        {
            if (result[i] < min[i])
            {
                result[i] = min[i];
            }
            else if (result[i] > max[i])
            {
                result[i] = max[i];
            }
        }

        return result;
    }

}

#endif