mavlink: bugs fixed