update of waypoints working