diff --git a/mission/devices/RwHandler.cpp b/mission/devices/RwHandler.cpp index 83a136b8..7d84bfcf 100644 --- a/mission/devices/RwHandler.cpp +++ b/mission/devices/RwHandler.cpp @@ -42,13 +42,17 @@ void RwHandler::doShutDown() { ReturnValue_t RwHandler::buildNormalDeviceCommand(DeviceCommandId_t * id) { switch (communicationStep) { + case CommunicationStep::GET_RESET_STATUS: + *id = RwDefinitions::GET_LAST_RESET_STATUS; + communicationStep = CommunicationStep::READ_TEMPERATURE; + break; case CommunicationStep::READ_TEMPERATURE: *id = RwDefinitions::GET_TEMPERATURE; communicationStep = CommunicationStep::GET_RW_SATUS; break; case CommunicationStep::GET_RW_SATUS: *id = RwDefinitions::GET_RW_STATUS; - communicationStep = CommunicationStep::READ_TEMPERATURE; + communicationStep = CommunicationStep::GET_RESET_STATUS; break; default: sif::debug << "RwHandler::buildNormalDeviceCommand: Invalid communication step" diff --git a/mission/devices/RwHandler.h b/mission/devices/RwHandler.h index 29a2ae52..9521034c 100644 --- a/mission/devices/RwHandler.h +++ b/mission/devices/RwHandler.h @@ -90,6 +90,7 @@ private: uint8_t commandBuffer[RwDefinitions::MAX_CMD_SIZE]; enum class CommunicationStep { + GET_RESET_STATUS, READ_TEMPERATURE, GET_RW_SATUS };