Sphere.hpp

#ifndef SPHERE_HPP
#define SPHERE_HPP

#include <boost/fusion/sequence/intrinsic/at_c.hpp>
#include <boost/fusion/include/at_c.hpp>
#include <boost/fusion/container/vector.hpp>
#include <boost/fusion/include/vector.hpp>
#include <boost/fusion/container/vector/vector_fwd.hpp>
#include <boost/fusion/include/vector_fwd.hpp>
#include "boost/multi_array.hpp"
#include "Point.hpp"
#include <Space/Shape/Point.hpp>

template<unsigned int dim ,typename T> class Sphere
{
    public:

    typedef boost::fusion::vector<T[3],T> type;

    type data;

    static const unsigned int x = 0;
    static const unsigned int r = 1;

    T center(unsigned int i)
    {
        return boost::fusion::at_c<x>(data)[i];
    }

    template<unsigned int k>Sphere(boost::fusion::vector<T[k]> & c, T radius)
    {
        // Copy the center
        for (int i = 0 ;  i < dim ; i++)
        {
            boost::fusion::at_c<x>(data)[i] = boost::fusion::at_c<x>(c)[i];
        }

        boost::fusion::at_c<r>(data) = radius;
    }

    T radius()
    {
        return boost::fusion::at_c<r>(data);
    }

    template<typename Distance> T isInside(Point<dim,T> p)
    {
        T dist;

        // Object to calculate distances
        Distance d;

        // calculate the distance of the center from the point

        for (int i = 0; i < dim ; i++)
        {
            dist += d.accum_dist(boost::fusion::at_c<x>(data)[i],p.get(i) );
        }

        // Check if the distance is smaller than the radius

        if (dist <= boost::fusion::at_c<r>(data))
        {return true;}
        else
        {return false;}

        return false;
    }

    template<typename Distance> bool isInside(float * pnt)
    {
        T dist;

        // Object to calculate distances
        Distance d;

        // calculate the distance of the center from the point

        for (int i = 0; i < dim ; i++)
        {
            dist += d.accum_dist(boost::fusion::at_c<x>(data)[i],pnt[i],i);
        }

        // Check if the distance is smaller than the radius

        if (dist <= boost::fusion::at_c<r>(data))
        {return true;}
        else
        {return false;}

        return false;
    }
};

#endif