set pref sd as param

bsp_q7s/core/CoreController.cpp

@@ -40,7 +40,8 @@ CoreController::CoreController(object_id_t objectId, bool enableHkSet)
       cmdRepliesSizes(128),
       opDivider5(5),
       opDivider10(10),
-      hkSet(this) {
+      hkSet(this),
+      paramHelper(this) {
   cmdExecutor.setRingBuffer(&cmdReplyBuf, &cmdRepliesSizes);
   try {
     sdcMan = SdCardManager::instance();
@@ -88,6 +89,10 @@ CoreController::CoreController(object_id_t objectId, bool enableHkSet)
 CoreController::~CoreController() {}
 
 ReturnValue_t CoreController::handleCommandMessage(CommandMessage *message) {
+  ReturnValue_t result = paramHelper.handleParameterMessage(message);
+  if(result == returnvalue::OK) {
+    return result;
+  }
   return ExtendedControllerBase::handleCommandMessage(message);
 }
 
@@ -154,6 +159,11 @@ ReturnValue_t CoreController::initialize() {
                  << std::endl;
   }
 
+  result = paramHelper.initialize();
+  if(result != returnvalue::OK) {
+    return result;
+  }
+
   sdStateMachine();
 
   triggerEvent(core::REBOOT_SW, CURRENT_CHIP, CURRENT_COPY);
@@ -2128,3 +2138,31 @@ bool CoreController::isNumber(const std::string &s) {
   return !s.empty() && std::find_if(s.begin(), s.end(),
                                     [](unsigned char c) { return !std::isdigit(c); }) == s.end();
 }
+
+ReturnValue_t CoreController::getParameter(uint8_t domainId, uint8_t uniqueIdentifier,
+                                           ParameterWrapper *parameterWrapper,
+                                           const ParameterWrapper *newValues,
+                                           uint16_t startAtIndex) {
+  if(domainId != 0) {
+    return HasParametersIF::INVALID_DOMAIN_ID;
+  }
+  if(uniqueIdentifier >= ParamId::NUM_IDS) {
+    return HasParametersIF::INVALID_IDENTIFIER_ID;
+  }
+    uint8_t newPrefSd;
+    ReturnValue_t result = newValues->getElement(&newPrefSd);
+    if (result != returnvalue::OK) {
+      return result;
+    }
+    // Only SD card 0 (0) and 1 (1) are allowed values.
+    if(newPrefSd > 1) {
+      return HasParametersIF::INVALID_VALUE;
+    }
+    result = sdcMan->setPreferredSdCard(static_cast<sd::SdCard>(newPrefSd));
+    if(result != returnvalue::OK) {
+      return returnvalue::FAILED;
+    }
+    parameterWrapper->set(prefSdRaw);
+    return returnvalue::OK;
+
+}