Adding, removing and setting waypoints