Mavlink updated for new messages, and fixed errors within Mavlink.

Updated Mavlink and fixed some errors.