mavlink, commander: bugs fixed