fix handling of setmode when base_mode was not yet updated, also fix some wrong bitmask handling
set_mode fix: cleanup
updated goAutonomous, goManual and toggleAutonomy
Merge pull request #421 from thomasgubler/fix_setmode

Fix setmode (in-air disarm fix)