From ebdc492ed1fa7233f536157b7c588fe802ca879e Mon Sep 17 00:00:00 2001
From: "Jakob.Meier" <meierj@irs.uni-stuttgart.de>
Date: Mon, 26 Apr 2021 14:25:23 +0200
Subject: [PATCH] self test wip

---
 mission/devices/IMTQHandler.cpp                            | 5 +++++
 mission/devices/IMTQHandler.h                              | 1 +
 mission/devices/devicedefinitions/IMTQHandlerDefinitions.h | 1 +
 3 files changed, 7 insertions(+)

diff --git a/mission/devices/IMTQHandler.cpp b/mission/devices/IMTQHandler.cpp
index f3d1880a..0e92a6c1 100644
--- a/mission/devices/IMTQHandler.cpp
+++ b/mission/devices/IMTQHandler.cpp
@@ -21,6 +21,7 @@ void IMTQHandler::doStartUp(){
 	if(mode == _MODE_START_UP){
 	    //TODO: Set to MODE_ON again
 		setMode(MODE_NORMAL);
+		communicationStep = CommunicationStep::SELT_TEST;
 	}
 }
 
@@ -31,6 +32,10 @@ void IMTQHandler::doShutDown(){
 ReturnValue_t IMTQHandler::buildNormalDeviceCommand(
 		DeviceCommandId_t * id) {
     switch (communicationStep) {
+    case CommunicationStep::SELF_TEST:
+        *id = IMTQ::SELF_TEST;
+        communicationStep = CommunicationStep::GET_ENG_HK_DATA;
+        break;
     case CommunicationStep::GET_ENG_HK_DATA:
         *id = IMTQ::GET_ENG_HK_DATA;
         communicationStep = CommunicationStep::START_MTM_MEASUREMENT;
diff --git a/mission/devices/IMTQHandler.h b/mission/devices/IMTQHandler.h
index be680560..e162c1c6 100644
--- a/mission/devices/IMTQHandler.h
+++ b/mission/devices/IMTQHandler.h
@@ -58,6 +58,7 @@ private:
 	uint8_t commandBuffer[IMTQ::MAX_COMMAND_SIZE];
 
 	enum class CommunicationStep {
+	    SELF_TEST,
         GET_ENG_HK_DATA,
         START_MTM_MEASUREMENT,
         GET_CAL_MTM_MEASUREMENT,
diff --git a/mission/devices/devicedefinitions/IMTQHandlerDefinitions.h b/mission/devices/devicedefinitions/IMTQHandlerDefinitions.h
index 23b5982a..0cbbb04e 100644
--- a/mission/devices/devicedefinitions/IMTQHandlerDefinitions.h
+++ b/mission/devices/devicedefinitions/IMTQHandlerDefinitions.h
@@ -13,6 +13,7 @@ namespace IMTQ {
 	static const DeviceCommandId_t GET_CAL_MTM_MEASUREMENT = 0x5;
 	/** Requests the raw values measured by the built-in MTM XEN1210 */
 	static const DeviceCommandId_t GET_RAW_MTM_MEASUREMENT = 0x6;
+	static const DeviceCommandId_t SELF_TEST = 0x7;
 
 	static const uint8_t GET_TEMP_REPLY_SIZE = 2;
 	static const uint8_t CFGR_CMD_SIZE = 3;