Box.hpp

#ifndef BOX_HPP
#define BOX_HPP

#include <boost/array.hpp>
#include <boost/range/begin.hpp>
#include <boost/range/end.hpp>
#include <boost/multi_array.hpp>
#include <utility>
#include <algorithm>
#include "utils/array_helper.hpp"
#include "Shape.hpp"
#include "linear_algebra.hpp"

template<typename T_>
class Box
{
public:
    typedef T_ value_type;
    typedef Vector3<T_> position_type;
    typedef T_ length_type;

public:
    Box(position_type const& position = position_type())
        : position_(position),
          units_(array_gen(
            create_vector<position_type>(1., 0., 0.),
            create_vector<position_type>(0., 1., 0.),
            create_vector<position_type>(0., 0., 1.))),
          half_extent_(array_gen<length_type>(0.5, 0.5, 0.5)) {}

    template<typename Tarray_>
    Box(position_type const& position, Tarray_ const& half_extent)
        : position_(position),
          units_(array_gen(
            create_vector<position_type>(1., 0., 0.),
            create_vector<position_type>(0., 1., 0.),
            create_vector<position_type>(0., 0., 1.)))
    {
        std::copy(boost::begin(half_extent), boost::end(half_extent),
                  boost::begin(half_extent_));
    }

    template<typename Tarray1, typename Tarray2>
    Box(position_type const& position,
        Tarray1 const& units, Tarray2 const& half_extent)
        : position_(position)
    {
        std::copy(boost::begin(units), boost::end(units),
                  boost::begin(units_));
        std::copy(boost::begin(half_extent), boost::end(half_extent),
                  boost::begin(half_extent_));
    }

    template<typename Tarray_>
    Box(position_type const& position,
        position_type const& vx,
        position_type const& vy,
        position_type const& vz,
        Tarray_ const& half_extent = array_gen<length_type>(0.5, 0.5, 0.5))
        : position_(position), units_(array_gen(vx, vy, vz))
    {
        std::copy(boost::begin(half_extent), boost::end(half_extent),
                  boost::begin(half_extent_));
    }

    Box(position_type const& position,
        position_type const& vx,
        position_type const& vy,
        position_type const& vz,
        length_type const& half_lx,
        length_type const& half_ly,
        length_type const& half_lz)
        : position_(position), units_(array_gen(vx, vy, vz)),
          half_extent_(array_gen<length_type>(half_lx, half_ly, half_lz)) {}

    position_type const& position() const
    {
        return position_;
    }

    position_type& position()
    {
        return position_;
    }

    position_type const& unit_x() const
    {
        return units_[0];
    }

    position_type& unit_x()
    {
        return units_[0];
    }

    position_type const& unit_y() const
    {
        return units_[1];
    }

    position_type& unit_y()
    {
        return units_[1];
    }

    position_type const& unit_z() const
    {
        return units_[2];
    }

    position_type& unit_z()
    {
        return units_[2];
    }

    boost::array<position_type, 3> const& units() const
    {
        return units_;
    }

    boost::array<position_type, 3>& units()
    {
        return units_;
    }

    length_type const Lx() const
    { 
        return 2 * half_extent_[0];
    }

    length_type Lx()
    {
        return 2 * half_extent_[0];
    }

    length_type const Ly() const
    {
        return 2 * half_extent_[1];
    }

    length_type Ly()
    {
        return 2 * half_extent_[1];
    }

    length_type const Lz() const
    {
        return 2 * half_extent_[2];
    }

    length_type Lz()
    {
        return 2 * half_extent_[2];
    }

    boost::array<length_type, 3> const& half_extent() const
    {
        return half_extent_;
    }

    boost::array<length_type, 3>& half_extent()
    {
        return half_extent_;
    }

    bool operator==(const Box& rhs) const
    {
        return position_ == rhs.position_ && units_ == rhs.units_ &&
               half_extent_ == rhs.half_extent_;
    }

    bool operator!=(const Box& rhs) const
    {
        return !operator==(rhs);
    }

    std::string show(int precision)
    {
        std::ostringstream strm;
        strm.precision(precision);
        strm << *this;
        return strm.str();
    }

protected:
    // Middle of box.
    position_type position_;
    boost::array<position_type, 3> units_;
    // Extent: for a box of 2 by 2 by 2, half_extent is 1 by 1 by 1.
    boost::array<length_type, 3> half_extent_;
};

template<typename T_>
inline boost::array<typename Box<T_>::length_type, 3>
to_internal(Box<T_> const& obj, typename Box<T_>::position_type const& pos)
{
    // Return pos relative to position of box. 
    typedef typename Box<T_>::position_type position_type;
    position_type pos_vector(subtract(pos, obj.position()));

    return array_gen<typename Box<T_>::length_type>(
        dot_product(pos_vector, obj.unit_x()),
        dot_product(pos_vector, obj.unit_y()),
        dot_product(pos_vector, obj.unit_z()));
}

template<typename T_>
inline std::pair<typename Box<T_>::position_type,
                 typename Box<T_>::length_type>
projected_point(Box<T_> const& obj, typename Box<T_>::position_type const& pos)
{
    // Todo. If we ever need it.
    // The projection of a point on a box.
    return std::make_pair(typename Box<T_>::position_type(),
                          typename Box<T_>::length_type());
}

template<typename T_>
inline typename Box<T_>::length_type
distance(Box<T_> const& obj, typename Box<T_>::position_type const& pos)
{
    typedef typename Box<T_>::length_type length_type;
    boost::array<length_type, 3> x_y_z(to_internal(obj, pos));
    boost::array<length_type, 3> dx_dy_dz(subtract(abs(x_y_z), obj.half_extent()));

    if (dx_dy_dz[0] > 0)
    {
        if (dx_dy_dz[1] > 0)
        {
            if (dx_dy_dz[2] > 0)
            {
                // Far away from box.
                return length(dx_dy_dz);
            }
            else
            {
                return length(array_slice<0, 2>(dx_dy_dz));
            }
        }
        else
        {
            if (dx_dy_dz[2] > 0)
            {
                return std::sqrt(gsl_pow_2(dx_dy_dz[0]) + gsl_pow_2(dx_dy_dz[2]));
            }
            else
            {
                return dx_dy_dz[0];
            }
        }
    }
    else
    {
        if (dx_dy_dz[1] > 0)
        {
            if (dx_dy_dz[2] > 0)
            {
                return length(array_slice<1, 3>(dx_dy_dz));
            }
            else
            {
                return dx_dy_dz[1];
            }
        }
        else
        {
            if (dx_dy_dz[2] > 0)
            {
                return dx_dy_dz[2];
            }
            else
            {
                // Inside box.
                return std::max(std::max(dx_dy_dz[0], dx_dy_dz[1]), dx_dy_dz[2]);
            }
        }
    }
}

template<typename T, typename Trng>
inline typename Box<T>::position_type
random_position(Box<T> const& shape, Trng& rng)
{
    boost::const_multi_array_ref<T, 2> mat(&shape.units()[0][0], boost::extents[3][3]);
    // -1 < rng() < 1. See for example CuboidalRegion.hpp.
    return add(
        shape.position(),
        multiply(
            create_vector<typename Box<T>::position_type>(
                shape.half_extent()[0] * rng(),
                shape.half_extent()[1] * rng(),
                shape.half_extent()[2] * rng()),
            mat));
}

template<typename T>
inline Box<T> const& shape(Box<T> const& shape)
{
    return shape;
}

template<typename T>
inline Box<T>& shape(Box<T>& shape)
{
    return shape;
}

template<typename T_>
struct is_shape<Box<T_> >: public boost::mpl::true_ {};

template<typename T_>
struct shape_position_type<Box<T_> >
{
    typedef typename Box<T_>::position_type type;
};

template<typename Tstrm_, typename Ttraits_, typename T_>
inline std::basic_ostream<Tstrm_, Ttraits_>& operator<<(std::basic_ostream<Tstrm_, Ttraits_>& strm,
        const Box<T_>& v)
{
    strm << "{" << v.position() <<  ", " << v.unit_x() << ", " << v.unit_y() << ", " << v.unit_z() << "," << v.Lx() << ", " << v.Ly() << ", " << v.Lz() << "}";
    return strm;
}


#if defined(HAVE_TR1_FUNCTIONAL)
namespace std { namespace tr1 {
#elif defined(HAVE_STD_HASH)
namespace std {
#elif defined(HAVE_BOOST_FUNCTIONAL_HASH_HPP)
namespace boost {
#endif

template<typename T_>
struct hash<Box<T_> >
{
    typedef Box<T_> argument_type;

    std::size_t operator()(argument_type const& val)
    {
        return hash<typename argument_type::position_type>()(val.position()) ^
            hash<typename argument_type::position_type>()(val.unit_x()) ^
            hash<typename argument_type::position_type>()(val.unit_y()) ^
            hash<typename argument_type::position_type>()(val.unit_z()) ^
            hash<typename argument_type::length_type>()(val.half_extent()[0]) ^
            hash<typename argument_type::length_type>()(val.half_extent()[1]) ^
            hash<typename argument_type::length_type>()(val.half_extent()[2]);
    }
};

#if defined(HAVE_TR1_FUNCTIONAL)
} } // namespace std::tr1
#elif defined(HAVE_STD_HASH)
} // namespace std
#elif defined(HAVE_BOOST_FUNCTIONAL_HASH_HPP)
} // namespace boost
#endif

#endif /* BOX_HPP */