Mavlink_test add