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