mavlink: Only write to TX buf if space is available. This is working aro...

...und a NuttX issue where overflowing the TX buf leads to being unable to send any further data.

This fixes the unreliability in HIL mode sometimes experienced.