Sub: Make capability init consistent

ArduSub/system.cpp

@@ -27,6 +27,8 @@ void Sub::init_ardupilot()
                         AP::fwversion().fw_string,
                         (unsigned)hal.util->available_memory());
 
+    init_capabilities();
+
     // load parameters from EEPROM
     load_parameters();
 
@@ -203,9 +205,6 @@ void Sub::init_ardupilot()
 
     ins.set_log_raw_bit(MASK_LOG_IMU_RAW);
 
-    // init vehicle capabilties
-    init_capabilities();
-
     // disable safety if requested
     BoardConfig.init_safety();