Added metrics to the hierarchical pathfinding test.