outbound frame packing: refactored for correctness, debugging, sends every hb

* also snuck in a change that sends mavlink packets to the mavproxy socket
  over a queue, rather than directly, so i can inject some local radio
  status packets