weird errors when going to normal mode

bsp_q7s/core/ObjectFactory.cpp

@@ -147,7 +147,7 @@ void ObjectFactory::produce(void* args) {
       new I2cCookie(addresses::IMTQ, IMTQ::MAX_REPLY_SIZE, q7s::I2C_DEFAULT_DEV);
   auto imtqHandler = new IMTQHandler(objects::IMTQ_HANDLER, objects::I2C_COM_IF, imtqI2cCookie);
 #if OBSW_DEBUG_IMTQ == 1
-  imtqHandler->setToGoToNormal();
+  imtqHandler->setToGoToNormal(true);
   imtqHandler->setStartUpImmediately();
 #endif
 #endif

mission/devices/IMTQHandler.cpp

@@ -1,11 +1,12 @@
 #include "IMTQHandler.h"
-#include "OBSWConfig.h"
 
 #include <fsfw/datapool/PoolReadGuard.h>
 #include <fsfw/globalfunctions/CRC.h>
 
 #include <cmath>
 
+#include "OBSWConfig.h"
+
 IMTQHandler::IMTQHandler(object_id_t objectId, object_id_t comIF, CookieIF* comCookie)
     : DeviceHandlerBase(objectId, comIF, comCookie),
       engHkDataset(this),
@@ -694,7 +695,7 @@ void IMTQHandler::fillEngHkDataset(const uint8_t* packet) {
 #endif
 }
 
-void IMTQHandler::setToGoToNormal() { mode = MODE_NORMAL; }
+void IMTQHandler::setToGoToNormal(bool enable) { this->goToNormalMode = enable; }
 
 void IMTQHandler::handleDeviceTM(const uint8_t* data, size_t dataSize, DeviceCommandId_t replyId) {
   if (wiretappingMode == RAW) {

mission/devices/IMTQHandler.h

@@ -18,7 +18,7 @@ class IMTQHandler : public DeviceHandlerBase {
   /**
    * @brief   Sets mode to MODE_NORMAL. Can be used for debugging.
    */
-  void setToGoToNormal();
+  void setToGoToNormal(bool enable);
 
  protected:
   void doStartUp() override;

mission/devices/devicedefinitions/GomspaceDefinitions.h

@@ -360,6 +360,22 @@ enum P60SytemPoolIds : lp_id_t {
 
 namespace P60Dock {
 
+enum SwitchChannels : uint8_t {
+  ACU = 0,
+  PDU1 = 1,
+  X3_IDLE = 2,
+  PDU2_VCC = 3,
+  ACU_VBAT = 4,
+  PDU1_VBAT = 5,
+  X3_IDLE_VBAT = 6,
+  PDU2_VBAT = 7,
+  STACK_VBAT = 8,
+  STACK_3V3 = 9,
+  STACK_5V = 10,
+  GS3V3 = 11,
+  GS5V = 12
+};
+
 /** Max reply size reached when requesting full hk table */
 static const uint16_t MAX_REPLY_LENGTH = 407;
 

tmtc

@@ -1 +1 @@
-Subproject commit 50128b7304470281ff90bc3dcc51c714a7e6b99f
+Subproject commit e710390f5330e3be1f14ba9c6082cbbfbcd9aec1