Setup working message send for mavlink