AI pathfinding prototype