Respect MAVLink retransmission protocol during mission read requests
Minor code rearrangement