mavlink_onboard: major optimization, cleanup and minor fixes, WIP
mavlink, mavlink_onboard: bugfixes, code style fixed
Merge pull request #448 from PX4/mavlink_fix

mavlink optimization