Cleaning up MavLink