public void AddWaypointNext_Inserts_a_node_at_correct_position()
{
navMesh.SetNextWaypoint();
navMesh.AddWaypointNext(waypointToAdd);
Assert.AreEqual(waypointToAdd, navMesh.WaypointList.ElementAt(2));
}
