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