openmw/components/detournavigator/gettilespositions.hpp

#ifndef OPENMW_COMPONENTS_DETOURNAVIGATOR_GETTILESPOSITIONS_H
#define OPENMW_COMPONENTS_DETOURNAVIGATOR_GETTILESPOSITIONS_H

#include "settings.hpp"
#include "settingsutils.hpp"
#include "tileposition.hpp"

#include <BulletCollision/CollisionShapes/btCollisionShape.h>

#include <osg/Vec3f>

namespace DetourNavigator
{
    inline osg::Vec3f makeOsgVec3f(const btVector3& value)
    {
        return osg::Vec3f(value.x(), value.y(), value.z());
    }

    template <class Callback>
    void getTilesPositions(const osg::Vec3f& aabbMin, const osg::Vec3f& aabbMax,
        const Settings& settings, Callback&& callback)
    {
        auto min = toNavMeshCoordinates(settings, aabbMin);
        auto max = toNavMeshCoordinates(settings, aabbMax);

        const auto border = getBorderSize(settings);
        min -= osg::Vec3f(border, border, border);
        max += osg::Vec3f(border, border, border);

        auto minTile = getTilePosition(settings, min);
        auto maxTile = getTilePosition(settings, max);

        if (minTile.x() > maxTile.x())
            std::swap(minTile.x(), maxTile.x());

        if (minTile.y() > maxTile.y())
            std::swap(minTile.y(), maxTile.y());

        for (int tileX = minTile.x(); tileX <= maxTile.x(); ++tileX)
            for (int tileY = minTile.y(); tileY <= maxTile.y(); ++tileY)
                callback(TilePosition {tileX, tileY});
    }

    template <class Callback>
    void getTilesPositions(const btCollisionShape& shape, const btTransform& transform,
        const Settings& settings, Callback&& callback)
    {
        btVector3 aabbMin;
        btVector3 aabbMax;
        shape.getAabb(transform, aabbMin, aabbMax);

        getTilesPositions(makeOsgVec3f(aabbMin), makeOsgVec3f(aabbMax), settings, std::forward<Callback>(callback));
    }
}

#endif