Fixed upstream MAVLink packet queue