#include <dtAI/navmesh.h>
#include <dtAI/waypoint.h>
#include <dtAI/waypointpair.h>
#include <algorithm>