mavlink: bugfix