Minor fixes to MAVLink
Merge pull request #1026 from PX4/mavlink_fixes

Minor fixes to MAVLink