Changes waypoint to listen to state, for visual servoing