mission/tmtc/CcsdsIpCoreHandler.cpp

@@ -82,6 +82,11 @@ ReturnValue_t CcsdsIpCoreHandler::initialize() {
     return result;
   }
 
+  result = modeHelper.initialize();
+  if (result != returnvalue::OK) {
+    return result;
+  }
+
   VirtualChannelMapIter iter;
   for (iter = virtualChannelMap.begin(); iter != virtualChannelMap.end(); iter++) {
     result = iter->second->initialize();
@@ -364,9 +369,11 @@ ReturnValue_t CcsdsIpCoreHandler::checkModeCommand(Mode_t mode, Submode_t submod
         submode != static_cast<Submode_t>(Submode::DATARATE_LOW)) {
       return HasModesIF::INVALID_SUBMODE;
     }
+  } else if (mode != HasModesIF::MODE_OFF) {
+    return returnvalue::FAILED;
   }
   *msToReachTheMode = 2000;
-  return returnvalue::FAILED;
+  return returnvalue::OK;
 }
 
 void CcsdsIpCoreHandler::startTransition(Mode_t mode, Submode_t submode) {
@@ -387,6 +394,7 @@ void CcsdsIpCoreHandler::startTransition(Mode_t mode, Submode_t submode) {
     disableTransmit();
     mode = HasModesIF::MODE_OFF;
   }
+  modeHelper.modeChanged(mode, submode);
 }
 
 void CcsdsIpCoreHandler::announceMode(bool recursive) { triggerEvent(MODE_INFO, mode, submode); }