#ifndef _NAVIPROVIDER_H_
#define _NAVIPROVIDER_H_

#include <Common.h>
#include "ForwardsZone.h"
#include <recastnavigation/Detour/Include/DetourNavMesh.h>
#include <recastnavigation/Detour/Include/DetourNavMeshQuery.h>

namespace Sapphire::World::Navi
{

  class NaviProvider
  {

    const int32_t NAVMESHSET_MAGIC = 'M' << 24 | 'S' << 16 | 'E' << 8 | 'T'; //'MSET'
    const int32_t NAVMESHSET_VERSION = 1;

    struct NavMeshSetHeader
    {
      int32_t magic;
      int32_t version;
      int32_t numTiles;
      dtNavMeshParams params;
    };

    struct NavMeshTileHeader
    {
      dtTileRef tileRef;
      int32_t dataSize;
    };

    const int32_t MAX_POLYS = 256;
    const int32_t MAX_SMOOTH = 2048;

  public:
    explicit NaviProvider( const std::string& internalName );

    bool init();
    void loadMesh( const std::string& path );
    void initQuery();

    void toDetourPos( const Common::FFXIVARR_POSITION3& position, float* out );
    Common::FFXIVARR_POSITION3 toGamePos( float* pos );

    std::vector< Common::FFXIVARR_POSITION3 > findFollowPath( const Common::FFXIVARR_POSITION3& startPos, const Common::FFXIVARR_POSITION3& endPos );

    bool hasNaviMesh() const;

  protected:
    std::string m_internalName;

    dtNavMesh* m_naviMesh;
    dtNavMeshQuery* m_naviMeshQuery;

    float m_polyFindRange[ 3 ];

  private:
    int32_t fixupCorridor( dtPolyRef* path, int32_t npath, int32_t maxPath, const dtPolyRef* visited, int32_t nvisited );
    int32_t fixupShortcuts( dtPolyRef* path, int32_t npath, dtNavMeshQuery* navQuery );
    inline bool inRange( const float* v1, const float* v2, const float r, const float h );
    bool getSteerTarget( dtNavMeshQuery* navQuery, const float* startPos, const float* endPos, const float minTargetDist,
		                     const dtPolyRef* path, const int32_t pathSize, float* steerPos, uint8_t& steerPosFlag,
			       	           dtPolyRef& steerPosRef, float* outPoints = 0, int32_t* outPointCount = 0 );

  };

}

#endif