mavlink, mavlink_onboard: bugfixes, code style fixed