position_estimator_inav: critical bug fixed
commander: switch to AUTO_READY or AUTO_MISSION immediately, don't try to stay on ground
Speeded up IO startup, needs review