mavproxy: Extended Rally WP handling