Small but very useful mavlink lib update.
Merge pull request #585 from Paku-/mavlink_update

Small but very useful mavlink lib update.