From 6a1611686ddfedb629edba90ebfcd72d6487274f Mon Sep 17 00:00:00 2001 From: "Jakob.Meier" Date: Thu, 27 May 2021 13:34:28 +0200 Subject: [PATCH 01/26] fixed include names --- bsp_q7s/ObjectFactory.cpp | 35 ++++++++++++++++---------------- bsp_q7s/boardconfig/q7s_config.h | 2 +- fsfw | 2 +- fsfw_hal | 2 +- mission/devices/SusHandler.h | 1 - 5 files changed, 20 insertions(+), 22 deletions(-) diff --git a/bsp_q7s/ObjectFactory.cpp b/bsp_q7s/ObjectFactory.cpp index 297f8167..4aa76df5 100644 --- a/bsp_q7s/ObjectFactory.cpp +++ b/bsp_q7s/ObjectFactory.cpp @@ -400,54 +400,53 @@ void ObjectFactory::produce(){ #if Q7S_ADD_RTD_DEVICES == 1 GpioCookie* rtdGpioCookie = new GpioCookie; - gpioCallbacks::initTcsBoardDecoder(gpioComIF); GpioCallback* gpioRtdIc3 = new GpioCallback(std::string("Chip select RTD IC3"), gpio::OUT, 1, - &gpioCallbacks::tcsBoardDecoderCallback, gpioComIF); + &gpioCallbacks::spiCsDecoderCallback, gpioComIF); rtdGpioCookie->addGpio(gpioIds::RTD_IC3, gpioRtdIc3); GpioCallback* gpioRtdIc4 = new GpioCallback(std::string("Chip select RTD IC4"), gpio::OUT, 1, - &gpioCallbacks::tcsBoardDecoderCallback, gpioComIF); + &gpioCallbacks::spiCsDecoderCallback, gpioComIF); rtdGpioCookie->addGpio(gpioIds::RTD_IC4, gpioRtdIc4); GpioCallback* gpioRtdIc5 = new GpioCallback(std::string("Chip select RTD IC5"), gpio::OUT, 1, - &gpioCallbacks::tcsBoardDecoderCallback, gpioComIF); + &gpioCallbacks::spiCsDecoderCallback, gpioComIF); rtdGpioCookie->addGpio(gpioIds::RTD_IC5, gpioRtdIc5); GpioCallback* gpioRtdIc6 = new GpioCallback(std::string("Chip select RTD IC6"), gpio::OUT, 1, - &gpioCallbacks::tcsBoardDecoderCallback, gpioComIF); + &gpioCallbacks::spiCsDecoderCallback, gpioComIF); rtdGpioCookie->addGpio(gpioIds::RTD_IC6, gpioRtdIc6); GpioCallback* gpioRtdIc7 = new GpioCallback(std::string("Chip select RTD IC7"), gpio::OUT, 1, - &gpioCallbacks::tcsBoardDecoderCallback, gpioComIF); + &gpioCallbacks::spiCsDecoderCallback, gpioComIF); rtdGpioCookie->addGpio(gpioIds::RTD_IC7, gpioRtdIc7); GpioCallback* gpioRtdIc8 = new GpioCallback(std::string("Chip select RTD IC8"), gpio::OUT, 1, - &gpioCallbacks::tcsBoardDecoderCallback, gpioComIF); + &gpioCallbacks::spiCsDecoderCallback, gpioComIF); rtdGpioCookie->addGpio(gpioIds::RTD_IC8, gpioRtdIc8); GpioCallback* gpioRtdIc9 = new GpioCallback(std::string("Chip select RTD IC9"), gpio::OUT, 1, - &gpioCallbacks::tcsBoardDecoderCallback, gpioComIF); + &gpioCallbacks::spiCsDecoderCallback, gpioComIF); rtdGpioCookie->addGpio(gpioIds::RTD_IC9, gpioRtdIc9); GpioCallback* gpioRtdIc10 = new GpioCallback(std::string("Chip select RTD IC10"), gpio::OUT, 1, - &gpioCallbacks::tcsBoardDecoderCallback, gpioComIF); + &gpioCallbacks::spiCsDecoderCallback, gpioComIF); rtdGpioCookie->addGpio(gpioIds::RTD_IC10, gpioRtdIc10); GpioCallback* gpioRtdIc11 = new GpioCallback(std::string("Chip select RTD IC11"), gpio::OUT, 1, - &gpioCallbacks::tcsBoardDecoderCallback, gpioComIF); + &gpioCallbacks::spiCsDecoderCallback, gpioComIF); rtdGpioCookie->addGpio(gpioIds::RTD_IC11, gpioRtdIc11); GpioCallback* gpioRtdIc12 = new GpioCallback(std::string("Chip select RTD IC12"), gpio::OUT, 1, - &gpioCallbacks::tcsBoardDecoderCallback, gpioComIF); + &gpioCallbacks::spiCsDecoderCallback, gpioComIF); rtdGpioCookie->addGpio(gpioIds::RTD_IC12, gpioRtdIc12); GpioCallback* gpioRtdIc13 = new GpioCallback(std::string("Chip select RTD IC13"), gpio::OUT, 1, - &gpioCallbacks::tcsBoardDecoderCallback, gpioComIF); + &gpioCallbacks::spiCsDecoderCallback, gpioComIF); rtdGpioCookie->addGpio(gpioIds::RTD_IC13, gpioRtdIc13); GpioCallback* gpioRtdIc14 = new GpioCallback(std::string("Chip select RTD IC14"), gpio::OUT, 1, - &gpioCallbacks::tcsBoardDecoderCallback, gpioComIF); + &gpioCallbacks::spiCsDecoderCallback, gpioComIF); rtdGpioCookie->addGpio(gpioIds::RTD_IC14, gpioRtdIc14); GpioCallback* gpioRtdIc15 = new GpioCallback(std::string("Chip select RTD IC15"), gpio::OUT, 1, - &gpioCallbacks::tcsBoardDecoderCallback, gpioComIF); + &gpioCallbacks::spiCsDecoderCallback, gpioComIF); rtdGpioCookie->addGpio(gpioIds::RTD_IC15, gpioRtdIc15); GpioCallback* gpioRtdIc16 = new GpioCallback(std::string("Chip select RTD IC16"), gpio::OUT, 1, - &gpioCallbacks::tcsBoardDecoderCallback, gpioComIF); + &gpioCallbacks::spiCsDecoderCallback, gpioComIF); rtdGpioCookie->addGpio(gpioIds::RTD_IC16, gpioRtdIc16); GpioCallback* gpioRtdIc17 = new GpioCallback(std::string("Chip select RTD IC17"), gpio::OUT, 1, - &gpioCallbacks::tcsBoardDecoderCallback, gpioComIF); + &gpioCallbacks::spiCsDecoderCallback, gpioComIF); rtdGpioCookie->addGpio(gpioIds::RTD_IC17, gpioRtdIc17); GpioCallback* gpioRtdIc18 = new GpioCallback(std::string("Chip select RTD IC18"), gpio::OUT, 1, - &gpioCallbacks::tcsBoardDecoderCallback, gpioComIF); + &gpioCallbacks::spiCsDecoderCallback, gpioComIF); rtdGpioCookie->addGpio(gpioIds::RTD_IC18, gpioRtdIc18); gpioComIF->addGpios(rtdGpioCookie); @@ -517,7 +516,7 @@ void ObjectFactory::produce(){ Max31865PT1000Handler* rtdIc16 = new Max31865PT1000Handler(objects::RTD_IC16, objects::SPI_COM_IF, spiRtdIc16, 0); Max31865PT1000Handler* rtdIc17 = new Max31865PT1000Handler(objects::RTD_IC17, objects::SPI_COM_IF, spiRtdIc17, 0); Max31865PT1000Handler* rtdIc18 = new Max31865PT1000Handler(objects::RTD_IC18, objects::SPI_COM_IF, spiRtdIc18, 0); -// rtdIc10->setStartUpImmediately(); + rtdIc3->setStartUpImmediately(); // rtdIc4->setStartUpImmediately(); (void) rtdIc3; diff --git a/bsp_q7s/boardconfig/q7s_config.h b/bsp_q7s/boardconfig/q7s_config.h index 782ecf4f..73cf2225 100644 --- a/bsp_q7s/boardconfig/q7s_config.h +++ b/bsp_q7s/boardconfig/q7s_config.h @@ -1,7 +1,7 @@ #ifndef BSP_Q7S_BOARDCONFIG_Q7S_CONFIG_H_ #define BSP_Q7S_BOARDCONFIG_Q7S_CONFIG_H_ -#define Q7S_ADD_RTD_DEVICES 0 +#define Q7S_ADD_RTD_DEVICES 1 /* Only one of those 2 should be enabled! */ /* Add code for ACS board */ diff --git a/fsfw b/fsfw index e7d24563..32b289cb 160000 --- a/fsfw +++ b/fsfw @@ -1 +1 @@ -Subproject commit e7d245635047439ca4b5a46d05bf58437a5aa33a +Subproject commit 32b289cbec97e66707a416f3696c804c05d84fb0 diff --git a/fsfw_hal b/fsfw_hal index a0f698ff..7724fdc3 160000 --- a/fsfw_hal +++ b/fsfw_hal @@ -1 +1 @@ -Subproject commit a0f698fffa4dd5c9f86337c5d6170f9321cb8de7 +Subproject commit 7724fdc389c48fc3c52ba94c7c7d9fe4530f1996 diff --git a/mission/devices/SusHandler.h b/mission/devices/SusHandler.h index c73cee97..3829f14e 100644 --- a/mission/devices/SusHandler.h +++ b/mission/devices/SusHandler.h @@ -4,7 +4,6 @@ #include #include #include -#include /** * @brief This is the device handler class for the SUS sensor. The sensor is From 33a55d7114ca22d3b89db36bf0706dcb6d29daf8 Mon Sep 17 00:00:00 2001 From: "Jakob.Meier" Date: Mon, 21 Jun 2021 09:50:26 +0200 Subject: [PATCH 02/26] RwHandler first commands --- bsp_q7s/CMakeLists.txt | 1 + bsp_q7s/ObjectFactory.cpp | 14 +- bsp_q7s/spiCallbacks/CMakeLists.txt | 3 + bsp_q7s/spiCallbacks/rwSpiCallback.cpp | 220 +++++++++++++++ bsp_q7s/spiCallbacks/rwSpiCallback.h | 21 ++ common/config/commonClassIds.h | 1 + common/config/commonSubsystemIds.h | 1 + common/config/spiConf.h | 3 + linux/fsfwconfig/devices/addresses.h | 6 +- linux/fsfwconfig/devices/gpioIds.h | 7 +- linux/fsfwconfig/objects/systemObjectList.h | 5 + mission/devices/CMakeLists.txt | 1 + mission/devices/RwHandler.cpp | 259 ++++++++++++++++++ mission/devices/RwHandler.h | 125 +++++++++ .../devicedefinitions/Max31865Definitions.h | 6 +- .../devices/devicedefinitions/RwDefinitions.h | 86 ++++++ 16 files changed, 750 insertions(+), 9 deletions(-) create mode 100644 bsp_q7s/spiCallbacks/CMakeLists.txt create mode 100644 bsp_q7s/spiCallbacks/rwSpiCallback.cpp create mode 100644 bsp_q7s/spiCallbacks/rwSpiCallback.h create mode 100644 mission/devices/RwHandler.cpp create mode 100644 mission/devices/RwHandler.h create mode 100644 mission/devices/devicedefinitions/RwDefinitions.h diff --git a/bsp_q7s/CMakeLists.txt b/bsp_q7s/CMakeLists.txt index ce790656..c0547997 100644 --- a/bsp_q7s/CMakeLists.txt +++ b/bsp_q7s/CMakeLists.txt @@ -9,3 +9,4 @@ add_subdirectory(comIF) add_subdirectory(boardtest) add_subdirectory(gpio) add_subdirectory(core) +add_subdirectory(spiCallbacks) diff --git a/bsp_q7s/ObjectFactory.cpp b/bsp_q7s/ObjectFactory.cpp index a977c91b..8c9dc91a 100644 --- a/bsp_q7s/ObjectFactory.cpp +++ b/bsp_q7s/ObjectFactory.cpp @@ -9,6 +9,7 @@ #include "bsp_q7s/gpio/gpioCallbacks.h" #include "bsp_q7s/core/CoreController.h" +#include "bsp_q7s/spiCallbacks/rwSpiCallback.h" #include #include @@ -31,11 +32,13 @@ #include #include #include +#include #include #include #include #include #include +#include #include #include @@ -545,10 +548,13 @@ void ObjectFactory::produce(void* args){ UartCookie* plocUartCookie = new UartCookie(std::string("/dev/ttyUL3"), 115200, PLOC::MAX_REPLY_SIZE); - PlocHandler* plocHandler = new PlocHandler(objects::PLOC_HANDLER, objects::UART_COM_IF, - plocUartCookie); -// plocHandler->setStartUpImmediately(); - (void) plocHandler; + PlocHandler(objects::PLOC_HANDLER, objects::UART_COM_IF, plocUartCookie); + + auto rw1SpiCookie = new SpiCookie(addresses::RW1, gpioIds::RW1, "/dev/spidev2.0", + RwDefinitions::MAX_REPLY_SIZE, spi::RW_MODE, spi::RW_SPEED, &rwSpiCallback, nullptr); + + auto rwHandler1 = new RwHandler(objects::RW1, objects::SPI_COM_IF, rw1SpiCookie); + rwHandler1->setStartUpImmediately(); #endif /* TE0720 == 0 */ diff --git a/bsp_q7s/spiCallbacks/CMakeLists.txt b/bsp_q7s/spiCallbacks/CMakeLists.txt new file mode 100644 index 00000000..59d507e6 --- /dev/null +++ b/bsp_q7s/spiCallbacks/CMakeLists.txt @@ -0,0 +1,3 @@ +target_sources(${TARGET_NAME} PRIVATE + rwSpiCallback.cpp +) diff --git a/bsp_q7s/spiCallbacks/rwSpiCallback.cpp b/bsp_q7s/spiCallbacks/rwSpiCallback.cpp new file mode 100644 index 00000000..fc9bade1 --- /dev/null +++ b/bsp_q7s/spiCallbacks/rwSpiCallback.cpp @@ -0,0 +1,220 @@ +#include +#include +#include +#include +#include + +ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *sendData, + size_t sendLen, void* args) { + + ReturnValue_t result = HasReturnvaluesIF::RETURN_OK; + + RwHandler* handler = reinterpret_cast(args); + if(handler == nullptr) { + sif::error << "rwSpiCallback: Pointer to handler is invalid" + << std::endl; + return HasReturnvaluesIF::RETURN_FAILED; + } + + uint8_t writeBuffer[2]; + uint8_t writeSize = 0; + + int fileDescriptor = 0; + std::string device = cookie->getSpiDevice(); + UnixFileGuard fileHelper(device, &fileDescriptor, O_RDWR, "rwSpiCallback: "); + if(fileHelper.getOpenResult() != HasReturnvaluesIF::RETURN_OK) { + sif::error << "rwSpiCallback: Failed to open device file" << std::endl; + return SpiComIF::OPENING_FILE_FAILED; + } + spi::SpiModes spiMode = spi::SpiModes::MODE_0; + uint32_t spiSpeed = 0; + cookie->getSpiParameters(spiMode, spiSpeed, nullptr); + comIf->setSpiSpeedAndMode(fileDescriptor, spiMode, spiSpeed); + + gpioId_t gpioId = cookie->getChipSelectPin(); + GpioIF* gpioIF = comIf->getGpioInterface(); + MutexIF::TimeoutType timeoutType = MutexIF::TimeoutType::WAITING; + uint32_t timeoutMs = 0; + MutexIF* mutex = comIf->getMutex(&timeoutType, &timeoutMs); + if(mutex == nullptr or gpioIF == nullptr) { + sif::debug << "rwSpiCallback: Mutex or GPIO interface invalid" << std::endl; + return HasReturnvaluesIF::RETURN_FAILED; + } + + if(gpioId != gpio::NO_GPIO) { + result = mutex->lockMutex(timeoutType, timeoutMs); + if (result != HasReturnvaluesIF::RETURN_OK) { + sif::debug << "rwSpiCallback: Failed to lock mutex" << std::endl; + return result; + } + } + + /** Sending frame start sign */ + writeBuffer[0] = 0x7E; + writeSize = 1; + + // Pull SPI CS low. For now, no support for active high given + if(gpioId != gpio::NO_GPIO) { + if(gpioIF->pullLow(gpioId) != HasReturnvaluesIF::RETURN_OK) { + sif::error << "rwSpiCallback: Failed to pull chip select low" << std::endl; + } + } + + if (write(fileDescriptor, writeBuffer, writeSize) != static_cast(writeSize)) { + sif::error << "rwSpiCallback: Write failed!" << std::endl; + if(gpioId != gpio::NO_GPIO) { + if (gpioIF->pullHigh(gpioId) != HasReturnvaluesIF::RETURN_OK) { + sif::error << "rwSpiCallback: Failed to pull chip select high" << std::endl; + } + } + if(mutex->unlockMutex() != HasReturnvaluesIF::RETURN_OK) { + sif::error << "rwSpiCallback: Failed to unlock mutex" << std::endl;; + } + return RwHandler::SPI_WRITE_FAILURE; + } + + /** Encoding and sending command */ + size_t idx = 0; + while(idx < sendLen) { + switch(*(sendData + idx)) { + case 0x7E: + writeBuffer[0] = 0x7D; + writeBuffer[1] = 0x5E; + writeSize = 2; + break; + case 0x7D: + writeBuffer[0] = 0x7D; + writeBuffer[1] = 0x5D; + writeSize = 2; + break; + default: + writeBuffer[0] = *(sendData + idx); + writeSize = 1; + } + if (write(fileDescriptor, writeBuffer, writeSize) != static_cast(writeSize)) { + sif::error << "rwSpiCallback: Write failed!" << std::endl; + if(gpioId != gpio::NO_GPIO) { + if (gpioIF->pullHigh(gpioId) != HasReturnvaluesIF::RETURN_OK) { + sif::error << "rwSpiCallback: Failed to pull chip select high" << std::endl; + } + } + if(mutex->unlockMutex() != HasReturnvaluesIF::RETURN_OK) { + sif::error << "rwSpiCallback: Failed to unlock mutex"; + } + return RwHandler::SPI_WRITE_FAILURE; + } + } + + /** Sending frame start sign */ + writeBuffer[0] = 0x7E; + writeSize = 1; + + if (write(fileDescriptor, writeBuffer, writeSize) != static_cast(writeSize)) { + sif::error << "rwSpiCallback: Write failed!" << std::endl; + if(gpioId != gpio::NO_GPIO) { + if (gpioIF->pullHigh(gpioId) != HasReturnvaluesIF::RETURN_OK) { + sif::error << "rwSpiCallback: Failed to pull chip select high" << std::endl; + } + } + if(mutex->unlockMutex() != HasReturnvaluesIF::RETURN_OK) { + sif::error << "rwSpiCallback: Failed to unlock mutex"; + } + return RwHandler::SPI_WRITE_FAILURE; + } + + uint8_t* rxBuf = nullptr; + result = comIf->getReadBuffer(cookie->getSpiAddress(), &rxBuf); + if(result != HasReturnvaluesIF::RETURN_OK) { + return result; + } + + size_t replyBufferSize = cookie->getMaxBufferSize(); + + uint8_t byteRead = 0; + /** Reading the reply frame */ + if(read(fileDescriptor, &byteRead, 1) != 1) { + sif::error << "rwSpiCallback: Failed to read first byte of reply frame" << std::endl; + return RwHandler::SPI_READ_FAILURE; + } + + /** First byte must be the start sign 0x7E */ + if (byteRead != 0x7E) { + sif::error << "rwSpiCallback: First byte of reply is not 0x7E" << std::endl; + return RwHandler::MISSING_START_SIGN; + } + + size_t decodedFrameLen = 0; + for (; decodedFrameLen < replyBufferSize; decodedFrameLen++) { + if(read(fileDescriptor, &byteRead, 1) != 1) { + sif::error << "rwSpiCallback: Read failed" << std::endl; + return RwHandler::SPI_READ_FAILURE; + } + + if (byteRead == 0x7E) { + /** Reached end of frame */ + break; + } + else if (byteRead == 0xD) { + if(read(fileDescriptor, &byteRead, 1) != 1) { + sif::error << "rwSpiCallback: Read failed" << std::endl; + result = RwHandler::SPI_READ_FAILURE; + break; + } + if (byteRead == 0x5E) { + *(rxBuf + decodedFrameLen) = 0x7E; + decodedFrameLen++; + continue; + } + else if (byteRead == 0x5D) { + *(rxBuf + decodedFrameLen) = 0x7D; + decodedFrameLen++; + continue; + } + else { + sif::error << "rwSpiCallback: Invalid substitute" << std::endl; + result = RwHandler::INVALID_SUBSTITUTE; + break; + } + } + else { + *(rxBuf + decodedFrameLen) = byteRead; + decodedFrameLen++; + continue; + } + + /** + * There might be the unlikely case that each byte in a get-telemetry reply has been + * replaced by its substitute. Than the next byte must correspond to the end sign 0x7E. + * Otherwise there might be something wrong. + */ + if (decodedFrameLen == replyBufferSize) { + if(read(fileDescriptor, &byteRead, 1) != 1) { + sif::error << "rwSpiCallback: Failed to read last byte" << std::endl; + result = RwHandler::SPI_READ_FAILURE; + break; + } + if (byteRead != 0x7E) { + sif::error << "rwSpiCallback: Missing end sign 0x7E" << std::endl; + decodedFrameLen--; + result = RwHandler::MISSING_END_SIGN; + break; + } + } + result = HasReturnvaluesIF::RETURN_OK; + } + + cookie->assignTransferSize(decodedFrameLen); + + if(gpioId != gpio::NO_GPIO) { + if (gpioIF->pullHigh(gpioId) != HasReturnvaluesIF::RETURN_OK) { + sif::error << "rwSpiCallback: Failed to pull chip select high" << std::endl; + } + } + + if(gpioId != gpio::NO_GPIO) { + if(mutex->unlockMutex() != HasReturnvaluesIF::RETURN_OK) { + sif::error << "rwSpiCallback: Failed to unlock mutex" << std::endl; + } + } + return result; +} diff --git a/bsp_q7s/spiCallbacks/rwSpiCallback.h b/bsp_q7s/spiCallbacks/rwSpiCallback.h new file mode 100644 index 00000000..d882bee4 --- /dev/null +++ b/bsp_q7s/spiCallbacks/rwSpiCallback.h @@ -0,0 +1,21 @@ +#ifndef BSP_Q7S_RW_SPI_CALLBACK_H_ +#define BSP_Q7S_RW_SPI_CALLBACK_H_ + +#include +#include + +/** + * @brief This is the callback function to send commands to the nano avionics reaction wheels and + * receive the replies. + * + * @details The data to sent are additionally encoded according to the HDLC framing defined in the + * datasheet of the reaction wheels: + * https://eive-cloud.irs.uni-stuttgart.de/index.php/apps/files/?dir=/EIVE_IRS/ + * Arbeitsdaten/08_Used%20Components/Nanoavionics_Reactionwheels&fileid=181622 + * Each command entails exactly one reply which will also be read in and decoded by this + * function. + */ +ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *sendData, + size_t sendLen, void* args); + +#endif /* BSP_Q7S_RW_SPI_CALLBACK_H_ */ diff --git a/common/config/commonClassIds.h b/common/config/commonClassIds.h index 7a53bdf0..8a4a8121 100644 --- a/common/config/commonClassIds.h +++ b/common/config/commonClassIds.h @@ -13,6 +13,7 @@ enum commonClassIds: uint8_t { HEATER_HANDLER, //HEATER SYRLINKS_HANDLER, //SYRLINKS IMTQ_HANDLER, //IMTQ + RW_HANDLER, //Reaction Wheels PLOC_HANDLER, //PLOC SUS_HANDLER, //SUSS CCSDS_IP_CORE_BRIDGE, // IP Core interface diff --git a/common/config/commonSubsystemIds.h b/common/config/commonSubsystemIds.h index 0bc3e1dd..bc2fe400 100644 --- a/common/config/commonSubsystemIds.h +++ b/common/config/commonSubsystemIds.h @@ -13,6 +13,7 @@ enum: uint8_t { SA_DEPL_HANDLER = 110, PLOC_HANDLER = 111, IMTQ_HANDLER = 112, + RW_HANDLER = 113, COMMON_SUBSYSTEM_ID_END }; } diff --git a/common/config/spiConf.h b/common/config/spiConf.h index 2632924d..d76ac9b8 100644 --- a/common/config/spiConf.h +++ b/common/config/spiConf.h @@ -26,6 +26,9 @@ static constexpr spi::SpiModes DEFAULT_MAX_1227_MODE = spi::SpiModes::MODE_3; static constexpr uint32_t DEFAULT_ADIS16507_SPEED = 976'000; static constexpr spi::SpiModes DEFAULT_ADIS16507_MODE = spi::SpiModes::MODE_3; +static constexpr uint32_t RW_SPEED = 300'000; +static constexpr spi::SpiModes RW_MODE = spi::SpiModes::MODE_0; + } #endif /* COMMON_CONFIG_SPICONF_H_ */ diff --git a/linux/fsfwconfig/devices/addresses.h b/linux/fsfwconfig/devices/addresses.h index 0deb8490..e4dc4979 100644 --- a/linux/fsfwconfig/devices/addresses.h +++ b/linux/fsfwconfig/devices/addresses.h @@ -63,7 +63,11 @@ namespace addresses { RTD_IC15, RTD_IC16, RTD_IC17, - RTD_IC18 + RTD_IC18, + RW1, + RW2, + RW3, + RW4 }; /* Addresses of devices supporting the CSP protocol */ diff --git a/linux/fsfwconfig/devices/gpioIds.h b/linux/fsfwconfig/devices/gpioIds.h index 102b04b9..39d1b8ce 100644 --- a/linux/fsfwconfig/devices/gpioIds.h +++ b/linux/fsfwconfig/devices/gpioIds.h @@ -68,7 +68,12 @@ namespace gpioIds { CS_RAD_SENSOR, PAPB_BUSY_N, - PAPB_EMPTY + PAPB_EMPTY, + + RW1, + RW2, + RW3, + RW4 }; } diff --git a/linux/fsfwconfig/objects/systemObjectList.h b/linux/fsfwconfig/objects/systemObjectList.h index 98d6c448..bda929a5 100644 --- a/linux/fsfwconfig/objects/systemObjectList.h +++ b/linux/fsfwconfig/objects/systemObjectList.h @@ -58,6 +58,11 @@ namespace objects { RAD_SENSOR = 0x54000050, + RW1 = 0x54000051, + RW2 = 0x54000052, + RW3 = 0x54000053, + RW4 = 0x54000054, + /* 0x54 ('T') for test handlers */ TEST_TASK = 0x54694269, LIBGPIOD_TEST = 0x54123456, diff --git a/mission/devices/CMakeLists.txt b/mission/devices/CMakeLists.txt index 735e595b..544bbd14 100644 --- a/mission/devices/CMakeLists.txt +++ b/mission/devices/CMakeLists.txt @@ -16,6 +16,7 @@ target_sources(${TARGET_NAME} PUBLIC PlocHandler.cpp RadiationSensorHandler.cpp GyroADIS16507Handler.cpp + RwHandler.cpp ) diff --git a/mission/devices/RwHandler.cpp b/mission/devices/RwHandler.cpp new file mode 100644 index 00000000..9f6d483b --- /dev/null +++ b/mission/devices/RwHandler.cpp @@ -0,0 +1,259 @@ +#include "RwHandler.h" +#include "OBSWConfig.h" + +#include +#include +#include + +RwHandler::RwHandler(object_id_t objectId, object_id_t comIF, CookieIF * comCookie) : + DeviceHandlerBase(objectId, comIF, comCookie), temperatureSet(this), statusSet(this) { + if (comCookie == NULL) { + sif::error << "RwHandler: Invalid com cookie" << std::endl; + } +} + +RwHandler::~RwHandler() { +} + +void RwHandler::doStartUp() { +#if OBSW_SWITCH_TO_NORMAL_MODE_AFTER_STARTUP == 1 + setMode(MODE_NORMAL); +#else + setMode(_MODE_TO_ON); +#endif +} + +void RwHandler::doShutDown() { + +} + +ReturnValue_t RwHandler::buildNormalDeviceCommand(DeviceCommandId_t * id) { + switch (communicationStep) { + case CommunicationStep::READ_TEMPERATURE: + *id = RwDefinitions::GET_TEMPERATURE; + break; + case CommunicationStep::GET_RW_SATUS: + *id = RwDefinitions::GET_RW_STATUS; + break; + default: + sif::debug << "RwHandler::buildNormalDeviceCommand: Invalid communication step" + << std::endl; + break; + } + return buildCommandFromCommand(*id, NULL, 0); +} + +ReturnValue_t RwHandler::buildTransitionDeviceCommand(DeviceCommandId_t * id) { + return RETURN_OK; +} + +ReturnValue_t RwHandler::buildCommandFromCommand(DeviceCommandId_t deviceCommand, + const uint8_t * commandData, size_t commandDataLen) { + ReturnValue_t result = RETURN_OK; + + switch (deviceCommand) { + case (RwDefinitions::GET_RW_STATUS): { + prepareGetStatusCmd(commandData, commandDataLen); + return RETURN_OK; + } + case (RwDefinitions::SET_SPEED): { + if (commandDataLen != 6) { + sif::error << "RwHandler::buildCommandFromCommand: Received set speed command with" + << " invalid length" << std::endl; + return SET_SPEED_COMMAND_INVALID_LENGTH; + } + result = checkSpeedAndRampTime(commandData, commandDataLen); + if (result != RETURN_OK) { + return result; + } + prepareSetSpeedCmd(commandData, commandDataLen); + return result; + } + case (RwDefinitions::GET_TEMPERATURE): { + prepareGetTemperatureCmd(); + return RETURN_OK; + } + default: + return DeviceHandlerIF::COMMAND_NOT_IMPLEMENTED; + } + return HasReturnvaluesIF::RETURN_FAILED; +} + +void RwHandler::fillCommandAndReplyMap() { + this->insertInCommandAndReplyMap(RwDefinitions::GET_TEMPERATURE, 1, &temperatureSet, + RwDefinitions::SIZE_GET_TEMPERATURE_REPLY); + this->insertInCommandAndReplyMap(RwDefinitions::SET_SPEED, 1, nullptr, + RwDefinitions::SIZE_SET_SPEED_REPLY); +} + +ReturnValue_t RwHandler::scanForReply(const uint8_t *start, size_t remainingSize, + DeviceCommandId_t *foundId, size_t *foundLen) { + + switch (*(start + 1)) { + case (static_cast(RwDefinitions::GET_RW_STATUS)): { + *foundLen = RwDefinitions::SIZE_GET_RW_STATUS; + *foundId = RwDefinitions::GET_RW_STATUS; + break; + } + case (static_cast(RwDefinitions::SET_SPEED)): { + *foundLen = RwDefinitions::SIZE_SET_SPEED_REPLY; + *foundId = RwDefinitions::SET_SPEED; + break; + } + case (static_cast(RwDefinitions::GET_TEMPERATURE)): { + *foundLen = RwDefinitions::SIZE_GET_TEMPERATURE_REPLY; + *foundId = RwDefinitions::GET_TEMPERATURE; + break; + } + default: { + sif::debug << "RwHandler::scanForReply: Reply contains invalid command code" << std::endl; + return RETURN_FAILED; + break; + } + } + + sizeOfReply = *foundLen; + + return RETURN_OK; +} + +ReturnValue_t RwHandler::interpretDeviceReply(DeviceCommandId_t id, const uint8_t *packet) { + + /** Check result code */ + if (*(packet + 1) != 0) { + return EXECUTION_FAILED; + } + + /** Received in little endian byte order */ + uint16_t replyCrc = *(packet + sizeOfReply - 1) << 8 | *(packet + sizeOfReply - 2) ; + + if (CRC::crc16ccitt(packet, sizeOfReply, 0xFFFF) != replyCrc) { + return CRC_ERROR; + } + + switch (id) { + case (RwDefinitions::GET_RW_STATUS): { + handleGetRwStatusReply(packet); + break; + } + case (RwDefinitions::SET_SPEED): + // no reply data expected + break; + case (RwDefinitions::GET_TEMPERATURE): { + handleTemperatureReply(packet); + break; + } + default: { + sif::debug << "RwHandler::interpretDeviceReply: Unknown device reply id" << std::endl; + return DeviceHandlerIF::UNKNOWN_DEVICE_REPLY; + } + } + + return RETURN_OK; +} + +void RwHandler::setNormalDatapoolEntriesInvalid() { + +} + +uint32_t RwHandler::getTransitionDelayMs(Mode_t modeFrom, Mode_t modeTo) { + return 5000; +} + +ReturnValue_t RwHandler::initializeLocalDataPool(localpool::DataPool& localDataPoolMap, + LocalDataPoolManager& poolManager) { + + localDataPoolMap.emplace(RwDefinitions::TEMPERATURE_C, new PoolEntry( { 0 })); + + return RETURN_OK; +} + +void RwHandler::prepareGetStatusCmd(const uint8_t * commandData, size_t commandDataLen) { + commandBuffer[0] = static_cast(RwDefinitions::GET_RW_STATUS); + + uint16_t crc = CRC::crc16ccitt(commandBuffer, 1, 0xFFFF); + commandBuffer[1] = static_cast(crc & 0xFF); + commandBuffer[2] = static_cast(crc >> 8 & 0xFF); + rawPacket = commandBuffer; + rawPacketLen = 3; +} + +ReturnValue_t RwHandler::checkSpeedAndRampTime(const uint8_t* commandData, size_t commandDataLen) { + int32_t speed = *commandData << 24 | *(commandData + 1) << 16 | *(commandData + 2) << 8 + | *(commandData + 3); + + if (speed < -65000 || speed > 65000 || (speed > -1000 && speed < 1000)) { + sif::error << "RwHandler::checkSpeedAndRampTime: Command has invalid speed" << std::endl; + return INVALID_SPEED; + } + + uint16_t rampTime = *commandData << 8 | *(commandData + 1); + + if (rampTime < 10 || rampTime > 10000) { + sif::error << "RwHandler::checkSpeedAndRampTime: Command has invalid ramp time" + << std::endl; + return INVALID_RAMP_TIME; + } + + return RETURN_OK; +} + +void RwHandler::prepareGetTemperatureCmd() { + commandBuffer[0] = static_cast(RwDefinitions::GET_TEMPERATURE); + uint16_t crc = CRC::crc16ccitt(commandBuffer, 1, 0xFFFF); + commandBuffer[1] = static_cast(crc & 0xFF); + commandBuffer[2] = static_cast(crc >> 8 & 0xFF); + rawPacket = commandBuffer; + rawPacketLen = 3; +} + + +void RwHandler::prepareSetSpeedCmd(const uint8_t * commandData, size_t commandDataLen) { + commandBuffer[0] = static_cast(RwDefinitions::SET_SPEED); + + /** Speed (0.1 RPM) */ + commandBuffer[1] = *(commandData + 3); + commandBuffer[2] = *(commandData + 2); + commandBuffer[3] = *(commandData + 1); + commandBuffer[4] = *commandData; + /** Ramp time (ms) */ + commandBuffer[5] = *(commandData + 1); + commandBuffer[6] = *commandData; + + uint16_t crc = CRC::crc16ccitt(commandBuffer, 7, 0xFFFF); + commandBuffer[7] = static_cast(crc & 0xFF); + commandBuffer[8] = static_cast(crc >> 8 & 0xFF); + rawPacket = commandBuffer; + rawPacketLen = 9; +} + +void RwHandler::handleGetRwStatusReply(const uint8_t* packet) { + uint8_t offset = 0; + statusSet.currSpeed = *(packet + 3) << 24 | *(packet + 2) << 16 | *(packet + 1) << 1 | *packet; + offset += 4; + statusSet.referenceSpeed = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 | *(packet + offset + 1) << 1 | *(packet + offset); + offset += 4; + statusSet.state = *(packet + offset); + offset += 1; + statusSet.clcMode = *(packet + offset); + +#if OBSW_VERBOSE_LEVEL >= 1 && RW_DEBUG == 1 + sif::info << "RwHandler::handleGetRwStatusReply: Current speed is: " << statusSet.currSpeed + << " * 0.1 RPM" << std::endl; + sif::info << "RwHandler::handleGetRwStatusReply: Reference speed is: " + << statusSet.referenceSpeed << " * 0.1 RPM" << std::endl; + sif::info << "RwHandler::handleGetRwStatusReply: State is: " << statusSet.state + << " * 0.1 RPM" << std::endl; + sif::info << "RwHandler::handleGetRwStatusReply: clc mode is: " << statusSet.clcMode + << " * 0.1 RPM" << std::endl; +#endif +} + +void RwHandler::handleTemperatureReply(const uint8_t* packet) { + temperatureSet.temperatureCelcius = *(packet + 3) << 24 | *(packet + 2) << 16 + | *(packet + 1) << 1 | *packet; +#if OBSW_VERBOSE_LEVEL >= 1 && RW_DEBUG == 1 + sif::info << "RwHandler::handleTemperatureReply: Temperature: " + << temperatureSet.temperatureCelcius << " °C" << std::endl; +#endif +} diff --git a/mission/devices/RwHandler.h b/mission/devices/RwHandler.h new file mode 100644 index 00000000..8f77527b --- /dev/null +++ b/mission/devices/RwHandler.h @@ -0,0 +1,125 @@ +#ifndef MISSION_DEVICES_RWHANDLER_H_ +#define MISSION_DEVICES_RWHANDLER_H_ + +#include +#include +#include + +/** + * @brief This is the device handler for the reaction wheel from nano avionics. + * + * @details Datasheet: https://eive-cloud.irs.uni-stuttgart.de/index.php/apps/files/?dir=/EIVE_IRS/ + * Arbeitsdaten/08_Used%20Components/Nanoavionics_Reactionwheels&fileid=181622 + * + * @note Values are transferred in little endian format. + * + * @author J. Meier + */ +class RwHandler: public DeviceHandlerBase { +public: + + RwHandler(object_id_t objectId, object_id_t comIF, CookieIF * comCookie); + virtual ~RwHandler(); + + /** + * @brief Sets mode to MODE_NORMAL. Can be used for debugging. + */ + void setModeNormal(); + + static const uint8_t INTERFACE_ID = CLASS_ID::RW_HANDLER; + + static const ReturnValue_t SPI_WRITE_FAILURE = MAKE_RETURN_CODE(0xB0); + //! [EXPORT] : [COMMENT] Used by the spi send function to tell a failing read call + static const ReturnValue_t SPI_READ_FAILURE = MAKE_RETURN_CODE(0xB1); + //! [EXPORT] : [COMMENT] Can be used by the HDLC decoding mechanism to inform about a missing start sign 0x7E + static const ReturnValue_t MISSING_START_SIGN = MAKE_RETURN_CODE(0xB2); + //! [EXPORT] : [COMMENT] Can be used by the HDLC decoding mechanism to inform about an invalid substitution combination + static const ReturnValue_t INVALID_SUBSTITUTE = MAKE_RETURN_CODE(0xB3); + //! [EXPORT] : [COMMENT] HDLC decoding mechanism never receives the end sign 0x7E + static const ReturnValue_t MISSING_END_SIGN = MAKE_RETURN_CODE(0xB4); + +protected: + void doStartUp() override; + void doShutDown() override; + ReturnValue_t buildNormalDeviceCommand(DeviceCommandId_t * id) override; + ReturnValue_t buildTransitionDeviceCommand(DeviceCommandId_t * id) override; + void fillCommandAndReplyMap() override; + ReturnValue_t buildCommandFromCommand(DeviceCommandId_t deviceCommand, + const uint8_t * commandData,size_t commandDataLen) override; + ReturnValue_t scanForReply(const uint8_t *start, size_t remainingSize, + DeviceCommandId_t *foundId, size_t *foundLen) override; + ReturnValue_t interpretDeviceReply(DeviceCommandId_t id, + const uint8_t *packet) override; + void setNormalDatapoolEntriesInvalid() override; + uint32_t getTransitionDelayMs(Mode_t modeFrom, Mode_t modeTo) override; + ReturnValue_t initializeLocalDataPool(localpool::DataPool& localDataPoolMap, + LocalDataPoolManager& poolManager) override; + +private: + + static const uint8_t SUBSYSTEM_ID = SUBSYSTEM_ID::RW_HANDLER; + + //! [EXPORT] : [COMMENT] Action Message with invalid speed was received. Valid speeds must be in the range of [-65000; 1000] or [1000; 65000] + static const ReturnValue_t INVALID_SPEED = MAKE_RETURN_CODE(0xA0); + //! [EXPORT] : [COMMENT] Action Message with invalid ramp time was received. + static const ReturnValue_t INVALID_RAMP_TIME = MAKE_RETURN_CODE(0xA1); + //! [EXPORT] : [COMMENT] Received set speed command has invalid length. Should be 6. + static const ReturnValue_t SET_SPEED_COMMAND_INVALID_LENGTH = MAKE_RETURN_CODE(0xA2); + //! [EXPORT] : [COMMENT] Command execution failed + static const ReturnValue_t EXECUTION_FAILED = MAKE_RETURN_CODE(0xA3); + //! [EXPORT] : [COMMENT] Reaction wheel reply has invalid crc + static const ReturnValue_t CRC_ERROR = MAKE_RETURN_CODE(0xA4); + + RwDefinitions::TemperatureSet temperatureSet; + RwDefinitions::StatusSet statusSet; + + + uint8_t commandBuffer[RwDefinitions::MAX_CMD_SIZE]; + + enum class CommunicationStep { + READ_TEMPERATURE, + GET_RW_SATUS + }; + + CommunicationStep communicationStep = CommunicationStep::READ_TEMPERATURE; + + size_t sizeOfReply = 0; + + /** + * @brief This function prepares the send buffer with the data to request the status of + * the reaction wheel. + */ + void prepareGetStatusCmd(const uint8_t * commandData, size_t commandDataLen); + + /** + * @brief This function checks if the receiced speed and ramp time to set are in a valid + * range. + * @return RETURN_OK if successful, otherwise error code. + */ + ReturnValue_t checkSpeedAndRampTime(const uint8_t * commandData, size_t commandDataLen); + + /** + * @brief This function prepares the set speed command from the commandData received with + * an action message. + */ + void prepareSetSpeedCmd(const uint8_t * commandData, size_t commandDataLen); + + /** + * @brief This function fills the commandBuffer with the data to request the temperature. + */ + void prepareGetTemperatureCmd(); + + /** + * @brief This function handles the reply of the get temperature command. + * + * @param packet Pointer to the reply data + */ + void handleTemperatureReply(const uint8_t* packet); + + /** + * @brief This function fills the status set with the data from the get-status-reply. + */ + void handleGetRwStatusReply(const uint8_t* packet); +}; + +#endif /* MISSION_DEVICES_RWHANDLER_H_ */ diff --git a/mission/devices/devicedefinitions/Max31865Definitions.h b/mission/devices/devicedefinitions/Max31865Definitions.h index 2a789a7b..26c702a3 100644 --- a/mission/devices/devicedefinitions/Max31865Definitions.h +++ b/mission/devices/devicedefinitions/Max31865Definitions.h @@ -1,5 +1,5 @@ -#ifndef MISSION_DEVICES_DEVICEPACKETS_THERMALSENSORPACKET_H_ -#define MISSION_DEVICES_DEVICEPACKETS_THERMALSENSORPACKET_H_ +#ifndef MISSION_DEVICES_DEVICEDEFINITIONS_MAX13865DEFINITIONS_H_ +#define MISSION_DEVICES_DEVICEDEFINITIONS_MAX13865DEFINITIONS_H_ #include #include @@ -54,5 +54,5 @@ public: } -#endif /* MISSION_DEVICES_DEVICEPACKETS_THERMALSENSORPACKET_H_ */ +#endif /* MISSION_DEVICES_DEVICEDEFINITIONS_MAX13865DEFINITIONS_H_ */ diff --git a/mission/devices/devicedefinitions/RwDefinitions.h b/mission/devices/devicedefinitions/RwDefinitions.h new file mode 100644 index 00000000..247b7bc6 --- /dev/null +++ b/mission/devices/devicedefinitions/RwDefinitions.h @@ -0,0 +1,86 @@ +#ifndef MISSION_DEVICES_DEVICEDEFINITIONS_RWDEFINITIONS_H_ +#define MISSION_DEVICES_DEVICEDEFINITIONS_RWDEFINITIONS_H_ + +#include +#include +#include +#include "objects/systemObjectList.h" + +namespace RwDefinitions { + +enum PoolIds: lp_id_t { + TEMPERATURE_C, + CURR_SPEED, + REFERENCE_SPEED, + STATE, + CLC_MODE +}; + +static constexpr DeviceCommandId_t GET_RW_STATUS = 4; +static constexpr DeviceCommandId_t SET_SPEED = 6; +static constexpr DeviceCommandId_t GET_TEMPERATURE = 8; + +static constexpr uint32_t TEMPERATURE_SET_ID = GET_TEMPERATURE; +static constexpr uint32_t STATUS_SET_ID = GET_RW_STATUS; + +static constexpr size_t SIZE_GET_RW_STATUS = 14; +static constexpr size_t SIZE_SET_SPEED_REPLY = 4; +static constexpr size_t SIZE_GET_TEMPERATURE_REPLY = 8; +/** Max size when requesting telemetry */ +static constexpr size_t SIZE_GET_TELEMETRY_REPLY = 83; + +/** Set speed command has maximum size */ +static constexpr size_t MAX_CMD_SIZE = 9; +static constexpr size_t MAX_REPLY_SIZE = SIZE_GET_TELEMETRY_REPLY; + +static constexpr uint8_t TEMPERATURE_SET_ENTRIES = 1; +static constexpr uint8_t STATUS_SET_ENTRIES = 4; + +/** + * @brief This dataset can be used to store the temperature of a reaction wheel. + */ +class TemperatureSet: + public StaticLocalDataSet { +public: + + TemperatureSet(HasLocalDataPoolIF* owner): + StaticLocalDataSet(owner, TEMPERATURE_SET_ID) { + } + + TemperatureSet(object_id_t objectId): + StaticLocalDataSet(sid_t(objectId, TEMPERATURE_SET_ID)) { + } + + lp_var_t temperatureCelcius = lp_var_t(sid.objectId, + PoolIds::TEMPERATURE_C, this); +}; + +/** + * @brief This dataset can be used to store the reaction wheel status. + */ +class StatusSet: + public StaticLocalDataSet { +public: + + StatusSet(HasLocalDataPoolIF* owner): + StaticLocalDataSet(owner, STATUS_SET_ID) { + } + + StatusSet(object_id_t objectId): + StaticLocalDataSet(sid_t(objectId, STATUS_SET_ID)) { + } + + lp_var_t currSpeed = lp_var_t(sid.objectId, + PoolIds::CURR_SPEED, this); + lp_var_t referenceSpeed = lp_var_t(sid.objectId, + PoolIds::REFERENCE_SPEED, this); + lp_var_t state = lp_var_t(sid.objectId, + PoolIds::STATE, this); + lp_var_t clcMode = lp_var_t(sid.objectId, + PoolIds::CLC_MODE, this); +}; + +} + +#endif /* MISSION_DEVICES_DEVICEDEFINITIONS_RWDEFINITIONS_H_ */ + From d704b389e48617b5442534ad7c575246fd5ad49b Mon Sep 17 00:00:00 2001 From: Martin Zietz Date: Mon, 21 Jun 2021 14:46:46 +0200 Subject: [PATCH 03/26] reaction wheels testing --- bsp_q7s/ObjectFactory.cpp | 9 ++++++- bsp_q7s/spiCallbacks/rwSpiCallback.cpp | 25 +++++++++++++++++++ .../pollingSequenceFactory.cpp | 9 ++++++- mission/devices/RwHandler.cpp | 1 - mission/devices/RwHandler.h | 5 ---- tmtc | 2 +- 6 files changed, 42 insertions(+), 9 deletions(-) diff --git a/bsp_q7s/ObjectFactory.cpp b/bsp_q7s/ObjectFactory.cpp index 8c9dc91a..e5b43ee0 100644 --- a/bsp_q7s/ObjectFactory.cpp +++ b/bsp_q7s/ObjectFactory.cpp @@ -548,13 +548,20 @@ void ObjectFactory::produce(void* args){ UartCookie* plocUartCookie = new UartCookie(std::string("/dev/ttyUL3"), 115200, PLOC::MAX_REPLY_SIZE); - PlocHandler(objects::PLOC_HANDLER, objects::UART_COM_IF, plocUartCookie); + new PlocHandler(objects::PLOC_HANDLER, objects::UART_COM_IF, plocUartCookie); + + GpioCookie* gpioCookieRw = new GpioCookie; + GpiodRegular* rw1ChipSelect = new GpiodRegular(std::string("gpiochip5"), 7, + std::string("Chip Select RW 1"), gpio::OUT, 1); + gpioCookieRw->addGpio(gpioIds::RW1, rw1ChipSelect); + gpioComIF->addGpios(gpioCookieRw); auto rw1SpiCookie = new SpiCookie(addresses::RW1, gpioIds::RW1, "/dev/spidev2.0", RwDefinitions::MAX_REPLY_SIZE, spi::RW_MODE, spi::RW_SPEED, &rwSpiCallback, nullptr); auto rwHandler1 = new RwHandler(objects::RW1, objects::SPI_COM_IF, rw1SpiCookie); rwHandler1->setStartUpImmediately(); + rw1SpiCookie->setCallbackArgs(rwHandler1); #endif /* TE0720 == 0 */ diff --git a/bsp_q7s/spiCallbacks/rwSpiCallback.cpp b/bsp_q7s/spiCallbacks/rwSpiCallback.cpp index fc9bade1..d1abf55e 100644 --- a/bsp_q7s/spiCallbacks/rwSpiCallback.cpp +++ b/bsp_q7s/spiCallbacks/rwSpiCallback.cpp @@ -103,6 +103,7 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s } return RwHandler::SPI_WRITE_FAILURE; } + idx++; } /** Sending frame start sign */ @@ -125,6 +126,14 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s uint8_t* rxBuf = nullptr; result = comIf->getReadBuffer(cookie->getSpiAddress(), &rxBuf); if(result != HasReturnvaluesIF::RETURN_OK) { + if(gpioId != gpio::NO_GPIO) { + if (gpioIF->pullHigh(gpioId) != HasReturnvaluesIF::RETURN_OK) { + sif::error << "rwSpiCallback: Failed to pull chip select high" << std::endl; + } + } + if(mutex->unlockMutex() != HasReturnvaluesIF::RETURN_OK) { + sif::error << "rwSpiCallback: Failed to unlock mutex"; + } return result; } @@ -133,6 +142,14 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s uint8_t byteRead = 0; /** Reading the reply frame */ if(read(fileDescriptor, &byteRead, 1) != 1) { + if(gpioId != gpio::NO_GPIO) { + if (gpioIF->pullHigh(gpioId) != HasReturnvaluesIF::RETURN_OK) { + sif::error << "rwSpiCallback: Failed to pull chip select high" << std::endl; + } + } + if(mutex->unlockMutex() != HasReturnvaluesIF::RETURN_OK) { + sif::error << "rwSpiCallback: Failed to unlock mutex"; + } sif::error << "rwSpiCallback: Failed to read first byte of reply frame" << std::endl; return RwHandler::SPI_READ_FAILURE; } @@ -140,6 +157,14 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s /** First byte must be the start sign 0x7E */ if (byteRead != 0x7E) { sif::error << "rwSpiCallback: First byte of reply is not 0x7E" << std::endl; + if(gpioId != gpio::NO_GPIO) { + if (gpioIF->pullHigh(gpioId) != HasReturnvaluesIF::RETURN_OK) { + sif::error << "rwSpiCallback: Failed to pull chip select high" << std::endl; + } + } + if(mutex->unlockMutex() != HasReturnvaluesIF::RETURN_OK) { + sif::error << "rwSpiCallback: Failed to unlock mutex"; + } return RwHandler::MISSING_START_SIGN; } diff --git a/linux/fsfwconfig/pollingsequence/pollingSequenceFactory.cpp b/linux/fsfwconfig/pollingsequence/pollingSequenceFactory.cpp index 39cbae4d..1682e4df 100644 --- a/linux/fsfwconfig/pollingsequence/pollingSequenceFactory.cpp +++ b/linux/fsfwconfig/pollingsequence/pollingSequenceFactory.cpp @@ -412,6 +412,12 @@ ReturnValue_t pst::pollingSequenceInitDefault(FixedTimeslotTaskIF *thisSequence) // thisSequence->addSlot(objects::SUS_13, length * 0.938, DeviceHandlerIF::SEND_READ); // thisSequence->addSlot(objects::SUS_13, length * 0.938, DeviceHandlerIF::GET_READ); + thisSequence->addSlot(objects::RW1, length * 0, DeviceHandlerIF::PERFORM_OPERATION); + thisSequence->addSlot(objects::RW1, length * 0.2, DeviceHandlerIF::SEND_WRITE); + thisSequence->addSlot(objects::RW1, length * 0.4, DeviceHandlerIF::GET_WRITE); + thisSequence->addSlot(objects::RW1, length * 0.6, DeviceHandlerIF::SEND_READ); + thisSequence->addSlot(objects::RW1, length * 0.8, DeviceHandlerIF::GET_READ); + if (thisSequence->checkSequence() == HasReturnvaluesIF::RETURN_OK) { return HasReturnvaluesIF::RETURN_OK; } @@ -480,8 +486,9 @@ ReturnValue_t pst::gomspacePstInit(FixedTimeslotTaskIF *thisSequence){ ReturnValue_t pst::pollingSequenceTest(FixedTimeslotTaskIF* thisSequence) { /* Length of a communication cycle */ - uint32_t length = thisSequence->getPeriodMs(); + #if OBSW_ADD_ACS_BOARD == 1 + uint32_t length = thisSequence->getPeriodMs(); thisSequence->addSlot(objects::MGM_0_LIS3_HANDLER, length * 0, DeviceHandlerIF::PERFORM_OPERATION); thisSequence->addSlot(objects::MGM_0_LIS3_HANDLER, length * 0.2, diff --git a/mission/devices/RwHandler.cpp b/mission/devices/RwHandler.cpp index 9f6d483b..f64c3685 100644 --- a/mission/devices/RwHandler.cpp +++ b/mission/devices/RwHandler.cpp @@ -3,7 +3,6 @@ #include #include -#include RwHandler::RwHandler(object_id_t objectId, object_id_t comIF, CookieIF * comCookie) : DeviceHandlerBase(objectId, comIF, comCookie), temperatureSet(this), statusSet(this) { diff --git a/mission/devices/RwHandler.h b/mission/devices/RwHandler.h index 8f77527b..7a5382d7 100644 --- a/mission/devices/RwHandler.h +++ b/mission/devices/RwHandler.h @@ -21,11 +21,6 @@ public: RwHandler(object_id_t objectId, object_id_t comIF, CookieIF * comCookie); virtual ~RwHandler(); - /** - * @brief Sets mode to MODE_NORMAL. Can be used for debugging. - */ - void setModeNormal(); - static const uint8_t INTERFACE_ID = CLASS_ID::RW_HANDLER; static const ReturnValue_t SPI_WRITE_FAILURE = MAKE_RETURN_CODE(0xB0); diff --git a/tmtc b/tmtc index 805470df..7a4d6ee1 160000 --- a/tmtc +++ b/tmtc @@ -1 +1 @@ -Subproject commit 805470df6d907ba5002fcca1ae71f662a7097b0b +Subproject commit 7a4d6ee13a32119a9a9e815d32680ae7ab302699 From 51dba9f2e9bc082bb29079eb63d872a5c78a1b54 Mon Sep 17 00:00:00 2001 From: "Jakob.Meier" Date: Mon, 21 Jun 2021 17:15:19 +0200 Subject: [PATCH 04/26] rw chip select decoding --- bsp_q7s/ObjectFactory.cpp | 16 +++++++++++--- bsp_q7s/gpio/gpioCallbacks.cpp | 34 ++++++++++++++++++++++++++++-- bsp_q7s/gpio/gpioCallbacks.h | 5 +++++ fsfw | 2 +- fsfw_hal | 2 +- linux/fsfwconfig/devices/gpioIds.h | 9 ++++---- 6 files changed, 57 insertions(+), 11 deletions(-) diff --git a/bsp_q7s/ObjectFactory.cpp b/bsp_q7s/ObjectFactory.cpp index e5b43ee0..68751f5c 100644 --- a/bsp_q7s/ObjectFactory.cpp +++ b/bsp_q7s/ObjectFactory.cpp @@ -551,9 +551,19 @@ void ObjectFactory::produce(void* args){ new PlocHandler(objects::PLOC_HANDLER, objects::UART_COM_IF, plocUartCookie); GpioCookie* gpioCookieRw = new GpioCookie; - GpiodRegular* rw1ChipSelect = new GpiodRegular(std::string("gpiochip5"), 7, - std::string("Chip Select RW 1"), gpio::OUT, 1); - gpioCookieRw->addGpio(gpioIds::RW1, rw1ChipSelect); + GpioCallback* csRw1 = new GpioCallback(std::string("Chip select reaction wheel 1"), gpio::OUT, + 1, &gpioCallbacks::spiCsDecoderCallback, gpioComIF); + gpioCookieRw->addGpio(gpioIds::EN_RW1, csRw1); + GpioCallback* csRw2 = new GpioCallback(std::string("Chip select reaction wheel 2"), gpio::OUT, + 1, &gpioCallbacks::spiCsDecoderCallback, gpioComIF); + gpioCookieRw->addGpio(gpioIds::EN_RW2, csRw2); + GpioCallback* csRw3 = new GpioCallback(std::string("Chip select reaction wheel 3"), gpio::OUT, + 1, &gpioCallbacks::spiCsDecoderCallback, gpioComIF); + gpioCookieRw->addGpio(gpioIds::EN_RW3, csRw3); + GpioCallback* csRw4 = new GpioCallback(std::string("Chip select reaction wheel 4"), gpio::OUT, + 1, &gpioCallbacks::spiCsDecoderCallback, gpioComIF); + gpioCookieRw->addGpio(gpioIds::EN_RW4, csRw4); + gpioComIF->addGpios(gpioCookieRw); auto rw1SpiCookie = new SpiCookie(addresses::RW1, gpioIds::RW1, "/dev/spidev2.0", diff --git a/bsp_q7s/gpio/gpioCallbacks.cpp b/bsp_q7s/gpio/gpioCallbacks.cpp index 2f59cb0e..7ae2c417 100644 --- a/bsp_q7s/gpio/gpioCallbacks.cpp +++ b/bsp_q7s/gpio/gpioCallbacks.cpp @@ -45,11 +45,13 @@ void initSpiCsDecoder(GpioIF* gpioComIF) { GpiodRegular* spiMuxBit6 = new GpiodRegular(std::string("gpiochip7"), 18, std::string("SPI Mux Bit 6"), gpio::OUT, 0); spiMuxGpios->addGpio(gpioIds::SPI_MUX_BIT_6, spiMuxBit6); + GpiodRegular* enRwDecoder = new GpiodRegular(std::string("gpiochip5"), 17, + std::string("EN_RW_CS"), gpio::OUT, 0); + spiMuxGpios->addGpio(gpioIds::EN_RW_CS, enRwDecoder); result = gpioComInterface->addGpios(spiMuxGpios); if (result != HasReturnvaluesIF::RETURN_OK) { - sif::error << "initSpiCsDecoder: Failed to add mux bit gpios to gpioComIF" - << std::endl; + sif::error << "initSpiCsDecoder: Failed to add mux bit gpios to gpioComIF" << std::endl; return; } } @@ -218,6 +220,26 @@ void spiCsDecoderCallback(gpioId_t gpioId, gpio::GpioOperation gpioOp, int value selectY6(); break; } + case(gpioIds::EN_RW1): { + enableRwDecoder(); + selectY0(); + break; + } + case(gpioIds::EN_RW2): { + enableRwDecoder(); + selectY1(); + break; + } + case(gpioIds::EN_RW3): { + enableRwDecoder(); + selectY3(); + break; + } + case(gpioIds::EN_RW4): { + enableRwDecoder(); + selectY4(); + break; + } default: sif::debug << "spiCsDecoderCallback: Invalid gpio id " << gpioId << std::endl; } @@ -251,6 +273,13 @@ void enableDecoderInterfaceBoardIc2() { gpioComInterface->pullHigh(gpioIds::SPI_MUX_BIT_3); } +void enableRwDecoder() { + gpioComInterface->pullLow(gpioIds::SPI_MUX_BIT_1); + gpioComInterface->pullLow(gpioIds::SPI_MUX_BIT_2); + gpioComInterface->pullLow(gpioIds::SPI_MUX_BIT_3); + gpioComInterface->pullHigh(gpioIds::EN_RW_CS); +} + void selectY0() { gpioComInterface->pullLow(gpioIds::SPI_MUX_BIT_4); gpioComInterface->pullLow(gpioIds::SPI_MUX_BIT_5); @@ -303,6 +332,7 @@ void disableAllDecoder() { gpioComInterface->pullLow(gpioIds::SPI_MUX_BIT_1); gpioComInterface->pullLow(gpioIds::SPI_MUX_BIT_2); gpioComInterface->pullLow(gpioIds::SPI_MUX_BIT_3); + gpioComInterface->pullLow(gpioIds::EN_RW_CS); } } diff --git a/bsp_q7s/gpio/gpioCallbacks.h b/bsp_q7s/gpio/gpioCallbacks.h index 4a0c73cb..eaf9a701 100644 --- a/bsp_q7s/gpio/gpioCallbacks.h +++ b/bsp_q7s/gpio/gpioCallbacks.h @@ -43,6 +43,11 @@ namespace gpioCallbacks { */ void enableDecoderInterfaceBoardIc2(); + /** + * @brief Enables the reaction wheel chip select decoder (IC3). + */ + void enableRwDecoder(); + /** * @brief This function disables all decoder. */ diff --git a/fsfw b/fsfw index d700fb55..cae69d54 160000 --- a/fsfw +++ b/fsfw @@ -1 +1 @@ -Subproject commit d700fb551c85393b58a3ada96fbd3f807217d14b +Subproject commit cae69d540097acba46bffa47fd7afc6a8a19bd15 diff --git a/fsfw_hal b/fsfw_hal index ae322d98..8fe5d0af 160000 --- a/fsfw_hal +++ b/fsfw_hal @@ -1 +1 @@ -Subproject commit ae322d981bd1ed8411a058ba6b4dc185f00a12f3 +Subproject commit 8fe5d0afa0857025d9dee3c6f266c2503a22c517 diff --git a/linux/fsfwconfig/devices/gpioIds.h b/linux/fsfwconfig/devices/gpioIds.h index 39d1b8ce..0a541477 100644 --- a/linux/fsfwconfig/devices/gpioIds.h +++ b/linux/fsfwconfig/devices/gpioIds.h @@ -70,10 +70,11 @@ namespace gpioIds { PAPB_BUSY_N, PAPB_EMPTY, - RW1, - RW2, - RW3, - RW4 + EN_RW1, + EN_RW2, + EN_RW3, + EN_RW4, + EN_RW_CS }; } From cbdcc50cc9b018d9a9fa24721bd2b8f917ee7675 Mon Sep 17 00:00:00 2001 From: Martin Zietz Date: Tue, 22 Jun 2021 13:48:30 +0200 Subject: [PATCH 05/26] rw enable wip --- bsp_q7s/ObjectFactory.cpp | 16 ++++++++-------- bsp_q7s/gpio/gpioCallbacks.cpp | 2 +- mission/devices/RwHandler.cpp | 14 +++++++++----- mission/devices/RwHandler.h | 13 ++++++++++++- 4 files changed, 30 insertions(+), 15 deletions(-) diff --git a/bsp_q7s/ObjectFactory.cpp b/bsp_q7s/ObjectFactory.cpp index f3ecd173..821d94fd 100644 --- a/bsp_q7s/ObjectFactory.cpp +++ b/bsp_q7s/ObjectFactory.cpp @@ -552,18 +552,18 @@ void ObjectFactory::produce(void* args){ new PlocHandler(objects::PLOC_HANDLER, objects::UART_COM_IF, plocUartCookie); GpioCookie* gpioCookieRw = new GpioCookie; - GpioCallback* csRw1 = new GpioCallback(std::string("Chip select reaction wheel 1"), gpio::OUT, + GpioCallback* enRw1 = new GpioCallback(std::string("Chip select reaction wheel 1"), gpio::OUT, 1, &gpioCallbacks::spiCsDecoderCallback, gpioComIF); - gpioCookieRw->addGpio(gpioIds::EN_RW1, csRw1); - GpioCallback* csRw2 = new GpioCallback(std::string("Chip select reaction wheel 2"), gpio::OUT, + gpioCookieRw->addGpio(gpioIds::EN_RW1, enRw1); + GpioCallback* enRw2 = new GpioCallback(std::string("Chip select reaction wheel 2"), gpio::OUT, 1, &gpioCallbacks::spiCsDecoderCallback, gpioComIF); - gpioCookieRw->addGpio(gpioIds::EN_RW2, csRw2); - GpioCallback* csRw3 = new GpioCallback(std::string("Chip select reaction wheel 3"), gpio::OUT, + gpioCookieRw->addGpio(gpioIds::EN_RW2, enRw2); + GpioCallback* enRw3 = new GpioCallback(std::string("Chip select reaction wheel 3"), gpio::OUT, 1, &gpioCallbacks::spiCsDecoderCallback, gpioComIF); - gpioCookieRw->addGpio(gpioIds::EN_RW3, csRw3); - GpioCallback* csRw4 = new GpioCallback(std::string("Chip select reaction wheel 4"), gpio::OUT, + gpioCookieRw->addGpio(gpioIds::EN_RW3, enRw3); + GpioCallback* enRw4 = new GpioCallback(std::string("Chip select reaction wheel 4"), gpio::OUT, 1, &gpioCallbacks::spiCsDecoderCallback, gpioComIF); - gpioCookieRw->addGpio(gpioIds::EN_RW4, csRw4); + gpioCookieRw->addGpio(gpioIds::EN_RW4, enRw4); gpioComIF->addGpios(gpioCookieRw); diff --git a/bsp_q7s/gpio/gpioCallbacks.cpp b/bsp_q7s/gpio/gpioCallbacks.cpp index 7ae2c417..ede2311a 100644 --- a/bsp_q7s/gpio/gpioCallbacks.cpp +++ b/bsp_q7s/gpio/gpioCallbacks.cpp @@ -46,7 +46,7 @@ void initSpiCsDecoder(GpioIF* gpioComIF) { std::string("SPI Mux Bit 6"), gpio::OUT, 0); spiMuxGpios->addGpio(gpioIds::SPI_MUX_BIT_6, spiMuxBit6); GpiodRegular* enRwDecoder = new GpiodRegular(std::string("gpiochip5"), 17, - std::string("EN_RW_CS"), gpio::OUT, 0); + std::string("EN_RW_CS"), gpio::OUT, 1); spiMuxGpios->addGpio(gpioIds::EN_RW_CS, enRwDecoder); result = gpioComInterface->addGpios(spiMuxGpios); diff --git a/mission/devices/RwHandler.cpp b/mission/devices/RwHandler.cpp index f64c3685..c029372b 100644 --- a/mission/devices/RwHandler.cpp +++ b/mission/devices/RwHandler.cpp @@ -4,11 +4,15 @@ #include #include -RwHandler::RwHandler(object_id_t objectId, object_id_t comIF, CookieIF * comCookie) : - DeviceHandlerBase(objectId, comIF, comCookie), temperatureSet(this), statusSet(this) { - if (comCookie == NULL) { - sif::error << "RwHandler: Invalid com cookie" << std::endl; - } +RwHandler::RwHandler(object_id_t objectId, object_id_t comIF, CookieIF * comCookie, + LinuxLibgpioIF* gpioComIF, gpioId_t enableGpio) : + DeviceHandlerBase(objectId, comIF, comCookie), temperatureSet(this), statusSet(this) { + if (comCookie == NULL) { + sif::error << "RwHandler: Invalid com cookie" << std::endl; + } + if (gpioComIF == NULL) { + sif::error << "RwHandler: Invalid gpio communication interface" << std::endl; + } } RwHandler::~RwHandler() { diff --git a/mission/devices/RwHandler.h b/mission/devices/RwHandler.h index 7a5382d7..f68b57b7 100644 --- a/mission/devices/RwHandler.h +++ b/mission/devices/RwHandler.h @@ -18,7 +18,18 @@ class RwHandler: public DeviceHandlerBase { public: - RwHandler(object_id_t objectId, object_id_t comIF, CookieIF * comCookie); + /** + * @brief Constructor + * + * @param objectId + * @param comIF + * @param comCookie + * @param gpioComIF Pointer to gpio communication interface + * @param enablePin GPIO connected to the enable pin of the reaction wheels. Must be pulled + * to high to enable the device. + */ + RwHandler(object_id_t objectId, object_id_t comIF, CookieIF * comCookie, + LinuxLibgpioIF* gpioComIF, gpioId_t enableGpio); virtual ~RwHandler(); static const uint8_t INTERFACE_ID = CLASS_ID::RW_HANDLER; From 8284ebec9f41b3748983dcabe12ea8f67e101379 Mon Sep 17 00:00:00 2001 From: Martin Zietz Date: Thu, 24 Jun 2021 12:04:36 +0200 Subject: [PATCH 06/26] rw wip --- bsp_q7s/ObjectFactory.cpp | 34 ++++++++++----- bsp_q7s/gpio/gpioCallbacks.cpp | 8 ++-- bsp_q7s/spiCallbacks/rwSpiCallback.cpp | 42 ++++++++++++++----- common/config/spiConf.h | 2 +- linux/fsfwconfig/devices/gpioIds.h | 6 +++ mission/devices/RwHandler.cpp | 10 ++++- mission/devices/RwHandler.h | 6 +++ .../devices/devicedefinitions/RwDefinitions.h | 28 +++++++------ 8 files changed, 95 insertions(+), 41 deletions(-) diff --git a/bsp_q7s/ObjectFactory.cpp b/bsp_q7s/ObjectFactory.cpp index 821d94fd..7507b5e6 100644 --- a/bsp_q7s/ObjectFactory.cpp +++ b/bsp_q7s/ObjectFactory.cpp @@ -552,25 +552,39 @@ void ObjectFactory::produce(void* args){ new PlocHandler(objects::PLOC_HANDLER, objects::UART_COM_IF, plocUartCookie); GpioCookie* gpioCookieRw = new GpioCookie; - GpioCallback* enRw1 = new GpioCallback(std::string("Chip select reaction wheel 1"), gpio::OUT, + GpioCallback* csRw1 = new GpioCallback(std::string("Chip select reaction wheel 1"), gpio::OUT, 1, &gpioCallbacks::spiCsDecoderCallback, gpioComIF); - gpioCookieRw->addGpio(gpioIds::EN_RW1, enRw1); - GpioCallback* enRw2 = new GpioCallback(std::string("Chip select reaction wheel 2"), gpio::OUT, + gpioCookieRw->addGpio(gpioIds::CS_RW1, csRw1); + GpioCallback* csRw2 = new GpioCallback(std::string("Chip select reaction wheel 2"), gpio::OUT, 1, &gpioCallbacks::spiCsDecoderCallback, gpioComIF); - gpioCookieRw->addGpio(gpioIds::EN_RW2, enRw2); - GpioCallback* enRw3 = new GpioCallback(std::string("Chip select reaction wheel 3"), gpio::OUT, + gpioCookieRw->addGpio(gpioIds::CS_RW2, csRw2); + GpioCallback* csRw3 = new GpioCallback(std::string("Chip select reaction wheel 3"), gpio::OUT, 1, &gpioCallbacks::spiCsDecoderCallback, gpioComIF); - gpioCookieRw->addGpio(gpioIds::EN_RW3, enRw3); - GpioCallback* enRw4 = new GpioCallback(std::string("Chip select reaction wheel 4"), gpio::OUT, + gpioCookieRw->addGpio(gpioIds::CS_RW3, csRw3); + GpioCallback* csRw4 = new GpioCallback(std::string("Chip select reaction wheel 4"), gpio::OUT, 1, &gpioCallbacks::spiCsDecoderCallback, gpioComIF); - gpioCookieRw->addGpio(gpioIds::EN_RW4, enRw4); + gpioCookieRw->addGpio(gpioIds::CS_RW4, csRw4); + + GpiodRegular* enRw1 = new GpiodRegular(std::string("gpiochip5"), 7, + std::string("Enable reaction wheel 1"), gpio::OUT, 0); + gpioCookieRw->addGpio(gpioIds::EN_RW1, enRw1); + GpiodRegular* enRw2 = new GpiodRegular(std::string("gpiochip5"), 3, + std::string("Enable reaction wheel 2"), gpio::OUT, 0); + gpioCookieRw->addGpio(gpioIds::EN_RW2, enRw2); + GpiodRegular* enRw3 = new GpiodRegular(std::string("gpiochip5"), 11, + std::string("Enable reaction wheel 3"), gpio::OUT, 0); + gpioCookieRw->addGpio(gpioIds::EN_RW3, enRw3); + GpiodRegular* enRw4 = new GpiodRegular(std::string("gpiochip5"), 6, + std::string("Enable reaction wheel 4"), gpio::OUT, 0); + gpioCookieRw->addGpio(gpioIds::EN_RW4, enRw4); gpioComIF->addGpios(gpioCookieRw); - auto rw1SpiCookie = new SpiCookie(addresses::RW1, gpioIds::EN_RW1, "/dev/spidev2.0", + auto rw1SpiCookie = new SpiCookie(addresses::RW1, gpioIds::CS_RW1, "/dev/spidev2.0", RwDefinitions::MAX_REPLY_SIZE, spi::RW_MODE, spi::RW_SPEED, &rwSpiCallback, nullptr); - auto rwHandler1 = new RwHandler(objects::RW1, objects::SPI_COM_IF, rw1SpiCookie); + auto rwHandler1 = new RwHandler(objects::RW1, objects::SPI_COM_IF, rw1SpiCookie, gpioComIF, + gpioIds::EN_RW1); rwHandler1->setStartUpImmediately(); rw1SpiCookie->setCallbackArgs(rwHandler1); diff --git a/bsp_q7s/gpio/gpioCallbacks.cpp b/bsp_q7s/gpio/gpioCallbacks.cpp index ede2311a..49e22249 100644 --- a/bsp_q7s/gpio/gpioCallbacks.cpp +++ b/bsp_q7s/gpio/gpioCallbacks.cpp @@ -220,22 +220,22 @@ void spiCsDecoderCallback(gpioId_t gpioId, gpio::GpioOperation gpioOp, int value selectY6(); break; } - case(gpioIds::EN_RW1): { + case(gpioIds::CS_RW1): { enableRwDecoder(); selectY0(); break; } - case(gpioIds::EN_RW2): { + case(gpioIds::CS_RW2): { enableRwDecoder(); selectY1(); break; } - case(gpioIds::EN_RW3): { + case(gpioIds::CS_RW3): { enableRwDecoder(); selectY3(); break; } - case(gpioIds::EN_RW4): { + case(gpioIds::CS_RW4): { enableRwDecoder(); selectY4(); break; diff --git a/bsp_q7s/spiCallbacks/rwSpiCallback.cpp b/bsp_q7s/spiCallbacks/rwSpiCallback.cpp index d1abf55e..2ad2d9fd 100644 --- a/bsp_q7s/spiCallbacks/rwSpiCallback.cpp +++ b/bsp_q7s/spiCallbacks/rwSpiCallback.cpp @@ -90,6 +90,7 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s default: writeBuffer[0] = *(sendData + idx); writeSize = 1; + break; } if (write(fileDescriptor, writeBuffer, writeSize) != static_cast(writeSize)) { sif::error << "rwSpiCallback: Write failed!" << std::endl; @@ -139,19 +140,28 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s size_t replyBufferSize = cookie->getMaxBufferSize(); + /** There must be a delay of 20 ms after sending the command */ + usleep(RwDefinitions::SPI_REPLY_DELAY); + + /** Receiving reply data */ uint8_t byteRead = 0; /** Reading the reply frame */ - if(read(fileDescriptor, &byteRead, 1) != 1) { - if(gpioId != gpio::NO_GPIO) { - if (gpioIF->pullHigh(gpioId) != HasReturnvaluesIF::RETURN_OK) { - sif::error << "rwSpiCallback: Failed to pull chip select high" << std::endl; - } - } - if(mutex->unlockMutex() != HasReturnvaluesIF::RETURN_OK) { - sif::error << "rwSpiCallback: Failed to unlock mutex"; - } - sif::error << "rwSpiCallback: Failed to read first byte of reply frame" << std::endl; - return RwHandler::SPI_READ_FAILURE; +// if(read(fileDescriptor, &byteRead, 1) != 1) { +// if(gpioId != gpio::NO_GPIO) { +// if (gpioIF->pullHigh(gpioId) != HasReturnvaluesIF::RETURN_OK) { +// sif::error << "rwSpiCallback: Failed to pull chip select high" << std::endl; +// } +// } +// if(mutex->unlockMutex() != HasReturnvaluesIF::RETURN_OK) { +// sif::error << "rwSpiCallback: Failed to unlock mutex"; +// } +// sif::error << "rwSpiCallback: Failed to read first byte of reply frame" << std::endl; +// return RwHandler::SPI_READ_FAILURE; +// } + + uint8_t readbuffer[10]; + if(read(fileDescriptor, readbuffer, 10) != 10) { + sif::error << "Failed to read all bytes" << std::endl;; } /** First byte must be the start sign 0x7E */ @@ -168,8 +178,18 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s return RwHandler::MISSING_START_SIGN; } + /** + * The reaction wheel responds with empty frames while preparing the reply data. + * However, receiving more than 5 empty frames will be interpreted as an error. + */ + for (int idx = 0; idx < 10; idx++) { + sif::error << "rwSpiCallback: Empty frame timeout"; + return RwHandler::NO_REPLY; + } + size_t decodedFrameLen = 0; for (; decodedFrameLen < replyBufferSize; decodedFrameLen++) { + byteRead = 0; if(read(fileDescriptor, &byteRead, 1) != 1) { sif::error << "rwSpiCallback: Read failed" << std::endl; return RwHandler::SPI_READ_FAILURE; diff --git a/common/config/spiConf.h b/common/config/spiConf.h index d76ac9b8..47600eb3 100644 --- a/common/config/spiConf.h +++ b/common/config/spiConf.h @@ -26,7 +26,7 @@ static constexpr spi::SpiModes DEFAULT_MAX_1227_MODE = spi::SpiModes::MODE_3; static constexpr uint32_t DEFAULT_ADIS16507_SPEED = 976'000; static constexpr spi::SpiModes DEFAULT_ADIS16507_MODE = spi::SpiModes::MODE_3; -static constexpr uint32_t RW_SPEED = 300'000; +static constexpr uint32_t RW_SPEED = 300000; static constexpr spi::SpiModes RW_MODE = spi::SpiModes::MODE_0; } diff --git a/linux/fsfwconfig/devices/gpioIds.h b/linux/fsfwconfig/devices/gpioIds.h index 0a541477..718bc9bf 100644 --- a/linux/fsfwconfig/devices/gpioIds.h +++ b/linux/fsfwconfig/devices/gpioIds.h @@ -74,6 +74,12 @@ namespace gpioIds { EN_RW2, EN_RW3, EN_RW4, + + CS_RW1, + CS_RW2, + CS_RW3, + CS_RW4, + EN_RW_CS }; } diff --git a/mission/devices/RwHandler.cpp b/mission/devices/RwHandler.cpp index c029372b..a80c97cc 100644 --- a/mission/devices/RwHandler.cpp +++ b/mission/devices/RwHandler.cpp @@ -6,7 +6,8 @@ RwHandler::RwHandler(object_id_t objectId, object_id_t comIF, CookieIF * comCookie, LinuxLibgpioIF* gpioComIF, gpioId_t enableGpio) : - DeviceHandlerBase(objectId, comIF, comCookie), temperatureSet(this), statusSet(this) { + DeviceHandlerBase(objectId, comIF, comCookie), gpioComIF(gpioComIF), enableGpio(enableGpio), + temperatureSet(this), statusSet(this) { if (comCookie == NULL) { sif::error << "RwHandler: Invalid com cookie" << std::endl; } @@ -19,6 +20,9 @@ RwHandler::~RwHandler() { } void RwHandler::doStartUp() { + if(gpioComIF->pullHigh(enableGpio) != RETURN_OK) { + sif::debug << "RwHandler::doStartUp: Failed to pull enable gpio to high"; + } #if OBSW_SWITCH_TO_NORMAL_MODE_AFTER_STARTUP == 1 setMode(MODE_NORMAL); #else @@ -27,7 +31,9 @@ void RwHandler::doStartUp() { } void RwHandler::doShutDown() { - + if(gpioComIF->pullLow(enableGpio) != RETURN_OK) { + sif::debug << "RwHandler::doStartUp: Failed to pull enable gpio to low"; + } } ReturnValue_t RwHandler::buildNormalDeviceCommand(DeviceCommandId_t * id) { diff --git a/mission/devices/RwHandler.h b/mission/devices/RwHandler.h index f68b57b7..0a9d58d0 100644 --- a/mission/devices/RwHandler.h +++ b/mission/devices/RwHandler.h @@ -3,6 +3,7 @@ #include #include +#include #include /** @@ -43,6 +44,8 @@ public: static const ReturnValue_t INVALID_SUBSTITUTE = MAKE_RETURN_CODE(0xB3); //! [EXPORT] : [COMMENT] HDLC decoding mechanism never receives the end sign 0x7E static const ReturnValue_t MISSING_END_SIGN = MAKE_RETURN_CODE(0xB4); + //! [EXPORT] : [COMMENT] Reaction wheel only responds with empty frames. + static const ReturnValue_t NO_REPLY = MAKE_RETURN_CODE(0xB5); protected: void doStartUp() override; @@ -76,6 +79,9 @@ private: //! [EXPORT] : [COMMENT] Reaction wheel reply has invalid crc static const ReturnValue_t CRC_ERROR = MAKE_RETURN_CODE(0xA4); + LinuxLibgpioIF* gpioComIF = nullptr; + gpioId_t enableGpio = gpio::NO_GPIO; + RwDefinitions::TemperatureSet temperatureSet; RwDefinitions::StatusSet statusSet; diff --git a/mission/devices/devicedefinitions/RwDefinitions.h b/mission/devices/devicedefinitions/RwDefinitions.h index 247b7bc6..23907eb3 100644 --- a/mission/devices/devicedefinitions/RwDefinitions.h +++ b/mission/devices/devicedefinitions/RwDefinitions.h @@ -8,6 +8,8 @@ namespace RwDefinitions { +static const uint32_t SPI_REPLY_DELAY = 70000; //us + enum PoolIds: lp_id_t { TEMPERATURE_C, CURR_SPEED, @@ -16,25 +18,25 @@ enum PoolIds: lp_id_t { CLC_MODE }; -static constexpr DeviceCommandId_t GET_RW_STATUS = 4; -static constexpr DeviceCommandId_t SET_SPEED = 6; -static constexpr DeviceCommandId_t GET_TEMPERATURE = 8; +static const DeviceCommandId_t GET_RW_STATUS = 4; +static const DeviceCommandId_t SET_SPEED = 6; +static const DeviceCommandId_t GET_TEMPERATURE = 8; -static constexpr uint32_t TEMPERATURE_SET_ID = GET_TEMPERATURE; -static constexpr uint32_t STATUS_SET_ID = GET_RW_STATUS; +static const uint32_t TEMPERATURE_SET_ID = GET_TEMPERATURE; +static const uint32_t STATUS_SET_ID = GET_RW_STATUS; -static constexpr size_t SIZE_GET_RW_STATUS = 14; -static constexpr size_t SIZE_SET_SPEED_REPLY = 4; -static constexpr size_t SIZE_GET_TEMPERATURE_REPLY = 8; +static const size_t SIZE_GET_RW_STATUS = 14; +static const size_t SIZE_SET_SPEED_REPLY = 4; +static const size_t SIZE_GET_TEMPERATURE_REPLY = 8; /** Max size when requesting telemetry */ -static constexpr size_t SIZE_GET_TELEMETRY_REPLY = 83; +static const size_t SIZE_GET_TELEMETRY_REPLY = 83; /** Set speed command has maximum size */ -static constexpr size_t MAX_CMD_SIZE = 9; -static constexpr size_t MAX_REPLY_SIZE = SIZE_GET_TELEMETRY_REPLY; +static const size_t MAX_CMD_SIZE = 9; +static const size_t MAX_REPLY_SIZE = SIZE_GET_TELEMETRY_REPLY; -static constexpr uint8_t TEMPERATURE_SET_ENTRIES = 1; -static constexpr uint8_t STATUS_SET_ENTRIES = 4; +static const uint8_t TEMPERATURE_SET_ENTRIES = 1; +static const uint8_t STATUS_SET_ENTRIES = 4; /** * @brief This dataset can be used to store the temperature of a reaction wheel. From b5fdeb93bb70f26a1ee19c567d937eda66e9b0c8 Mon Sep 17 00:00:00 2001 From: "Jakob.Meier" Date: Thu, 24 Jun 2021 17:32:42 +0200 Subject: [PATCH 07/26] get temperature and status of reaction wheel --- bsp_q7s/spiCallbacks/rwSpiCallback.cpp | 127 ++++++------------ bsp_q7s/spiCallbacks/rwSpiCallback.h | 9 ++ fsfw_hal | 2 +- mission/devices/RwHandler.cpp | 39 ++++-- .../devices/devicedefinitions/RwDefinitions.h | 9 ++ 5 files changed, 89 insertions(+), 97 deletions(-) diff --git a/bsp_q7s/spiCallbacks/rwSpiCallback.cpp b/bsp_q7s/spiCallbacks/rwSpiCallback.cpp index 2ad2d9fd..41ba70d9 100644 --- a/bsp_q7s/spiCallbacks/rwSpiCallback.cpp +++ b/bsp_q7s/spiCallbacks/rwSpiCallback.cpp @@ -62,14 +62,7 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s if (write(fileDescriptor, writeBuffer, writeSize) != static_cast(writeSize)) { sif::error << "rwSpiCallback: Write failed!" << std::endl; - if(gpioId != gpio::NO_GPIO) { - if (gpioIF->pullHigh(gpioId) != HasReturnvaluesIF::RETURN_OK) { - sif::error << "rwSpiCallback: Failed to pull chip select high" << std::endl; - } - } - if(mutex->unlockMutex() != HasReturnvaluesIF::RETURN_OK) { - sif::error << "rwSpiCallback: Failed to unlock mutex" << std::endl;; - } + closeSpi(gpioId, gpioIF, mutex); return RwHandler::SPI_WRITE_FAILURE; } @@ -94,14 +87,7 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s } if (write(fileDescriptor, writeBuffer, writeSize) != static_cast(writeSize)) { sif::error << "rwSpiCallback: Write failed!" << std::endl; - if(gpioId != gpio::NO_GPIO) { - if (gpioIF->pullHigh(gpioId) != HasReturnvaluesIF::RETURN_OK) { - sif::error << "rwSpiCallback: Failed to pull chip select high" << std::endl; - } - } - if(mutex->unlockMutex() != HasReturnvaluesIF::RETURN_OK) { - sif::error << "rwSpiCallback: Failed to unlock mutex"; - } + closeSpi(gpioId, gpioIF, mutex); return RwHandler::SPI_WRITE_FAILURE; } idx++; @@ -113,28 +99,14 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s if (write(fileDescriptor, writeBuffer, writeSize) != static_cast(writeSize)) { sif::error << "rwSpiCallback: Write failed!" << std::endl; - if(gpioId != gpio::NO_GPIO) { - if (gpioIF->pullHigh(gpioId) != HasReturnvaluesIF::RETURN_OK) { - sif::error << "rwSpiCallback: Failed to pull chip select high" << std::endl; - } - } - if(mutex->unlockMutex() != HasReturnvaluesIF::RETURN_OK) { - sif::error << "rwSpiCallback: Failed to unlock mutex"; - } + closeSpi(gpioId, gpioIF, mutex); return RwHandler::SPI_WRITE_FAILURE; } uint8_t* rxBuf = nullptr; result = comIf->getReadBuffer(cookie->getSpiAddress(), &rxBuf); if(result != HasReturnvaluesIF::RETURN_OK) { - if(gpioId != gpio::NO_GPIO) { - if (gpioIF->pullHigh(gpioId) != HasReturnvaluesIF::RETURN_OK) { - sif::error << "rwSpiCallback: Failed to pull chip select high" << std::endl; - } - } - if(mutex->unlockMutex() != HasReturnvaluesIF::RETURN_OK) { - sif::error << "rwSpiCallback: Failed to unlock mutex"; - } + closeSpi(gpioId, gpioIF, mutex); return result; } @@ -143,56 +115,40 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s /** There must be a delay of 20 ms after sending the command */ usleep(RwDefinitions::SPI_REPLY_DELAY); - /** Receiving reply data */ - uint8_t byteRead = 0; - /** Reading the reply frame */ -// if(read(fileDescriptor, &byteRead, 1) != 1) { -// if(gpioId != gpio::NO_GPIO) { -// if (gpioIF->pullHigh(gpioId) != HasReturnvaluesIF::RETURN_OK) { -// sif::error << "rwSpiCallback: Failed to pull chip select high" << std::endl; -// } -// } -// if(mutex->unlockMutex() != HasReturnvaluesIF::RETURN_OK) { -// sif::error << "rwSpiCallback: Failed to unlock mutex"; -// } -// sif::error << "rwSpiCallback: Failed to read first byte of reply frame" << std::endl; -// return RwHandler::SPI_READ_FAILURE; -// } - - uint8_t readbuffer[10]; - if(read(fileDescriptor, readbuffer, 10) != 10) { - sif::error << "Failed to read all bytes" << std::endl;; - } - - /** First byte must be the start sign 0x7E */ - if (byteRead != 0x7E) { - sif::error << "rwSpiCallback: First byte of reply is not 0x7E" << std::endl; - if(gpioId != gpio::NO_GPIO) { - if (gpioIF->pullHigh(gpioId) != HasReturnvaluesIF::RETURN_OK) { - sif::error << "rwSpiCallback: Failed to pull chip select high" << std::endl; - } - } - if(mutex->unlockMutex() != HasReturnvaluesIF::RETURN_OK) { - sif::error << "rwSpiCallback: Failed to unlock mutex"; - } - return RwHandler::MISSING_START_SIGN; - } - /** * The reaction wheel responds with empty frames while preparing the reply data. * However, receiving more than 5 empty frames will be interpreted as an error. */ + uint8_t byteRead = 0; for (int idx = 0; idx < 10; idx++) { - sif::error << "rwSpiCallback: Empty frame timeout"; - return RwHandler::NO_REPLY; + if(read(fileDescriptor, &byteRead, 1) != 1) { + sif::error << "rwSpiCallback: Read failed" << std::endl; + closeSpi(gpioId, gpioIF, mutex); + return RwHandler::SPI_READ_FAILURE; + } + + if (byteRead != 0x7E) { + break; + } + + if (idx == 9) { + sif::error << "rwSpiCallback: Empty frame timeout" << std::endl; + closeSpi(gpioId, gpioIF, mutex); + return RwHandler::NO_REPLY; + } } size_t decodedFrameLen = 0; - for (; decodedFrameLen < replyBufferSize; decodedFrameLen++) { - byteRead = 0; - if(read(fileDescriptor, &byteRead, 1) != 1) { - sif::error << "rwSpiCallback: Read failed" << std::endl; - return RwHandler::SPI_READ_FAILURE; + while(decodedFrameLen < replyBufferSize) { + + /** First byte already read in */ + if (decodedFrameLen != 0) { + byteRead = 0; + if(read(fileDescriptor, &byteRead, 1) != 1) { + sif::error << "rwSpiCallback: Read failed" << std::endl; + result = RwHandler::SPI_READ_FAILURE; + break; + } } if (byteRead == 0x7E) { @@ -217,6 +173,7 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s } else { sif::error << "rwSpiCallback: Invalid substitute" << std::endl; + closeSpi(gpioId, gpioIF, mutex); result = RwHandler::INVALID_SUBSTITUTE; break; } @@ -250,16 +207,18 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s cookie->assignTransferSize(decodedFrameLen); - if(gpioId != gpio::NO_GPIO) { - if (gpioIF->pullHigh(gpioId) != HasReturnvaluesIF::RETURN_OK) { - sif::error << "rwSpiCallback: Failed to pull chip select high" << std::endl; - } - } + closeSpi(gpioId, gpioIF, mutex); - if(gpioId != gpio::NO_GPIO) { - if(mutex->unlockMutex() != HasReturnvaluesIF::RETURN_OK) { - sif::error << "rwSpiCallback: Failed to unlock mutex" << std::endl; - } - } return result; } + +void closeSpi (gpioId_t gpioId, GpioIF* gpioIF, MutexIF* mutex) { + if(gpioId != gpio::NO_GPIO) { + if (gpioIF->pullHigh(gpioId) != HasReturnvaluesIF::RETURN_OK) { + sif::error << "closeSpi: Failed to pull chip select high" << std::endl; + } + } + if(mutex->unlockMutex() != HasReturnvaluesIF::RETURN_OK) { + sif::error << "closeSpi: Failed to unlock mutex" << std::endl;; + } +} diff --git a/bsp_q7s/spiCallbacks/rwSpiCallback.h b/bsp_q7s/spiCallbacks/rwSpiCallback.h index d882bee4..e684c1c1 100644 --- a/bsp_q7s/spiCallbacks/rwSpiCallback.h +++ b/bsp_q7s/spiCallbacks/rwSpiCallback.h @@ -18,4 +18,13 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *sendData, size_t sendLen, void* args); +/** + * @brief This function closes a spi session. Pulls the chip select to high an releases the + * mutex. + * @param gpioId Gpio ID of chip select + * @param gpioIF Pointer to gpio interface to drive the chip select + * @param mutex The spi mutex + */ +void closeSpi(gpioId_t gpioId, GpioIF* gpioIF, MutexIF* mutex); + #endif /* BSP_Q7S_RW_SPI_CALLBACK_H_ */ diff --git a/fsfw_hal b/fsfw_hal index 8fe5d0af..2e243e3b 160000 --- a/fsfw_hal +++ b/fsfw_hal @@ -1 +1 @@ -Subproject commit 8fe5d0afa0857025d9dee3c6f266c2503a22c517 +Subproject commit 2e243e3b294870b0c93f85c6b8ff0c74f4f9cce7 diff --git a/mission/devices/RwHandler.cpp b/mission/devices/RwHandler.cpp index a80c97cc..23c49eba 100644 --- a/mission/devices/RwHandler.cpp +++ b/mission/devices/RwHandler.cpp @@ -40,9 +40,11 @@ ReturnValue_t RwHandler::buildNormalDeviceCommand(DeviceCommandId_t * id) { switch (communicationStep) { 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; break; default: sif::debug << "RwHandler::buildNormalDeviceCommand: Invalid communication step" @@ -61,6 +63,12 @@ ReturnValue_t RwHandler::buildCommandFromCommand(DeviceCommandId_t deviceCommand ReturnValue_t result = RETURN_OK; switch (deviceCommand) { + case (RwDefinitions::RESET_MCU): { + commandBuffer[0] = static_cast(RwDefinitions::RESET_MCU); + rawPacket = commandBuffer; + rawPacketLen = 1; + return RETURN_OK; + } case (RwDefinitions::GET_RW_STATUS): { prepareGetStatusCmd(commandData, commandDataLen); return RETURN_OK; @@ -89,6 +97,9 @@ ReturnValue_t RwHandler::buildCommandFromCommand(DeviceCommandId_t deviceCommand } void RwHandler::fillCommandAndReplyMap() { + this->insertInCommandMap(RwDefinitions::RESET_MCU); + this->insertInCommandAndReplyMap(RwDefinitions::GET_RW_STATUS, 1, &statusSet, + RwDefinitions::SIZE_GET_RW_STATUS); this->insertInCommandAndReplyMap(RwDefinitions::GET_TEMPERATURE, 1, &temperatureSet, RwDefinitions::SIZE_GET_TEMPERATURE_REPLY); this->insertInCommandAndReplyMap(RwDefinitions::SET_SPEED, 1, nullptr, @@ -98,7 +109,7 @@ void RwHandler::fillCommandAndReplyMap() { ReturnValue_t RwHandler::scanForReply(const uint8_t *start, size_t remainingSize, DeviceCommandId_t *foundId, size_t *foundLen) { - switch (*(start + 1)) { + switch (*(start)) { case (static_cast(RwDefinitions::GET_RW_STATUS)): { *foundLen = RwDefinitions::SIZE_GET_RW_STATUS; *foundId = RwDefinitions::GET_RW_STATUS; @@ -129,14 +140,15 @@ ReturnValue_t RwHandler::scanForReply(const uint8_t *start, size_t remainingSize ReturnValue_t RwHandler::interpretDeviceReply(DeviceCommandId_t id, const uint8_t *packet) { /** Check result code */ - if (*(packet + 1) != 0) { + if (*(packet + 1) == RwDefinitions::ERROR) { return EXECUTION_FAILED; } /** Received in little endian byte order */ uint16_t replyCrc = *(packet + sizeOfReply - 1) << 8 | *(packet + sizeOfReply - 2) ; - if (CRC::crc16ccitt(packet, sizeOfReply, 0xFFFF) != replyCrc) { + if (CRC::crc16ccitt(packet, sizeOfReply - 2, 0xFFFF) != replyCrc) { + sif::error << "RwHandler::interpretDeviceReply: cRC error" << std::endl; return CRC_ERROR; } @@ -237,10 +249,12 @@ void RwHandler::prepareSetSpeedCmd(const uint8_t * commandData, size_t commandDa } void RwHandler::handleGetRwStatusReply(const uint8_t* packet) { - uint8_t offset = 0; - statusSet.currSpeed = *(packet + 3) << 24 | *(packet + 2) << 16 | *(packet + 1) << 1 | *packet; + uint8_t offset = 2; + statusSet.currSpeed = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 + | *(packet + offset + 1) << 1 | *(packet + offset); offset += 4; - statusSet.referenceSpeed = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 | *(packet + offset + 1) << 1 | *(packet + offset); + statusSet.referenceSpeed = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 + | *(packet + offset + 1) << 1 | *(packet + offset); offset += 4; statusSet.state = *(packet + offset); offset += 1; @@ -251,16 +265,17 @@ void RwHandler::handleGetRwStatusReply(const uint8_t* packet) { << " * 0.1 RPM" << std::endl; sif::info << "RwHandler::handleGetRwStatusReply: Reference speed is: " << statusSet.referenceSpeed << " * 0.1 RPM" << std::endl; - sif::info << "RwHandler::handleGetRwStatusReply: State is: " << statusSet.state - << " * 0.1 RPM" << std::endl; - sif::info << "RwHandler::handleGetRwStatusReply: clc mode is: " << statusSet.clcMode - << " * 0.1 RPM" << std::endl; + sif::info << "RwHandler::handleGetRwStatusReply: State is: " + << (unsigned int) statusSet.state.value << std::endl; + sif::info << "RwHandler::handleGetRwStatusReply: clc mode is: " + << (unsigned int) statusSet.clcMode.value << std::endl; #endif } void RwHandler::handleTemperatureReply(const uint8_t* packet) { - temperatureSet.temperatureCelcius = *(packet + 3) << 24 | *(packet + 2) << 16 - | *(packet + 1) << 1 | *packet; + uint8_t offset = 2; + temperatureSet.temperatureCelcius = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 + | *(packet + offset + 1) << 1 | *(packet + offset); #if OBSW_VERBOSE_LEVEL >= 1 && RW_DEBUG == 1 sif::info << "RwHandler::handleTemperatureReply: Temperature: " << temperatureSet.temperatureCelcius << " °C" << std::endl; diff --git a/mission/devices/devicedefinitions/RwDefinitions.h b/mission/devices/devicedefinitions/RwDefinitions.h index 23907eb3..4fe2d368 100644 --- a/mission/devices/devicedefinitions/RwDefinitions.h +++ b/mission/devices/devicedefinitions/RwDefinitions.h @@ -18,6 +18,15 @@ enum PoolIds: lp_id_t { CLC_MODE }; +enum States: uint8_t { + ERROR, + IDLE, + COASTING, + RUNNING_SPEED_STABLE, + RUNNING_SPEED_CHANGING +}; + +static const DeviceCommandId_t RESET_MCU = 1; static const DeviceCommandId_t GET_RW_STATUS = 4; static const DeviceCommandId_t SET_SPEED = 6; static const DeviceCommandId_t GET_TEMPERATURE = 8; From e5e3c6cacf90a8dd504e5cb23ac7628b4663be43 Mon Sep 17 00:00:00 2001 From: "Jakob.Meier" Date: Fri, 25 Jun 2021 12:07:33 +0200 Subject: [PATCH 08/26] updated tmtc --- tmtc | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/tmtc b/tmtc index 36582621..3d263737 160000 --- a/tmtc +++ b/tmtc @@ -1 +1 @@ -Subproject commit 36582621f2de1c558aa3909704545e326614d462 +Subproject commit 3d26373726199b0d07f0ce344a184ccd9a0a6041 From ced90934bbd18ab9a3bd2e379eb35559913e4b0e Mon Sep 17 00:00:00 2001 From: "Jakob.Meier" Date: Fri, 25 Jun 2021 12:17:07 +0200 Subject: [PATCH 09/26] added tmtc update --- tmtc | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/tmtc b/tmtc index 3d263737..899cd942 160000 --- a/tmtc +++ b/tmtc @@ -1 +1 @@ -Subproject commit 3d26373726199b0d07f0ce344a184ccd9a0a6041 +Subproject commit 899cd942ce7136f371e93d270a6c6c149c0698cb From ce3fee33e0b23bd3cdb4c2ff2f04ab6a22494474 Mon Sep 17 00:00:00 2001 From: Martin Zietz Date: Fri, 25 Jun 2021 15:25:54 +0200 Subject: [PATCH 10/26] rw handler fixes --- linux/fsfwconfig/OBSWConfig.h.in | 2 ++ .../pollingsequence/pollingSequenceFactory.cpp | 11 +++++++++++ mission/devices/RwHandler.cpp | 12 ++++++------ tmtc | 2 +- 4 files changed, 20 insertions(+), 7 deletions(-) diff --git a/linux/fsfwconfig/OBSWConfig.h.in b/linux/fsfwconfig/OBSWConfig.h.in index b3002cf4..ce1a7526 100644 --- a/linux/fsfwconfig/OBSWConfig.h.in +++ b/linux/fsfwconfig/OBSWConfig.h.in @@ -20,6 +20,7 @@ debugging. */ #define OBSW_PRINT_MISSED_DEADLINES 1 #define OBSW_ADD_TEST_CODE 1 #define OBSW_ADD_TEST_PST 1 +#define OBSW_ADD_GPS 0 #define TEST_LIBGPIOD 0 #define TEST_RADIATION_SENSOR_HANDLER 0 @@ -43,6 +44,7 @@ debugging. */ #define DEBUG_SUS 1 #define DEBUG_RTD 1 #define IMTQ_DEBUG 1 +#define RW_DEBUG 1 // Leave at one as the BSP is linux. Used by the ADIS16507 device handler #define OBSW_ADIS16507_LINUX_COM_IF 1 diff --git a/linux/fsfwconfig/pollingsequence/pollingSequenceFactory.cpp b/linux/fsfwconfig/pollingsequence/pollingSequenceFactory.cpp index 6ba4083d..9bb73857 100644 --- a/linux/fsfwconfig/pollingsequence/pollingSequenceFactory.cpp +++ b/linux/fsfwconfig/pollingsequence/pollingSequenceFactory.cpp @@ -432,50 +432,61 @@ ReturnValue_t pst::pstI2c(FixedTimeslotTaskIF *thisSequence) { ReturnValue_t pst::pstUart(FixedTimeslotTaskIF *thisSequence) { // Length of a communication cycle uint32_t length = thisSequence->getPeriodMs(); + thisSequence->addSlot(objects::PLOC_HANDLER, length * 0, DeviceHandlerIF::PERFORM_OPERATION); thisSequence->addSlot(objects::SYRLINKS_HK_HANDLER, length * 0, DeviceHandlerIF::PERFORM_OPERATION); +#if OBSW_ADD_GPS == 1 thisSequence->addSlot(objects::GPS0_HANDLER, length * 0, DeviceHandlerIF::PERFORM_OPERATION); thisSequence->addSlot(objects::GPS1_HANDLER, length * 0, DeviceHandlerIF::PERFORM_OPERATION); +#endif thisSequence->addSlot(objects::PLOC_HANDLER, length * 0.2, DeviceHandlerIF::SEND_WRITE); thisSequence->addSlot(objects::SYRLINKS_HK_HANDLER, length * 0.2, DeviceHandlerIF::SEND_WRITE); +#if OBSW_ADD_GPS == 1 thisSequence->addSlot(objects::GPS0_HANDLER, length * 0.2, DeviceHandlerIF::SEND_WRITE); thisSequence->addSlot(objects::GPS1_HANDLER, length * 0.2, DeviceHandlerIF::SEND_WRITE); +#endif thisSequence->addSlot(objects::PLOC_HANDLER, length * 0.4, DeviceHandlerIF::GET_WRITE); thisSequence->addSlot(objects::SYRLINKS_HK_HANDLER, length * 0.4, DeviceHandlerIF::GET_WRITE); +#if OBSW_ADD_GPS == 1 thisSequence->addSlot(objects::GPS0_HANDLER, length * 0.4, DeviceHandlerIF::GET_WRITE); thisSequence->addSlot(objects::GPS1_HANDLER, length * 0.4, DeviceHandlerIF::GET_WRITE); +#endif thisSequence->addSlot(objects::PLOC_HANDLER, length * 0.6, DeviceHandlerIF::SEND_READ); thisSequence->addSlot(objects::SYRLINKS_HK_HANDLER, length * 0.6, DeviceHandlerIF::SEND_READ); +#if OBSW_ADD_GPS == 1 thisSequence->addSlot(objects::GPS0_HANDLER, length * 0.6, DeviceHandlerIF::SEND_READ); thisSequence->addSlot(objects::GPS1_HANDLER, length * 0.6, DeviceHandlerIF::SEND_READ); +#endif thisSequence->addSlot(objects::PLOC_HANDLER, length * 0.8, DeviceHandlerIF::GET_READ); thisSequence->addSlot(objects::SYRLINKS_HK_HANDLER, length * 0.8, DeviceHandlerIF::GET_READ); +#if OBSW_ADD_GPS == 1 thisSequence->addSlot(objects::GPS0_HANDLER, length * 0.8, DeviceHandlerIF::GET_READ); thisSequence->addSlot(objects::GPS1_HANDLER, length * 0.8, DeviceHandlerIF::GET_READ); +#endif if (thisSequence->checkSequence() != HasReturnvaluesIF::RETURN_OK) { sif::error << "UART PST initialization failed" << std::endl; diff --git a/mission/devices/RwHandler.cpp b/mission/devices/RwHandler.cpp index 23c49eba..a9d9dde3 100644 --- a/mission/devices/RwHandler.cpp +++ b/mission/devices/RwHandler.cpp @@ -208,7 +208,7 @@ ReturnValue_t RwHandler::checkSpeedAndRampTime(const uint8_t* commandData, size_ return INVALID_SPEED; } - uint16_t rampTime = *commandData << 8 | *(commandData + 1); + uint16_t rampTime = *(commandData + 4) << 8 | *(commandData + 5); if (rampTime < 10 || rampTime > 10000) { sif::error << "RwHandler::checkSpeedAndRampTime: Command has invalid ramp time" @@ -238,8 +238,8 @@ void RwHandler::prepareSetSpeedCmd(const uint8_t * commandData, size_t commandDa commandBuffer[3] = *(commandData + 1); commandBuffer[4] = *commandData; /** Ramp time (ms) */ - commandBuffer[5] = *(commandData + 1); - commandBuffer[6] = *commandData; + commandBuffer[5] = *(commandData + 5); + commandBuffer[6] = *(commandData + 4); uint16_t crc = CRC::crc16ccitt(commandBuffer, 7, 0xFFFF); commandBuffer[7] = static_cast(crc & 0xFF); @@ -251,10 +251,10 @@ void RwHandler::prepareSetSpeedCmd(const uint8_t * commandData, size_t commandDa void RwHandler::handleGetRwStatusReply(const uint8_t* packet) { uint8_t offset = 2; statusSet.currSpeed = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 - | *(packet + offset + 1) << 1 | *(packet + offset); + | *(packet + offset + 1) << 8 | *(packet + offset); offset += 4; statusSet.referenceSpeed = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 - | *(packet + offset + 1) << 1 | *(packet + offset); + | *(packet + offset + 1) << 8 | *(packet + offset); offset += 4; statusSet.state = *(packet + offset); offset += 1; @@ -275,7 +275,7 @@ void RwHandler::handleGetRwStatusReply(const uint8_t* packet) { void RwHandler::handleTemperatureReply(const uint8_t* packet) { uint8_t offset = 2; temperatureSet.temperatureCelcius = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 - | *(packet + offset + 1) << 1 | *(packet + offset); + | *(packet + offset + 1) << 8 | *(packet + offset); #if OBSW_VERBOSE_LEVEL >= 1 && RW_DEBUG == 1 sif::info << "RwHandler::handleTemperatureReply: Temperature: " << temperatureSet.temperatureCelcius << " °C" << std::endl; diff --git a/tmtc b/tmtc index 899cd942..19b76d96 160000 --- a/tmtc +++ b/tmtc @@ -1 +1 @@ -Subproject commit 899cd942ce7136f371e93d270a6c6c149c0698cb +Subproject commit 19b76d961c61966a0093d3768f62d99196e1c9b2 From 0139df43714c1a130259e81984d394ece1f5511b Mon Sep 17 00:00:00 2001 From: "Jakob.Meier" Date: Fri, 25 Jun 2021 15:47:33 +0200 Subject: [PATCH 11/26] modified rw definitions --- mission/devices/devicedefinitions/RwDefinitions.h | 2 ++ 1 file changed, 2 insertions(+) diff --git a/mission/devices/devicedefinitions/RwDefinitions.h b/mission/devices/devicedefinitions/RwDefinitions.h index 4fe2d368..e07e01b0 100644 --- a/mission/devices/devicedefinitions/RwDefinitions.h +++ b/mission/devices/devicedefinitions/RwDefinitions.h @@ -27,6 +27,8 @@ enum States: uint8_t { }; static const DeviceCommandId_t RESET_MCU = 1; +static const DeviceCommandId_t GET_LAST_RESET_STATUS = 2; +static const DeviceCommandId_t CLEAR_LAST_RESET_STATUS = 3; static const DeviceCommandId_t GET_RW_STATUS = 4; static const DeviceCommandId_t SET_SPEED = 6; static const DeviceCommandId_t GET_TEMPERATURE = 8; From 7c8127714e33fc7ddfecfe33e66c30cf92fd1bf9 Mon Sep 17 00:00:00 2001 From: "Jakob.Meier" Date: Fri, 25 Jun 2021 16:00:32 +0200 Subject: [PATCH 12/26] added init command --- mission/devices/RwHandler.cpp | 17 ++++++++++++++++- mission/devices/RwHandler.h | 7 +++++++ .../devices/devicedefinitions/RwDefinitions.h | 1 + tmtc | 2 +- 4 files changed, 25 insertions(+), 2 deletions(-) diff --git a/mission/devices/RwHandler.cpp b/mission/devices/RwHandler.cpp index a9d9dde3..7254ee0e 100644 --- a/mission/devices/RwHandler.cpp +++ b/mission/devices/RwHandler.cpp @@ -55,7 +55,8 @@ ReturnValue_t RwHandler::buildNormalDeviceCommand(DeviceCommandId_t * id) { } ReturnValue_t RwHandler::buildTransitionDeviceCommand(DeviceCommandId_t * id) { - return RETURN_OK; + *id = RwDefinitions::INIT_RW_CONTROLLER; + return buildCommandFromCommand(*id, nullptr, 0);; } ReturnValue_t RwHandler::buildCommandFromCommand(DeviceCommandId_t deviceCommand, @@ -73,6 +74,10 @@ ReturnValue_t RwHandler::buildCommandFromCommand(DeviceCommandId_t deviceCommand prepareGetStatusCmd(commandData, commandDataLen); return RETURN_OK; } + case (RwDefinitions::INIT_RW_CONTROLLER): { + prepareInitRwCommand(); + return RETURN_OK; + } case (RwDefinitions::SET_SPEED): { if (commandDataLen != 6) { sif::error << "RwHandler::buildCommandFromCommand: Received set speed command with" @@ -100,6 +105,7 @@ void RwHandler::fillCommandAndReplyMap() { this->insertInCommandMap(RwDefinitions::RESET_MCU); this->insertInCommandAndReplyMap(RwDefinitions::GET_RW_STATUS, 1, &statusSet, RwDefinitions::SIZE_GET_RW_STATUS); + this->insertInCommandMap(RwDefinitions::INIT_RW_CONTROLLER); this->insertInCommandAndReplyMap(RwDefinitions::GET_TEMPERATURE, 1, &temperatureSet, RwDefinitions::SIZE_GET_TEMPERATURE_REPLY); this->insertInCommandAndReplyMap(RwDefinitions::SET_SPEED, 1, nullptr, @@ -228,6 +234,15 @@ void RwHandler::prepareGetTemperatureCmd() { rawPacketLen = 3; } +void RwHandler::prepareInitRwCommand() { + commandBuffer[0] = static_cast(RwDefinitions::INIT_RW_CONTROLLER); + uint16_t crc = CRC::crc16ccitt(commandBuffer, 1, 0xFFFF); + commandBuffer[1] = static_cast(crc & 0xFF); + commandBuffer[2] = static_cast(crc >> 8 & 0xFF); + rawPacket = commandBuffer; + rawPacketLen = 3; +} + void RwHandler::prepareSetSpeedCmd(const uint8_t * commandData, size_t commandDataLen) { commandBuffer[0] = static_cast(RwDefinitions::SET_SPEED); diff --git a/mission/devices/RwHandler.h b/mission/devices/RwHandler.h index 0a9d58d0..fcde9c81 100644 --- a/mission/devices/RwHandler.h +++ b/mission/devices/RwHandler.h @@ -121,6 +121,13 @@ private: */ void prepareGetTemperatureCmd(); + /** + * @brief This function fills the commandBuffer with the data to request initialize the + * reaction wheel controller. This command must be sent as soon as the state of a + * reaction wheel is equal to 1 which indicates an error. + */ + void prepareInitRwCommand(); + /** * @brief This function handles the reply of the get temperature command. * diff --git a/mission/devices/devicedefinitions/RwDefinitions.h b/mission/devices/devicedefinitions/RwDefinitions.h index e07e01b0..a38b0acf 100644 --- a/mission/devices/devicedefinitions/RwDefinitions.h +++ b/mission/devices/devicedefinitions/RwDefinitions.h @@ -30,6 +30,7 @@ static const DeviceCommandId_t RESET_MCU = 1; static const DeviceCommandId_t GET_LAST_RESET_STATUS = 2; static const DeviceCommandId_t CLEAR_LAST_RESET_STATUS = 3; static const DeviceCommandId_t GET_RW_STATUS = 4; +static const DeviceCommandId_t INIT_RW_CONTROLLER = 5; static const DeviceCommandId_t SET_SPEED = 6; static const DeviceCommandId_t GET_TEMPERATURE = 8; diff --git a/tmtc b/tmtc index 19b76d96..899cd942 160000 --- a/tmtc +++ b/tmtc @@ -1 +1 @@ -Subproject commit 19b76d961c61966a0093d3768f62d99196e1c9b2 +Subproject commit 899cd942ce7136f371e93d270a6c6c149c0698cb From 8ef9760f78b283d53ac94512b9f9556c63e3099c Mon Sep 17 00:00:00 2001 From: "Jakob.Meier" Date: Mon, 28 Jun 2021 08:57:37 +0200 Subject: [PATCH 13/26] added get reset and clear reset command to rw handler --- mission/devices/RwHandler.cpp | 90 ++++++++++++++++--- mission/devices/RwHandler.h | 37 +++++++- .../devices/devicedefinitions/RwDefinitions.h | 26 +++++- 3 files changed, 137 insertions(+), 16 deletions(-) diff --git a/mission/devices/RwHandler.cpp b/mission/devices/RwHandler.cpp index 7254ee0e..83a136b8 100644 --- a/mission/devices/RwHandler.cpp +++ b/mission/devices/RwHandler.cpp @@ -7,7 +7,7 @@ RwHandler::RwHandler(object_id_t objectId, object_id_t comIF, CookieIF * comCookie, LinuxLibgpioIF* gpioComIF, gpioId_t enableGpio) : DeviceHandlerBase(objectId, comIF, comCookie), gpioComIF(gpioComIF), enableGpio(enableGpio), - temperatureSet(this), statusSet(this) { + temperatureSet(this), statusSet(this), lastResetStatusSet(this) { if (comCookie == NULL) { sif::error << "RwHandler: Invalid com cookie" << std::endl; } @@ -20,6 +20,9 @@ RwHandler::~RwHandler() { } void RwHandler::doStartUp() { + if (!startupPerformed) { + return; + } if(gpioComIF->pullHigh(enableGpio) != RETURN_OK) { sif::debug << "RwHandler::doStartUp: Failed to pull enable gpio to high"; } @@ -34,6 +37,7 @@ void RwHandler::doShutDown() { if(gpioComIF->pullLow(enableGpio) != RETURN_OK) { sif::debug << "RwHandler::doStartUp: Failed to pull enable gpio to low"; } + startupPerformed = false; } ReturnValue_t RwHandler::buildNormalDeviceCommand(DeviceCommandId_t * id) { @@ -55,7 +59,25 @@ ReturnValue_t RwHandler::buildNormalDeviceCommand(DeviceCommandId_t * id) { } ReturnValue_t RwHandler::buildTransitionDeviceCommand(DeviceCommandId_t * id) { - *id = RwDefinitions::INIT_RW_CONTROLLER; + switch (startupStep) { + case StartupStep::GET_RESET_STATUS: + *id = RwDefinitions::GET_LAST_RESET_STATUS; + startupStep = StartupStep::CLEAR_RESET_STATUS; + break; + case StartupStep::CLEAR_RESET_STATUS: + *id = RwDefinitions::CLEAR_LAST_RESET_STATUS; + startupStep = StartupStep::INIT_RW; + break; + case StartupStep::INIT_RW: + *id = RwDefinitions::INIT_RW_CONTROLLER; + startupStep = StartupStep::GET_RESET_STATUS; + startupPerformed = true; + break; + default: + sif::debug << "RwHandler::buildTransitionDeviceCommand: Invalid startup step" + << std::endl; + break; + } return buildCommandFromCommand(*id, nullptr, 0);; } @@ -70,6 +92,14 @@ ReturnValue_t RwHandler::buildCommandFromCommand(DeviceCommandId_t deviceCommand rawPacketLen = 1; return RETURN_OK; } + case (RwDefinitions::GET_LAST_RESET_STATUS): { + prepareGetLastResetStatusCommand(); + return RETURN_OK; + } + case (RwDefinitions::CLEAR_LAST_RESET_STATUS): { + prepareClearResetStatusCommand(); + return RETURN_OK; + } case (RwDefinitions::GET_RW_STATUS): { prepareGetStatusCmd(commandData, commandDataLen); return RETURN_OK; @@ -103,6 +133,9 @@ ReturnValue_t RwHandler::buildCommandFromCommand(DeviceCommandId_t deviceCommand void RwHandler::fillCommandAndReplyMap() { this->insertInCommandMap(RwDefinitions::RESET_MCU); + this->insertInCommandAndReplyMap(RwDefinitions::GET_LAST_RESET_STATUS, 1, &lastResetStatusSet, + RwDefinitions::SIZE_GET_RESET_STATUS); + this->insertInCommandMap(RwDefinitions::CLEAR_LAST_RESET_STATUS); this->insertInCommandAndReplyMap(RwDefinitions::GET_RW_STATUS, 1, &statusSet, RwDefinitions::SIZE_GET_RW_STATUS); this->insertInCommandMap(RwDefinitions::INIT_RW_CONTROLLER); @@ -116,6 +149,11 @@ ReturnValue_t RwHandler::scanForReply(const uint8_t *start, size_t remainingSize DeviceCommandId_t *foundId, size_t *foundLen) { switch (*(start)) { + case (static_cast(RwDefinitions::GET_LAST_RESET_STATUS)): { + *foundLen = RwDefinitions::SIZE_GET_RESET_STATUS; + *foundId = RwDefinitions::GET_LAST_RESET_STATUS; + break; + } case (static_cast(RwDefinitions::GET_RW_STATUS)): { *foundLen = RwDefinitions::SIZE_GET_RW_STATUS; *foundId = RwDefinitions::GET_RW_STATUS; @@ -159,6 +197,10 @@ ReturnValue_t RwHandler::interpretDeviceReply(DeviceCommandId_t id, const uint8_ } switch (id) { + case (RwDefinitions::GET_LAST_RESET_STATUS): { + handleResetStatusReply(packet); + break; + } case (RwDefinitions::GET_RW_STATUS): { handleGetRwStatusReply(packet); break; @@ -195,6 +237,24 @@ ReturnValue_t RwHandler::initializeLocalDataPool(localpool::DataPool& localDataP return RETURN_OK; } +void RwHandler::prepareGetLastResetStatusCommand() { + commandBuffer[0] = static_cast(RwDefinitions::GET_LAST_RESET_STATUS); + uint16_t crc = CRC::crc16ccitt(commandBuffer, 1, 0xFFFF); + commandBuffer[1] = static_cast(crc & 0xFF); + commandBuffer[2] = static_cast(crc >> 8 & 0xFF); + rawPacket = commandBuffer; + rawPacketLen = 3; +} + +void RwHandler::prepareClearResetStatusCommand() { + commandBuffer[0] = static_cast(RwDefinitions::CLEAR_LAST_RESET_STATUS); + uint16_t crc = CRC::crc16ccitt(commandBuffer, 1, 0xFFFF); + commandBuffer[1] = static_cast(crc & 0xFF); + commandBuffer[2] = static_cast(crc >> 8 & 0xFF); + rawPacket = commandBuffer; + rawPacketLen = 3; +} + void RwHandler::prepareGetStatusCmd(const uint8_t * commandData, size_t commandDataLen) { commandBuffer[0] = static_cast(RwDefinitions::GET_RW_STATUS); @@ -225,15 +285,6 @@ ReturnValue_t RwHandler::checkSpeedAndRampTime(const uint8_t* commandData, size_ return RETURN_OK; } -void RwHandler::prepareGetTemperatureCmd() { - commandBuffer[0] = static_cast(RwDefinitions::GET_TEMPERATURE); - uint16_t crc = CRC::crc16ccitt(commandBuffer, 1, 0xFFFF); - commandBuffer[1] = static_cast(crc & 0xFF); - commandBuffer[2] = static_cast(crc >> 8 & 0xFF); - rawPacket = commandBuffer; - rawPacketLen = 3; -} - void RwHandler::prepareInitRwCommand() { commandBuffer[0] = static_cast(RwDefinitions::INIT_RW_CONTROLLER); uint16_t crc = CRC::crc16ccitt(commandBuffer, 1, 0xFFFF); @@ -243,6 +294,14 @@ void RwHandler::prepareInitRwCommand() { rawPacketLen = 3; } +void RwHandler::prepareGetTemperatureCmd() { + commandBuffer[0] = static_cast(RwDefinitions::GET_TEMPERATURE); + uint16_t crc = CRC::crc16ccitt(commandBuffer, 1, 0xFFFF); + commandBuffer[1] = static_cast(crc & 0xFF); + commandBuffer[2] = static_cast(crc >> 8 & 0xFF); + rawPacket = commandBuffer; + rawPacketLen = 3; +} void RwHandler::prepareSetSpeedCmd(const uint8_t * commandData, size_t commandDataLen) { commandBuffer[0] = static_cast(RwDefinitions::SET_SPEED); @@ -263,6 +322,15 @@ void RwHandler::prepareSetSpeedCmd(const uint8_t * commandData, size_t commandDa rawPacketLen = 9; } +void RwHandler::handleResetStatusReply(const uint8_t* packet) { + uint8_t offset = 2; + lastResetStatusSet.lastResetStatus = *(packet + offset); +#if OBSW_VERBOSE_LEVEL >= 1 && RW_DEBUG == 1 + sif::info << "RwHandler::handleResetStatusReply: Last reset status: " + << static_cast(lastResetStatusSet.lastResetStatus.value) << std::endl; +#endif +} + void RwHandler::handleGetRwStatusReply(const uint8_t* packet) { uint8_t offset = 2; statusSet.currSpeed = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 diff --git a/mission/devices/RwHandler.h b/mission/devices/RwHandler.h index fcde9c81..29a2ae52 100644 --- a/mission/devices/RwHandler.h +++ b/mission/devices/RwHandler.h @@ -84,6 +84,7 @@ private: RwDefinitions::TemperatureSet temperatureSet; RwDefinitions::StatusSet statusSet; + RwDefinitions::LastResetSatus lastResetStatusSet; uint8_t commandBuffer[RwDefinitions::MAX_CMD_SIZE]; @@ -95,8 +96,28 @@ private: CommunicationStep communicationStep = CommunicationStep::READ_TEMPERATURE; + enum class StartupStep { + GET_RESET_STATUS, + CLEAR_RESET_STATUS, + INIT_RW + }; + + StartupStep startupStep = StartupStep::GET_RESET_STATUS; + size_t sizeOfReply = 0; + bool startupPerformed = false; + + /** + * @brief This function prepares the command to request the last reset status + */ + void prepareGetLastResetStatusCommand(); + + /** + * @brief Fills the command buffer with the command to clear the reset status. + */ + void prepareClearResetStatusCommand(); + /** * @brief This function prepares the send buffer with the data to request the status of * the reaction wheel. @@ -110,6 +131,13 @@ private: */ ReturnValue_t checkSpeedAndRampTime(const uint8_t * commandData, size_t commandDataLen); + /** + * @brief This function fills the commandBuffer with the data to request initialize the + * reaction wheel controller. This command must be sent as soon as the state of a + * reaction wheel is equal to 1 which indicates an error. + */ + void prepareInitRwCommand(); + /** * @brief This function prepares the set speed command from the commandData received with * an action message. @@ -122,11 +150,12 @@ private: void prepareGetTemperatureCmd(); /** - * @brief This function fills the commandBuffer with the data to request initialize the - * reaction wheel controller. This command must be sent as soon as the state of a - * reaction wheel is equal to 1 which indicates an error. + * @brief This function writes the last reset status retrieved with the get last reset status + * command into the reset status dataset. + * + * @param packet Pointer to the buffer holding the reply data. */ - void prepareInitRwCommand(); + void handleResetStatusReply(const uint8_t* packet); /** * @brief This function handles the reply of the get temperature command. diff --git a/mission/devices/devicedefinitions/RwDefinitions.h b/mission/devices/devicedefinitions/RwDefinitions.h index a38b0acf..73de0e57 100644 --- a/mission/devices/devicedefinitions/RwDefinitions.h +++ b/mission/devices/devicedefinitions/RwDefinitions.h @@ -15,7 +15,8 @@ enum PoolIds: lp_id_t { CURR_SPEED, REFERENCE_SPEED, STATE, - CLC_MODE + CLC_MODE, + LAST_RESET_STATUS }; enum States: uint8_t { @@ -30,13 +31,16 @@ static const DeviceCommandId_t RESET_MCU = 1; static const DeviceCommandId_t GET_LAST_RESET_STATUS = 2; static const DeviceCommandId_t CLEAR_LAST_RESET_STATUS = 3; static const DeviceCommandId_t GET_RW_STATUS = 4; +/** This command is needed to recover from error state */ static const DeviceCommandId_t INIT_RW_CONTROLLER = 5; static const DeviceCommandId_t SET_SPEED = 6; static const DeviceCommandId_t GET_TEMPERATURE = 8; static const uint32_t TEMPERATURE_SET_ID = GET_TEMPERATURE; static const uint32_t STATUS_SET_ID = GET_RW_STATUS; +static const uint32_t LAST_RESET_ID = GET_LAST_RESET_STATUS; +static const size_t SIZE_GET_RESET_STATUS = 5; static const size_t SIZE_GET_RW_STATUS = 14; static const size_t SIZE_SET_SPEED_REPLY = 4; static const size_t SIZE_GET_TEMPERATURE_REPLY = 8; @@ -47,6 +51,7 @@ static const size_t SIZE_GET_TELEMETRY_REPLY = 83; static const size_t MAX_CMD_SIZE = 9; static const size_t MAX_REPLY_SIZE = SIZE_GET_TELEMETRY_REPLY; +static const uint8_t LAST_RESET_ENTRIES = 1; static const uint8_t TEMPERATURE_SET_ENTRIES = 1; static const uint8_t STATUS_SET_ENTRIES = 4; @@ -94,6 +99,25 @@ public: PoolIds::CLC_MODE, this); }; +/** + * @brief This dataset stores the last reset status. + */ +class LastResetSatus: + public StaticLocalDataSet { +public: + + LastResetSatus(HasLocalDataPoolIF* owner): + StaticLocalDataSet(owner, LAST_RESET_ID) { + } + + LastResetSatus(object_id_t objectId): + StaticLocalDataSet(sid_t(objectId, LAST_RESET_ID)) { + } + + lp_var_t lastResetStatus = lp_var_t(sid.objectId, + PoolIds::LAST_RESET_STATUS, this); +}; + } #endif /* MISSION_DEVICES_DEVICEDEFINITIONS_RWDEFINITIONS_H_ */ From 516ef34b21a0f563418729c23b64f421ecd3467e Mon Sep 17 00:00:00 2001 From: "Jakob.Meier" Date: Mon, 28 Jun 2021 09:31:10 +0200 Subject: [PATCH 14/26] added periodically polling of reset status in rw handler --- mission/devices/RwHandler.cpp | 6 +++++- mission/devices/RwHandler.h | 1 + 2 files changed, 6 insertions(+), 1 deletion(-) 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 }; From 23731e367c410ae958c000fcd96828e6d0826bf9 Mon Sep 17 00:00:00 2001 From: Martin Zietz Date: Mon, 28 Jun 2021 14:07:37 +0200 Subject: [PATCH 15/26] added second reaction wheel --- bsp_q7s/ObjectFactory.cpp | 16 ++++- bsp_q7s/spiCallbacks/rwSpiCallback.cpp | 4 +- .../pollingSequenceFactory.cpp | 6 ++ mission/devices/RwHandler.cpp | 67 +++++++++++++------ mission/devices/RwHandler.h | 9 ++- .../devices/devicedefinitions/RwDefinitions.h | 2 + tmtc | 2 +- 7 files changed, 76 insertions(+), 30 deletions(-) diff --git a/bsp_q7s/ObjectFactory.cpp b/bsp_q7s/ObjectFactory.cpp index 7507b5e6..8229536b 100644 --- a/bsp_q7s/ObjectFactory.cpp +++ b/bsp_q7s/ObjectFactory.cpp @@ -582,12 +582,26 @@ void ObjectFactory::produce(void* args){ auto rw1SpiCookie = new SpiCookie(addresses::RW1, gpioIds::CS_RW1, "/dev/spidev2.0", RwDefinitions::MAX_REPLY_SIZE, spi::RW_MODE, spi::RW_SPEED, &rwSpiCallback, nullptr); + auto rw2SpiCookie = new SpiCookie(addresses::RW2, gpioIds::CS_RW2, "/dev/spidev2.0", + RwDefinitions::MAX_REPLY_SIZE, spi::RW_MODE, spi::RW_SPEED, &rwSpiCallback, nullptr); + auto rw3SpiCookie = new SpiCookie(addresses::RW3, gpioIds::CS_RW3, "/dev/spidev2.0", + RwDefinitions::MAX_REPLY_SIZE, spi::RW_MODE, spi::RW_SPEED, &rwSpiCallback, nullptr); + auto rw4SpiCookie = new SpiCookie(addresses::RW4, gpioIds::CS_RW4, "/dev/spidev2.0", + RwDefinitions::MAX_REPLY_SIZE, spi::RW_MODE, spi::RW_SPEED, &rwSpiCallback, nullptr); + (void) rw3SpiCookie; + (void) rw4SpiCookie; auto rwHandler1 = new RwHandler(objects::RW1, objects::SPI_COM_IF, rw1SpiCookie, gpioComIF, gpioIds::EN_RW1); - rwHandler1->setStartUpImmediately(); + (void) rwHandler1; +// rwHandler1->setStartUpImmediately(); rw1SpiCookie->setCallbackArgs(rwHandler1); + auto rwHandler2 = new RwHandler(objects::RW2, objects::SPI_COM_IF, rw2SpiCookie, gpioComIF, + gpioIds::EN_RW1); + rwHandler2->setStartUpImmediately(); + rw2SpiCookie->setCallbackArgs(rwHandler2); + #endif /* TE0720 == 0 */ new UdpTmTcBridge(objects::UDP_BRIDGE, objects::CCSDS_PACKET_DISTRIBUTOR); diff --git a/bsp_q7s/spiCallbacks/rwSpiCallback.cpp b/bsp_q7s/spiCallbacks/rwSpiCallback.cpp index 41ba70d9..bfb1892c 100644 --- a/bsp_q7s/spiCallbacks/rwSpiCallback.cpp +++ b/bsp_q7s/spiCallbacks/rwSpiCallback.cpp @@ -93,7 +93,7 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s idx++; } - /** Sending frame start sign */ + /** Sending frame end sign */ writeBuffer[0] = 0x7E; writeSize = 1; @@ -155,7 +155,7 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s /** Reached end of frame */ break; } - else if (byteRead == 0xD) { + else if (byteRead == 0x7D) { if(read(fileDescriptor, &byteRead, 1) != 1) { sif::error << "rwSpiCallback: Read failed" << std::endl; result = RwHandler::SPI_READ_FAILURE; diff --git a/linux/fsfwconfig/pollingsequence/pollingSequenceFactory.cpp b/linux/fsfwconfig/pollingsequence/pollingSequenceFactory.cpp index 9bb73857..35f38919 100644 --- a/linux/fsfwconfig/pollingsequence/pollingSequenceFactory.cpp +++ b/linux/fsfwconfig/pollingsequence/pollingSequenceFactory.cpp @@ -407,6 +407,12 @@ ReturnValue_t pst::pstSpi(FixedTimeslotTaskIF *thisSequence) { thisSequence->addSlot(objects::RW1, length * 0.6, DeviceHandlerIF::SEND_READ); thisSequence->addSlot(objects::RW1, length * 0.8, DeviceHandlerIF::GET_READ); + thisSequence->addSlot(objects::RW2, length * 0, DeviceHandlerIF::PERFORM_OPERATION); + thisSequence->addSlot(objects::RW2, length * 0.2, DeviceHandlerIF::SEND_WRITE); + thisSequence->addSlot(objects::RW2, length * 0.4, DeviceHandlerIF::GET_WRITE); + thisSequence->addSlot(objects::RW2, length * 0.6, DeviceHandlerIF::SEND_READ); + thisSequence->addSlot(objects::RW2, length * 0.8, DeviceHandlerIF::GET_READ); + if (thisSequence->checkSequence() != HasReturnvaluesIF::RETURN_OK) { sif::error << "SPI PST initialization failed" << std::endl; return HasReturnvaluesIF::RETURN_FAILED; diff --git a/mission/devices/RwHandler.cpp b/mission/devices/RwHandler.cpp index 7d84bfcf..c789fb64 100644 --- a/mission/devices/RwHandler.cpp +++ b/mission/devices/RwHandler.cpp @@ -20,12 +20,19 @@ RwHandler::~RwHandler() { } void RwHandler::doStartUp() { - if (!startupPerformed) { - return; - } - if(gpioComIF->pullHigh(enableGpio) != RETURN_OK) { - sif::debug << "RwHandler::doStartUp: Failed to pull enable gpio to high"; + switch (startupStep) { + case StartupStep::ENABLE_RW: { + if(gpioComIF->pullHigh(enableGpio) != RETURN_OK) { + sif::debug << "RwHandler::doStartUp: Failed to pull enable gpio to high"; + } + return; } + case StartupStep::STARTUP_COMPLETE: + break; + default: + return; + } + #if OBSW_SWITCH_TO_NORMAL_MODE_AFTER_STARTUP == 1 setMode(MODE_NORMAL); #else @@ -37,7 +44,8 @@ void RwHandler::doShutDown() { if(gpioComIF->pullLow(enableGpio) != RETURN_OK) { sif::debug << "RwHandler::doStartUp: Failed to pull enable gpio to low"; } - startupPerformed = false; + /** Reset startup step for next doStartUp routine */ + startupStep = StartupStep::ENABLE_RW; } ReturnValue_t RwHandler::buildNormalDeviceCommand(DeviceCommandId_t * id) { @@ -64,7 +72,7 @@ ReturnValue_t RwHandler::buildNormalDeviceCommand(DeviceCommandId_t * id) { ReturnValue_t RwHandler::buildTransitionDeviceCommand(DeviceCommandId_t * id) { switch (startupStep) { - case StartupStep::GET_RESET_STATUS: + case StartupStep::ENABLE_RW: *id = RwDefinitions::GET_LAST_RESET_STATUS; startupStep = StartupStep::CLEAR_RESET_STATUS; break; @@ -74,9 +82,10 @@ ReturnValue_t RwHandler::buildTransitionDeviceCommand(DeviceCommandId_t * id) { break; case StartupStep::INIT_RW: *id = RwDefinitions::INIT_RW_CONTROLLER; - startupStep = StartupStep::GET_RESET_STATUS; - startupPerformed = true; + startupStep = StartupStep::STARTUP_COMPLETE; break; + case StartupStep::STARTUP_COMPLETE: + break; default: sif::debug << "RwHandler::buildTransitionDeviceCommand: Invalid startup step" << std::endl; @@ -136,17 +145,19 @@ ReturnValue_t RwHandler::buildCommandFromCommand(DeviceCommandId_t deviceCommand } void RwHandler::fillCommandAndReplyMap() { - this->insertInCommandMap(RwDefinitions::RESET_MCU); - this->insertInCommandAndReplyMap(RwDefinitions::GET_LAST_RESET_STATUS, 1, &lastResetStatusSet, - RwDefinitions::SIZE_GET_RESET_STATUS); - this->insertInCommandMap(RwDefinitions::CLEAR_LAST_RESET_STATUS); - this->insertInCommandAndReplyMap(RwDefinitions::GET_RW_STATUS, 1, &statusSet, - RwDefinitions::SIZE_GET_RW_STATUS); - this->insertInCommandMap(RwDefinitions::INIT_RW_CONTROLLER); - this->insertInCommandAndReplyMap(RwDefinitions::GET_TEMPERATURE, 1, &temperatureSet, - RwDefinitions::SIZE_GET_TEMPERATURE_REPLY); - this->insertInCommandAndReplyMap(RwDefinitions::SET_SPEED, 1, nullptr, - RwDefinitions::SIZE_SET_SPEED_REPLY); + this->insertInCommandMap(RwDefinitions::RESET_MCU); + this->insertInCommandAndReplyMap(RwDefinitions::GET_LAST_RESET_STATUS, 1, &lastResetStatusSet, + RwDefinitions::SIZE_GET_RESET_STATUS); + this->insertInCommandAndReplyMap(RwDefinitions::CLEAR_LAST_RESET_STATUS, 1, nullptr, + RwDefinitions::SIZE_CLEAR_RESET_STATUS); + this->insertInCommandAndReplyMap(RwDefinitions::GET_RW_STATUS, 1, &statusSet, + RwDefinitions::SIZE_GET_RW_STATUS); + this->insertInCommandAndReplyMap(RwDefinitions::INIT_RW_CONTROLLER, 1, nullptr, + RwDefinitions::SIZE_INIT_RW); + this->insertInCommandAndReplyMap(RwDefinitions::GET_TEMPERATURE, 1, &temperatureSet, + RwDefinitions::SIZE_GET_TEMPERATURE_REPLY); + this->insertInCommandAndReplyMap(RwDefinitions::SET_SPEED, 1, nullptr, + RwDefinitions::SIZE_SET_SPEED_REPLY); } ReturnValue_t RwHandler::scanForReply(const uint8_t *start, size_t remainingSize, @@ -158,11 +169,21 @@ ReturnValue_t RwHandler::scanForReply(const uint8_t *start, size_t remainingSize *foundId = RwDefinitions::GET_LAST_RESET_STATUS; break; } + case (static_cast(RwDefinitions::CLEAR_LAST_RESET_STATUS)): { + *foundLen = RwDefinitions::SIZE_CLEAR_RESET_STATUS; + *foundId = RwDefinitions::CLEAR_LAST_RESET_STATUS; + break; + } case (static_cast(RwDefinitions::GET_RW_STATUS)): { *foundLen = RwDefinitions::SIZE_GET_RW_STATUS; *foundId = RwDefinitions::GET_RW_STATUS; break; } + case (static_cast(RwDefinitions::INIT_RW_CONTROLLER)): { + *foundLen = RwDefinitions::SIZE_INIT_RW; + *foundId = RwDefinitions::INIT_RW_CONTROLLER; + break; + } case (static_cast(RwDefinitions::SET_SPEED)): { *foundLen = RwDefinitions::SIZE_SET_SPEED_REPLY; *foundId = RwDefinitions::SET_SPEED; @@ -189,6 +210,8 @@ ReturnValue_t RwHandler::interpretDeviceReply(DeviceCommandId_t id, const uint8_ /** Check result code */ if (*(packet + 1) == RwDefinitions::ERROR) { + sif::error << "RwHandler::interpretDeviceReply: Command execution failed. Command id: " + << id << std::endl; return EXECUTION_FAILED; } @@ -209,6 +232,8 @@ ReturnValue_t RwHandler::interpretDeviceReply(DeviceCommandId_t id, const uint8_ handleGetRwStatusReply(packet); break; } + case (RwDefinitions::CLEAR_LAST_RESET_STATUS): + case (RwDefinitions::INIT_RW_CONTROLLER): case (RwDefinitions::SET_SPEED): // no reply data expected break; @@ -230,7 +255,7 @@ void RwHandler::setNormalDatapoolEntriesInvalid() { } uint32_t RwHandler::getTransitionDelayMs(Mode_t modeFrom, Mode_t modeTo) { - return 5000; + return 15000; } ReturnValue_t RwHandler::initializeLocalDataPool(localpool::DataPool& localDataPoolMap, diff --git a/mission/devices/RwHandler.h b/mission/devices/RwHandler.h index 9521034c..a3d9ff1c 100644 --- a/mission/devices/RwHandler.h +++ b/mission/devices/RwHandler.h @@ -98,17 +98,16 @@ private: CommunicationStep communicationStep = CommunicationStep::READ_TEMPERATURE; enum class StartupStep { - GET_RESET_STATUS, + ENABLE_RW, CLEAR_RESET_STATUS, - INIT_RW + INIT_RW, + STARTUP_COMPLETE }; - StartupStep startupStep = StartupStep::GET_RESET_STATUS; + StartupStep startupStep = StartupStep::ENABLE_RW; size_t sizeOfReply = 0; - bool startupPerformed = false; - /** * @brief This function prepares the command to request the last reset status */ diff --git a/mission/devices/devicedefinitions/RwDefinitions.h b/mission/devices/devicedefinitions/RwDefinitions.h index 73de0e57..e383920e 100644 --- a/mission/devices/devicedefinitions/RwDefinitions.h +++ b/mission/devices/devicedefinitions/RwDefinitions.h @@ -41,6 +41,8 @@ static const uint32_t STATUS_SET_ID = GET_RW_STATUS; static const uint32_t LAST_RESET_ID = GET_LAST_RESET_STATUS; static const size_t SIZE_GET_RESET_STATUS = 5; +static const size_t SIZE_CLEAR_RESET_STATUS = 4; +static const size_t SIZE_INIT_RW = 4; static const size_t SIZE_GET_RW_STATUS = 14; static const size_t SIZE_SET_SPEED_REPLY = 4; static const size_t SIZE_GET_TEMPERATURE_REPLY = 8; diff --git a/tmtc b/tmtc index 899cd942..19b76d96 160000 --- a/tmtc +++ b/tmtc @@ -1 +1 @@ -Subproject commit 899cd942ce7136f371e93d270a6c6c149c0698cb +Subproject commit 19b76d961c61966a0093d3768f62d99196e1c9b2 From cf7dd233ea23125615b11337c7f38d28a081134d Mon Sep 17 00:00:00 2001 From: "Jakob.Meier" Date: Mon, 28 Jun 2021 14:39:08 +0200 Subject: [PATCH 16/26] rw2 enable fix --- bsp_q7s/ObjectFactory.cpp | 2 +- tmtc | 2 +- 2 files changed, 2 insertions(+), 2 deletions(-) diff --git a/bsp_q7s/ObjectFactory.cpp b/bsp_q7s/ObjectFactory.cpp index 8229536b..a84e314f 100644 --- a/bsp_q7s/ObjectFactory.cpp +++ b/bsp_q7s/ObjectFactory.cpp @@ -598,7 +598,7 @@ void ObjectFactory::produce(void* args){ rw1SpiCookie->setCallbackArgs(rwHandler1); auto rwHandler2 = new RwHandler(objects::RW2, objects::SPI_COM_IF, rw2SpiCookie, gpioComIF, - gpioIds::EN_RW1); + gpioIds::EN_RW2); rwHandler2->setStartUpImmediately(); rw2SpiCookie->setCallbackArgs(rwHandler2); diff --git a/tmtc b/tmtc index 19b76d96..10ea97ff 160000 --- a/tmtc +++ b/tmtc @@ -1 +1 @@ -Subproject commit 19b76d961c61966a0093d3768f62d99196e1c9b2 +Subproject commit 10ea97ff0b685014f8f79b124edc8009db6fd879 From 703f29af26fa7eff687b1b4b1d13ba403135a56a Mon Sep 17 00:00:00 2001 From: Martin Zietz Date: Tue, 29 Jun 2021 09:50:50 +0200 Subject: [PATCH 17/26] created all rw objects --- bsp_q7s/ObjectFactory.cpp | 17 ++++++++++++++--- bsp_q7s/gpio/gpioCallbacks.cpp | 4 ++-- .../pollingsequence/pollingSequenceFactory.cpp | 12 ++++++++++++ mission/devices/RwHandler.cpp | 2 +- 4 files changed, 29 insertions(+), 6 deletions(-) diff --git a/bsp_q7s/ObjectFactory.cpp b/bsp_q7s/ObjectFactory.cpp index a84e314f..84c26605 100644 --- a/bsp_q7s/ObjectFactory.cpp +++ b/bsp_q7s/ObjectFactory.cpp @@ -588,8 +588,6 @@ void ObjectFactory::produce(void* args){ RwDefinitions::MAX_REPLY_SIZE, spi::RW_MODE, spi::RW_SPEED, &rwSpiCallback, nullptr); auto rw4SpiCookie = new SpiCookie(addresses::RW4, gpioIds::CS_RW4, "/dev/spidev2.0", RwDefinitions::MAX_REPLY_SIZE, spi::RW_MODE, spi::RW_SPEED, &rwSpiCallback, nullptr); - (void) rw3SpiCookie; - (void) rw4SpiCookie; auto rwHandler1 = new RwHandler(objects::RW1, objects::SPI_COM_IF, rw1SpiCookie, gpioComIF, gpioIds::EN_RW1); @@ -599,9 +597,22 @@ void ObjectFactory::produce(void* args){ auto rwHandler2 = new RwHandler(objects::RW2, objects::SPI_COM_IF, rw2SpiCookie, gpioComIF, gpioIds::EN_RW2); - rwHandler2->setStartUpImmediately(); +// rwHandler2->setStartUpImmediately(); + (void) rwHandler2; rw2SpiCookie->setCallbackArgs(rwHandler2); + auto rwHandler3 = new RwHandler(objects::RW3, objects::SPI_COM_IF, rw3SpiCookie, gpioComIF, + gpioIds::EN_RW3); +// rwHandler3->setStartUpImmediately(); + (void) rwHandler3; +// rw3SpiCookie->setCallbackArgs(rwHandler3); + + auto rwHandler4 = new RwHandler(objects::RW4, objects::SPI_COM_IF, rw4SpiCookie, gpioComIF, + gpioIds::EN_RW4); +// (void) rwHandler4; + rwHandler4->setStartUpImmediately(); + rw4SpiCookie->setCallbackArgs(rwHandler4); + #endif /* TE0720 == 0 */ new UdpTmTcBridge(objects::UDP_BRIDGE, objects::CCSDS_PACKET_DISTRIBUTOR); diff --git a/bsp_q7s/gpio/gpioCallbacks.cpp b/bsp_q7s/gpio/gpioCallbacks.cpp index 49e22249..5499517b 100644 --- a/bsp_q7s/gpio/gpioCallbacks.cpp +++ b/bsp_q7s/gpio/gpioCallbacks.cpp @@ -232,12 +232,12 @@ void spiCsDecoderCallback(gpioId_t gpioId, gpio::GpioOperation gpioOp, int value } case(gpioIds::CS_RW3): { enableRwDecoder(); - selectY3(); + selectY2(); break; } case(gpioIds::CS_RW4): { enableRwDecoder(); - selectY4(); + selectY3(); break; } default: diff --git a/linux/fsfwconfig/pollingsequence/pollingSequenceFactory.cpp b/linux/fsfwconfig/pollingsequence/pollingSequenceFactory.cpp index 35f38919..be184b6b 100644 --- a/linux/fsfwconfig/pollingsequence/pollingSequenceFactory.cpp +++ b/linux/fsfwconfig/pollingsequence/pollingSequenceFactory.cpp @@ -413,6 +413,18 @@ ReturnValue_t pst::pstSpi(FixedTimeslotTaskIF *thisSequence) { thisSequence->addSlot(objects::RW2, length * 0.6, DeviceHandlerIF::SEND_READ); thisSequence->addSlot(objects::RW2, length * 0.8, DeviceHandlerIF::GET_READ); + thisSequence->addSlot(objects::RW3, length * 0, DeviceHandlerIF::PERFORM_OPERATION); + thisSequence->addSlot(objects::RW3, length * 0.2, DeviceHandlerIF::SEND_WRITE); + thisSequence->addSlot(objects::RW3, length * 0.4, DeviceHandlerIF::GET_WRITE); + thisSequence->addSlot(objects::RW3, length * 0.6, DeviceHandlerIF::SEND_READ); + thisSequence->addSlot(objects::RW3, length * 0.8, DeviceHandlerIF::GET_READ); + + thisSequence->addSlot(objects::RW4, length * 0, DeviceHandlerIF::PERFORM_OPERATION); + thisSequence->addSlot(objects::RW4, length * 0.2, DeviceHandlerIF::SEND_WRITE); + thisSequence->addSlot(objects::RW4, length * 0.4, DeviceHandlerIF::GET_WRITE); + thisSequence->addSlot(objects::RW4, length * 0.6, DeviceHandlerIF::SEND_READ); + thisSequence->addSlot(objects::RW4, length * 0.8, DeviceHandlerIF::GET_READ); + if (thisSequence->checkSequence() != HasReturnvaluesIF::RETURN_OK) { sif::error << "SPI PST initialization failed" << std::endl; return HasReturnvaluesIF::RETURN_FAILED; diff --git a/mission/devices/RwHandler.cpp b/mission/devices/RwHandler.cpp index c789fb64..d423aac1 100644 --- a/mission/devices/RwHandler.cpp +++ b/mission/devices/RwHandler.cpp @@ -298,7 +298,7 @@ ReturnValue_t RwHandler::checkSpeedAndRampTime(const uint8_t* commandData, size_ int32_t speed = *commandData << 24 | *(commandData + 1) << 16 | *(commandData + 2) << 8 | *(commandData + 3); - if (speed < -65000 || speed > 65000 || (speed > -1000 && speed < 1000)) { + if ((speed < -65000 || speed > 65000 || (speed > -1000 && speed < 1000)) && (speed != 0)) { sif::error << "RwHandler::checkSpeedAndRampTime: Command has invalid speed" << std::endl; return INVALID_SPEED; } From 6e70f2254d6c2072948a715f4ee44fe6e8842383 Mon Sep 17 00:00:00 2001 From: "Jakob.Meier" Date: Tue, 29 Jun 2021 16:08:20 +0200 Subject: [PATCH 18/26] all reaction wheels working --- bsp_q7s/ObjectFactory.cpp | 10 +- linux/fsfwconfig/OBSWConfig.h.in | 2 +- mission/devices/RwHandler.cpp | 103 ++++++++++-------- mission/devices/RwHandler.h | 23 ++-- .../devices/devicedefinitions/RwDefinitions.h | 17 ++- tmtc | 2 +- 6 files changed, 86 insertions(+), 71 deletions(-) diff --git a/bsp_q7s/ObjectFactory.cpp b/bsp_q7s/ObjectFactory.cpp index 84c26605..a4a876a3 100644 --- a/bsp_q7s/ObjectFactory.cpp +++ b/bsp_q7s/ObjectFactory.cpp @@ -591,26 +591,18 @@ void ObjectFactory::produce(void* args){ auto rwHandler1 = new RwHandler(objects::RW1, objects::SPI_COM_IF, rw1SpiCookie, gpioComIF, gpioIds::EN_RW1); - (void) rwHandler1; -// rwHandler1->setStartUpImmediately(); rw1SpiCookie->setCallbackArgs(rwHandler1); auto rwHandler2 = new RwHandler(objects::RW2, objects::SPI_COM_IF, rw2SpiCookie, gpioComIF, gpioIds::EN_RW2); -// rwHandler2->setStartUpImmediately(); - (void) rwHandler2; rw2SpiCookie->setCallbackArgs(rwHandler2); auto rwHandler3 = new RwHandler(objects::RW3, objects::SPI_COM_IF, rw3SpiCookie, gpioComIF, gpioIds::EN_RW3); -// rwHandler3->setStartUpImmediately(); - (void) rwHandler3; -// rw3SpiCookie->setCallbackArgs(rwHandler3); + rw3SpiCookie->setCallbackArgs(rwHandler3); auto rwHandler4 = new RwHandler(objects::RW4, objects::SPI_COM_IF, rw4SpiCookie, gpioComIF, gpioIds::EN_RW4); -// (void) rwHandler4; - rwHandler4->setStartUpImmediately(); rw4SpiCookie->setCallbackArgs(rwHandler4); #endif /* TE0720 == 0 */ diff --git a/linux/fsfwconfig/OBSWConfig.h.in b/linux/fsfwconfig/OBSWConfig.h.in index ce1a7526..a5a439ab 100644 --- a/linux/fsfwconfig/OBSWConfig.h.in +++ b/linux/fsfwconfig/OBSWConfig.h.in @@ -52,7 +52,7 @@ debugging. */ #include "OBSWVersion.h" /* Can be used to switch device to NORMAL mode immediately */ -#define OBSW_SWITCH_TO_NORMAL_MODE_AFTER_STARTUP 1 +#define OBSW_SWITCH_TO_NORMAL_MODE_AFTER_STARTUP 0 #ifdef __cplusplus diff --git a/mission/devices/RwHandler.cpp b/mission/devices/RwHandler.cpp index d423aac1..45c721a8 100644 --- a/mission/devices/RwHandler.cpp +++ b/mission/devices/RwHandler.cpp @@ -20,18 +20,12 @@ RwHandler::~RwHandler() { } void RwHandler::doStartUp() { - switch (startupStep) { - case StartupStep::ENABLE_RW: { - if(gpioComIF->pullHigh(enableGpio) != RETURN_OK) { - sif::debug << "RwHandler::doStartUp: Failed to pull enable gpio to high"; - } - return; - } - case StartupStep::STARTUP_COMPLETE: - break; - default: - return; - } + + internalState = InternalState::GET_RESET_STATUS; + + if(gpioComIF->pullHigh(enableGpio) != RETURN_OK) { + sif::debug << "RwHandler::doStartUp: Failed to pull enable gpio to high"; + } #if OBSW_SWITCH_TO_NORMAL_MODE_AFTER_STARTUP == 1 setMode(MODE_NORMAL); @@ -44,23 +38,26 @@ void RwHandler::doShutDown() { if(gpioComIF->pullLow(enableGpio) != RETURN_OK) { sif::debug << "RwHandler::doStartUp: Failed to pull enable gpio to low"; } - /** Reset startup step for next doStartUp routine */ - startupStep = StartupStep::ENABLE_RW; } ReturnValue_t RwHandler::buildNormalDeviceCommand(DeviceCommandId_t * id) { - switch (communicationStep) { - case CommunicationStep::GET_RESET_STATUS: + switch (internalState) { + case InternalState::GET_RESET_STATUS: *id = RwDefinitions::GET_LAST_RESET_STATUS; - communicationStep = CommunicationStep::READ_TEMPERATURE; + internalState = InternalState::READ_TEMPERATURE; break; - case CommunicationStep::READ_TEMPERATURE: + case InternalState::CLEAR_RESET_STATUS: + *id = RwDefinitions::CLEAR_LAST_RESET_STATUS; + /** After reset status is cleared, reset status will be polled again for verification */ + internalState = InternalState::GET_RESET_STATUS; + break; + case InternalState::READ_TEMPERATURE: *id = RwDefinitions::GET_TEMPERATURE; - communicationStep = CommunicationStep::GET_RW_SATUS; + internalState = InternalState::GET_RW_SATUS; break; - case CommunicationStep::GET_RW_SATUS: + case InternalState::GET_RW_SATUS: *id = RwDefinitions::GET_RW_STATUS; - communicationStep = CommunicationStep::GET_RESET_STATUS; + internalState = InternalState::GET_RESET_STATUS; break; default: sif::debug << "RwHandler::buildNormalDeviceCommand: Invalid communication step" @@ -71,27 +68,7 @@ ReturnValue_t RwHandler::buildNormalDeviceCommand(DeviceCommandId_t * id) { } ReturnValue_t RwHandler::buildTransitionDeviceCommand(DeviceCommandId_t * id) { - switch (startupStep) { - case StartupStep::ENABLE_RW: - *id = RwDefinitions::GET_LAST_RESET_STATUS; - startupStep = StartupStep::CLEAR_RESET_STATUS; - break; - case StartupStep::CLEAR_RESET_STATUS: - *id = RwDefinitions::CLEAR_LAST_RESET_STATUS; - startupStep = StartupStep::INIT_RW; - break; - case StartupStep::INIT_RW: - *id = RwDefinitions::INIT_RW_CONTROLLER; - startupStep = StartupStep::STARTUP_COMPLETE; - break; - case StartupStep::STARTUP_COMPLETE: - break; - default: - sif::debug << "RwHandler::buildTransitionDeviceCommand: Invalid startup step" - << std::endl; - break; - } - return buildCommandFromCommand(*id, nullptr, 0);; + return RETURN_OK; } ReturnValue_t RwHandler::buildCommandFromCommand(DeviceCommandId_t deviceCommand, @@ -100,9 +77,7 @@ ReturnValue_t RwHandler::buildCommandFromCommand(DeviceCommandId_t deviceCommand switch (deviceCommand) { case (RwDefinitions::RESET_MCU): { - commandBuffer[0] = static_cast(RwDefinitions::RESET_MCU); - rawPacket = commandBuffer; - rawPacketLen = 1; + prepareResetMcuCommand(); return RETURN_OK; } case (RwDefinitions::GET_LAST_RESET_STATUS): { @@ -255,7 +230,7 @@ void RwHandler::setNormalDatapoolEntriesInvalid() { } uint32_t RwHandler::getTransitionDelayMs(Mode_t modeFrom, Mode_t modeTo) { - return 15000; + return 500; } ReturnValue_t RwHandler::initializeLocalDataPool(localpool::DataPool& localDataPoolMap, @@ -263,9 +238,23 @@ ReturnValue_t RwHandler::initializeLocalDataPool(localpool::DataPool& localDataP localDataPoolMap.emplace(RwDefinitions::TEMPERATURE_C, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::CURR_SPEED, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::REFERENCE_SPEED, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::STATE, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::CLC_MODE, new PoolEntry( { 0 })); + + localDataPoolMap.emplace(RwDefinitions::LAST_RESET_STATUS, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::CURRRENT_RESET_STATUS, new PoolEntry( { 0 })); + return RETURN_OK; } +void RwHandler::prepareResetMcuCommand() { + commandBuffer[0] = static_cast(RwDefinitions::RESET_MCU); + rawPacket = commandBuffer; + rawPacketLen = 1; +} + void RwHandler::prepareGetLastResetStatusCommand() { commandBuffer[0] = static_cast(RwDefinitions::GET_LAST_RESET_STATUS); uint16_t crc = CRC::crc16ccitt(commandBuffer, 1, 0xFFFF); @@ -352,15 +341,24 @@ void RwHandler::prepareSetSpeedCmd(const uint8_t * commandData, size_t commandDa } void RwHandler::handleResetStatusReply(const uint8_t* packet) { + PoolReadGuard rg(&lastResetStatusSet); uint8_t offset = 2; - lastResetStatusSet.lastResetStatus = *(packet + offset); + uint8_t resetStatus = *(packet + offset); + if (resetStatus != RwDefinitions::CLEARED) { + internalState = InternalState::CLEAR_RESET_STATUS; + lastResetStatusSet.lastResetStatus = resetStatus; + } + lastResetStatusSet.currentResetStatus = resetStatus; #if OBSW_VERBOSE_LEVEL >= 1 && RW_DEBUG == 1 sif::info << "RwHandler::handleResetStatusReply: Last reset status: " << static_cast(lastResetStatusSet.lastResetStatus.value) << std::endl; + sif::info << "RwHandler::handleResetStatusReply: Current reset status: " + << static_cast(lastResetStatusSet.currentResetStatus.value) << std::endl; #endif } void RwHandler::handleGetRwStatusReply(const uint8_t* packet) { + PoolReadGuard rg(&statusSet); uint8_t offset = 2; statusSet.currSpeed = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 | *(packet + offset + 1) << 8 | *(packet + offset); @@ -372,6 +370,16 @@ void RwHandler::handleGetRwStatusReply(const uint8_t* packet) { offset += 1; statusSet.clcMode = *(packet + offset); + if (statusSet.state == RwDefinitions::ERROR) { + /** + * This requires the commanding of the init reaction wheel controller command to recover + * form error state which must be handled by the FDIR instance. + */ + triggerEvent(ERROR_STATE); + sif::error << "RwHandler::handleGetRwStatusReply: Reaction wheel in error state" + << std::endl; + } + #if OBSW_VERBOSE_LEVEL >= 1 && RW_DEBUG == 1 sif::info << "RwHandler::handleGetRwStatusReply: Current speed is: " << statusSet.currSpeed << " * 0.1 RPM" << std::endl; @@ -385,6 +393,7 @@ void RwHandler::handleGetRwStatusReply(const uint8_t* packet) { } void RwHandler::handleTemperatureReply(const uint8_t* packet) { + PoolReadGuard rg(&temperatureSet); uint8_t offset = 2; temperatureSet.temperatureCelcius = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 | *(packet + offset + 1) << 8 | *(packet + offset); diff --git a/mission/devices/RwHandler.h b/mission/devices/RwHandler.h index a3d9ff1c..11fb4a30 100644 --- a/mission/devices/RwHandler.h +++ b/mission/devices/RwHandler.h @@ -79,6 +79,9 @@ private: //! [EXPORT] : [COMMENT] Reaction wheel reply has invalid crc static const ReturnValue_t CRC_ERROR = MAKE_RETURN_CODE(0xA4); + //! [EXPORT] : [COMMENT] Reaction wheel signals an error state + static const Event ERROR_STATE = MAKE_EVENT(1, severity::HIGH); + LinuxLibgpioIF* gpioComIF = nullptr; gpioId_t enableGpio = gpio::NO_GPIO; @@ -89,25 +92,23 @@ private: uint8_t commandBuffer[RwDefinitions::MAX_CMD_SIZE]; - enum class CommunicationStep { + enum class InternalState { GET_RESET_STATUS, + CLEAR_RESET_STATUS, READ_TEMPERATURE, GET_RW_SATUS }; - CommunicationStep communicationStep = CommunicationStep::READ_TEMPERATURE; - - enum class StartupStep { - ENABLE_RW, - CLEAR_RESET_STATUS, - INIT_RW, - STARTUP_COMPLETE - }; - - StartupStep startupStep = StartupStep::ENABLE_RW; + InternalState internalState = InternalState::GET_RESET_STATUS; size_t sizeOfReply = 0; + /** + * @brief This function fills the command buffer with the data to reset the MCU on a reaction + * wheel. + */ + void prepareResetMcuCommand(); + /** * @brief This function prepares the command to request the last reset status */ diff --git a/mission/devices/devicedefinitions/RwDefinitions.h b/mission/devices/devicedefinitions/RwDefinitions.h index e383920e..fbdbd5cf 100644 --- a/mission/devices/devicedefinitions/RwDefinitions.h +++ b/mission/devices/devicedefinitions/RwDefinitions.h @@ -16,7 +16,8 @@ enum PoolIds: lp_id_t { REFERENCE_SPEED, STATE, CLC_MODE, - LAST_RESET_STATUS + LAST_RESET_STATUS, + CURRRENT_RESET_STATUS }; enum States: uint8_t { @@ -27,6 +28,16 @@ enum States: uint8_t { RUNNING_SPEED_CHANGING }; +enum LastResetStatus: uint8_t { + CLEARED = 0, + PIN_RESET = 1, + POR_PDR_BOR_RESET = 2, + SOFTWARE_RESET = 4, + INDEPENDENT_WATCHDOG_RESET = 8, + WINDOW_WATCHDOG_RESET = 16, + LOW_POWER_RESET = 32 +}; + static const DeviceCommandId_t RESET_MCU = 1; static const DeviceCommandId_t GET_LAST_RESET_STATUS = 2; static const DeviceCommandId_t CLEAR_LAST_RESET_STATUS = 3; @@ -53,7 +64,7 @@ static const size_t SIZE_GET_TELEMETRY_REPLY = 83; static const size_t MAX_CMD_SIZE = 9; static const size_t MAX_REPLY_SIZE = SIZE_GET_TELEMETRY_REPLY; -static const uint8_t LAST_RESET_ENTRIES = 1; +static const uint8_t LAST_RESET_ENTRIES = 2; static const uint8_t TEMPERATURE_SET_ENTRIES = 1; static const uint8_t STATUS_SET_ENTRIES = 4; @@ -118,6 +129,8 @@ public: lp_var_t lastResetStatus = lp_var_t(sid.objectId, PoolIds::LAST_RESET_STATUS, this); + lp_var_t currentResetStatus = lp_var_t(sid.objectId, + PoolIds::CURRRENT_RESET_STATUS, this); }; } diff --git a/tmtc b/tmtc index 10ea97ff..a8ea01bb 160000 --- a/tmtc +++ b/tmtc @@ -1 +1 @@ -Subproject commit 10ea97ff0b685014f8f79b124edc8009db6fd879 +Subproject commit a8ea01bb2fced3d7562af4b200080e424468e9c6 From 9335befdc67466308eafd41523be30a48c61e754 Mon Sep 17 00:00:00 2001 From: "Jakob.Meier" Date: Tue, 29 Jun 2021 16:10:19 +0200 Subject: [PATCH 19/26] tmtc update --- tmtc | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/tmtc b/tmtc index a8ea01bb..09cab194 160000 --- a/tmtc +++ b/tmtc @@ -1 +1 @@ -Subproject commit a8ea01bb2fced3d7562af4b200080e424468e9c6 +Subproject commit 09cab1941fad0bbe8fa54234f7513c61e22038ca From f583fc1d99b767fc39beaca7e9120427b7a616c8 Mon Sep 17 00:00:00 2001 From: "Jakob.Meier" Date: Tue, 29 Jun 2021 17:27:39 +0200 Subject: [PATCH 20/26] generator runs and rw transition delay --- generators/bsp_q7s_events.csv | 9 + generators/bsp_q7s_objects.csv | 129 ++++---- generators/events/translateEvents.cpp | 31 +- generators/objects/translateObjects.cpp | 313 ++++++++++-------- linux/fsfwconfig/events/translateEvents.cpp | 31 +- linux/fsfwconfig/objects/translateObjects.cpp | 313 ++++++++++-------- mission/devices/RwHandler.cpp | 4 +- 7 files changed, 471 insertions(+), 359 deletions(-) diff --git a/generators/bsp_q7s_events.csv b/generators/bsp_q7s_events.csv index 81459869..c895aebb 100644 --- a/generators/bsp_q7s_events.csv +++ b/generators/bsp_q7s_events.csv @@ -81,3 +81,12 @@ 11102;ACK_FAILURE;LOW; ;../../mission/devices/PlocHandler.h 11103;EXE_FAILURE;LOW; ;../../mission/devices/PlocHandler.h 11104;CRC_FAILURE_EVENT;LOW; ;../../mission/devices/PlocHandler.h +11201;SELF_TEST_I2C_FAILURE;LOW; ;../../mission/devices/IMTQHandler.h +11202;SELF_TEST_SPI_FAILURE;LOW; ;../../mission/devices/IMTQHandler.h +11203;SELF_TEST_ADC_FAILURE;LOW; ;../../mission/devices/IMTQHandler.h +11204;SELF_TEST_PWM_FAILURE;LOW; ;../../mission/devices/IMTQHandler.h +11205;SELF_TEST_TC_FAILURE;LOW; ;../../mission/devices/IMTQHandler.h +11206;SELF_TEST_MTM_RANGE_FAILURE;LOW; ;../../mission/devices/IMTQHandler.h +11207;SELF_TEST_COIL_CURRENT_FAILURE;LOW; ;../../mission/devices/IMTQHandler.h +11208;INVALID_ERROR_BYTE;LOW; ;../../mission/devices/IMTQHandler.h +11301;ERROR_STATE;HIGH; ;../../mission/devices/RwHandler.h diff --git a/generators/bsp_q7s_objects.csv b/generators/bsp_q7s_objects.csv index 8df83d6a..e0180089 100644 --- a/generators/bsp_q7s_objects.csv +++ b/generators/bsp_q7s_objects.csv @@ -1,52 +1,74 @@ 0x00005060;P60DOCK_TEST_TASK -0x44000001;P60DOCK_HANDLER -0x44000002;PDU1_HANDLER -0x44000003;PDU2_HANDLER -0x44000004;ACU_HANDLER -0x44000005;TMP1075_HANDLER_1 -0x44000006;TMP1075_HANDLER_2 -0x44000007;MGM_0_LIS3_HANDLER -0x44000008;MGM_1_RM3100_HANDLER -0x44000009;MGM_2_LIS3_HANDLER -0x44000010;MGM_3_RM3100_HANDLER -0x44000011;GYRO_0_ADIS_HANDLER -0x44000012;GYRO_1_L3G_HANDLER -0x44000013;GYRO_2_L3G_HANDLER -0x44000014;IMTQ_HANDLER -0x44000015;PLOC_HANDLER -0x44000016;SUS_1 -0x44000017;SUS_2 -0x44000018;SUS_3 -0x44000019;SUS_4 -0x4400001A;SUS_5 -0x4400001B;SUS_6 -0x4400001C;SUS_7 -0x4400001D;SUS_8 -0x4400001E;SUS_9 -0x4400001F;SUS_10 -0x44000021;SUS_11 -0x44000022;SUS_12 -0x44000023;SUS_13 -0x44001000;PCDU_HANDLER -0x44001001;SOLAR_ARRAY_DEPL_HANDLER -0x44001002;SYRLINKS_HK_HANDLER -0x47000001;GPIO_IF -0x49000001;ARDUINO_COM_IF -0x49000002;CSP_COM_IF -0x49000003;I2C_COM_IF -0x49000004;UART_COM_IF -0x49000005;SPI_COM_IF +0x43000003;CORE_CONTROLLER +0x43100002;ACS_CONTROLLER +0x43400001;THERMAL_CONTROLLER +0x44120006;MGM_0_LIS3_HANDLER +0x44120010;GYRO_0_ADIS_HANDLER +0x44120032;SUS_1 +0x44120033;SUS_2 +0x44120034;SUS_3 +0x44120035;SUS_4 +0x44120036;SUS_5 +0x44120037;SUS_6 +0x44120038;SUS_7 +0x44120039;SUS_8 +0x44120040;SUS_9 +0x44120041;SUS_10 +0x44120042;SUS_11 +0x44120043;SUS_12 +0x44120044;SUS_13 +0x44120107;MGM_1_RM3100_HANDLER +0x44120111;GYRO_1_L3G_HANDLER +0x44120208;MGM_2_LIS3_HANDLER +0x44120212;GYRO_2_ADIS_HANDLER +0x44120309;MGM_3_RM3100_HANDLER +0x44120313;GYRO_3_L3G_HANDLER +0x44130045;GPS0_HANDLER +0x44130146;GPS1_HANDLER +0x44140014;IMTQ_HANDLER +0x442000A1;PCDU_HANDLER +0x44210001;RW1 +0x44210002;RW2 +0x44210003;RW3 +0x44210004;RW4 +0x44250000;P60DOCK_HANDLER +0x44250001;PDU1_HANDLER +0x44250002;PDU2_HANDLER +0x44250003;ACU_HANDLER +0x443200A5;RAD_SENSOR +0x44330015;PLOC_HANDLER +0x444100A2;SOLAR_ARRAY_DEPL_HANDLER +0x444100A4;HEATER_HANDLER +0x44420004;TMP1075_HANDLER_1 +0x44420005;TMP1075_HANDLER_2 +0x44420016;RTD_IC3 +0x44420017;RTD_IC4 +0x44420018;RTD_IC5 +0x44420019;RTD_IC6 +0x44420020;RTD_IC7 +0x44420021;RTD_IC8 +0x44420022;RTD_IC9 +0x44420023;RTD_IC10 +0x44420024;RTD_IC11 +0x44420025;RTD_IC12 +0x44420026;RTD_IC13 +0x44420027;RTD_IC14 +0x44420028;RTD_IC15 +0x44420029;RTD_IC16 +0x44420030;RTD_IC17 +0x44420031;RTD_IC18 +0x445300A3;SYRLINKS_HK_HANDLER +0x49000000;ARDUINO_COM_IF +0x49010005;GPIO_IF +0x49020004;SPI_COM_IF +0x49030003;UART_COM_IF +0x49040002;I2C_COM_IF +0x49050001;CSP_COM_IF 0x50000100;CCSDS_PACKET_DISTRIBUTOR 0x50000200;PUS_PACKET_DISTRIBUTOR 0x50000300;UDP_BRIDGE 0x50000400;UDP_POLLING_TASK -0x51000300;PUS_SERVICE_3 -0x51000400;PUS_SERVICE_5 0x51000500;PUS_SERVICE_6 -0x51000800;PUS_SERVICE_8 -0x51002300;PUS_SERVICE_23 -0x51020100;PUS_SERVICE_201 -0x52000002;TM_FUNNEL 0x53000000;FSFW_OBJECTS_START 0x53000001;PUS_SERVICE_1_VERIFICATION 0x53000002;PUS_SERVICE_2_DEVICE_ACCESS @@ -67,27 +89,12 @@ 0x534f0300;IPC_STORE 0x53500010;TIME_STAMPER 0x53ffffff;FSFW_OBJECTS_END -0x54000003;HEATER_HANDLER -0x54000004;RTD_IC3 -0x54000005;RTD_IC4 -0x54000006;RTD_IC5 -0x54000007;RTD_IC6 -0x54000008;RTD_IC7 -0x54000009;RTD_IC8 -0x5400000A;RTD_IC9 -0x5400000B;RTD_IC10 -0x5400000C;RTD_IC11 -0x5400000D;RTD_IC12 -0x5400000E;RTD_IC13 -0x5400000F;RTD_IC14 0x54000010;SPI_TEST -0x5400001F;RTD_IC15 -0x5400002F;RTD_IC16 -0x5400003F;RTD_IC17 -0x5400004F;RTD_IC18 -0x54000050;RAD_SENSOR +0x54000020;UART_TEST 0x5400AFFE;DUMMY_HANDLER 0x5400CAFE;DUMMY_INTERFACE 0x54123456;LIBGPIOD_TEST 0x54694269;TEST_TASK +0x73000100;TM_FUNNEL +0x73500000;CCSDS_IP_CORE_BRIDGE 0xFFFFFFFF;NO_OBJECT diff --git a/generators/events/translateEvents.cpp b/generators/events/translateEvents.cpp index c3af08e1..9ae81646 100644 --- a/generators/events/translateEvents.cpp +++ b/generators/events/translateEvents.cpp @@ -1,7 +1,7 @@ /** - * @brief Auto-generated event translation file. Contains 83 translations. + * @brief Auto-generated event translation file. Contains 92 translations. * @details - * Generated on: 2021-06-08 17:09:32 + * Generated on: 2021-06-29 16:20:09 */ #include "translateEvents.h" @@ -88,6 +88,15 @@ const char *MEMORY_READ_RPT_CRC_FAILURE_STRING = "MEMORY_READ_RPT_CRC_FAILURE"; const char *ACK_FAILURE_STRING = "ACK_FAILURE"; const char *EXE_FAILURE_STRING = "EXE_FAILURE"; const char *CRC_FAILURE_EVENT_STRING = "CRC_FAILURE_EVENT"; +const char *SELF_TEST_I2C_FAILURE_STRING = "SELF_TEST_I2C_FAILURE"; +const char *SELF_TEST_SPI_FAILURE_STRING = "SELF_TEST_SPI_FAILURE"; +const char *SELF_TEST_ADC_FAILURE_STRING = "SELF_TEST_ADC_FAILURE"; +const char *SELF_TEST_PWM_FAILURE_STRING = "SELF_TEST_PWM_FAILURE"; +const char *SELF_TEST_TC_FAILURE_STRING = "SELF_TEST_TC_FAILURE"; +const char *SELF_TEST_MTM_RANGE_FAILURE_STRING = "SELF_TEST_MTM_RANGE_FAILURE"; +const char *SELF_TEST_COIL_CURRENT_FAILURE_STRING = "SELF_TEST_COIL_CURRENT_FAILURE"; +const char *INVALID_ERROR_BYTE_STRING = "INVALID_ERROR_BYTE"; +const char *ERROR_STATE_STRING = "ERROR_STATE"; const char * translateEvents(Event event) { switch( (event & 0xffff) ) { @@ -257,6 +266,24 @@ const char * translateEvents(Event event) { return EXE_FAILURE_STRING; case(11104): return CRC_FAILURE_EVENT_STRING; + case(11201): + return SELF_TEST_I2C_FAILURE_STRING; + case(11202): + return SELF_TEST_SPI_FAILURE_STRING; + case(11203): + return SELF_TEST_ADC_FAILURE_STRING; + case(11204): + return SELF_TEST_PWM_FAILURE_STRING; + case(11205): + return SELF_TEST_TC_FAILURE_STRING; + case(11206): + return SELF_TEST_MTM_RANGE_FAILURE_STRING; + case(11207): + return SELF_TEST_COIL_CURRENT_FAILURE_STRING; + case(11208): + return INVALID_ERROR_BYTE_STRING; + case(11301): + return ERROR_STATE_STRING; default: return "UNKNOWN_EVENT"; } diff --git a/generators/objects/translateObjects.cpp b/generators/objects/translateObjects.cpp index 47b55435..2068158b 100644 --- a/generators/objects/translateObjects.cpp +++ b/generators/objects/translateObjects.cpp @@ -1,27 +1,17 @@ -/** +/** * @brief Auto-generated object translation file. * @details - * Contains 93 translations. - * Generated on: 2021-05-18 16:48:46 + * Contains 100 translations. + * Generated on: 2021-06-29 16:19:57 */ #include "translateObjects.h" const char *P60DOCK_TEST_TASK_STRING = "P60DOCK_TEST_TASK"; -const char *P60DOCK_HANDLER_STRING = "P60DOCK_HANDLER"; -const char *PDU1_HANDLER_STRING = "PDU1_HANDLER"; -const char *PDU2_HANDLER_STRING = "PDU2_HANDLER"; -const char *ACU_HANDLER_STRING = "ACU_HANDLER"; -const char *TMP1075_HANDLER_1_STRING = "TMP1075_HANDLER_1"; -const char *TMP1075_HANDLER_2_STRING = "TMP1075_HANDLER_2"; +const char *CORE_CONTROLLER_STRING = "CORE_CONTROLLER"; +const char *ACS_CONTROLLER_STRING = "ACS_CONTROLLER"; +const char *THERMAL_CONTROLLER_STRING = "THERMAL_CONTROLLER"; const char *MGM_0_LIS3_HANDLER_STRING = "MGM_0_LIS3_HANDLER"; -const char *MGM_1_RM3100_HANDLER_STRING = "MGM_1_RM3100_HANDLER"; -const char *MGM_2_LIS3_HANDLER_STRING = "MGM_2_LIS3_HANDLER"; -const char *MGM_3_RM3100_HANDLER_STRING = "MGM_3_RM3100_HANDLER"; const char *GYRO_0_ADIS_HANDLER_STRING = "GYRO_0_ADIS_HANDLER"; -const char *GYRO_1_L3G_HANDLER_STRING = "GYRO_1_L3G_HANDLER"; -const char *GYRO_2_L3G_HANDLER_STRING = "GYRO_2_L3G_HANDLER"; -const char *IMTQ_HANDLER_STRING = "IMTQ_HANDLER"; -const char *PLOC_HANDLER_STRING = "PLOC_HANDLER"; const char *SUS_1_STRING = "SUS_1"; const char *SUS_2_STRING = "SUS_2"; const char *SUS_3_STRING = "SUS_3"; @@ -35,26 +25,58 @@ const char *SUS_10_STRING = "SUS_10"; const char *SUS_11_STRING = "SUS_11"; const char *SUS_12_STRING = "SUS_12"; const char *SUS_13_STRING = "SUS_13"; +const char *MGM_1_RM3100_HANDLER_STRING = "MGM_1_RM3100_HANDLER"; +const char *GYRO_1_L3G_HANDLER_STRING = "GYRO_1_L3G_HANDLER"; +const char *MGM_2_LIS3_HANDLER_STRING = "MGM_2_LIS3_HANDLER"; +const char *GYRO_2_ADIS_HANDLER_STRING = "GYRO_2_ADIS_HANDLER"; +const char *MGM_3_RM3100_HANDLER_STRING = "MGM_3_RM3100_HANDLER"; +const char *GYRO_3_L3G_HANDLER_STRING = "GYRO_3_L3G_HANDLER"; +const char *GPS0_HANDLER_STRING = "GPS0_HANDLER"; +const char *GPS1_HANDLER_STRING = "GPS1_HANDLER"; +const char *IMTQ_HANDLER_STRING = "IMTQ_HANDLER"; const char *PCDU_HANDLER_STRING = "PCDU_HANDLER"; +const char *RW1_STRING = "RW1"; +const char *RW2_STRING = "RW2"; +const char *RW3_STRING = "RW3"; +const char *RW4_STRING = "RW4"; +const char *P60DOCK_HANDLER_STRING = "P60DOCK_HANDLER"; +const char *PDU1_HANDLER_STRING = "PDU1_HANDLER"; +const char *PDU2_HANDLER_STRING = "PDU2_HANDLER"; +const char *ACU_HANDLER_STRING = "ACU_HANDLER"; +const char *RAD_SENSOR_STRING = "RAD_SENSOR"; +const char *PLOC_HANDLER_STRING = "PLOC_HANDLER"; const char *SOLAR_ARRAY_DEPL_HANDLER_STRING = "SOLAR_ARRAY_DEPL_HANDLER"; +const char *HEATER_HANDLER_STRING = "HEATER_HANDLER"; +const char *TMP1075_HANDLER_1_STRING = "TMP1075_HANDLER_1"; +const char *TMP1075_HANDLER_2_STRING = "TMP1075_HANDLER_2"; +const char *RTD_IC3_STRING = "RTD_IC3"; +const char *RTD_IC4_STRING = "RTD_IC4"; +const char *RTD_IC5_STRING = "RTD_IC5"; +const char *RTD_IC6_STRING = "RTD_IC6"; +const char *RTD_IC7_STRING = "RTD_IC7"; +const char *RTD_IC8_STRING = "RTD_IC8"; +const char *RTD_IC9_STRING = "RTD_IC9"; +const char *RTD_IC10_STRING = "RTD_IC10"; +const char *RTD_IC11_STRING = "RTD_IC11"; +const char *RTD_IC12_STRING = "RTD_IC12"; +const char *RTD_IC13_STRING = "RTD_IC13"; +const char *RTD_IC14_STRING = "RTD_IC14"; +const char *RTD_IC15_STRING = "RTD_IC15"; +const char *RTD_IC16_STRING = "RTD_IC16"; +const char *RTD_IC17_STRING = "RTD_IC17"; +const char *RTD_IC18_STRING = "RTD_IC18"; const char *SYRLINKS_HK_HANDLER_STRING = "SYRLINKS_HK_HANDLER"; -const char *GPIO_IF_STRING = "GPIO_IF"; const char *ARDUINO_COM_IF_STRING = "ARDUINO_COM_IF"; -const char *CSP_COM_IF_STRING = "CSP_COM_IF"; -const char *I2C_COM_IF_STRING = "I2C_COM_IF"; -const char *UART_COM_IF_STRING = "UART_COM_IF"; +const char *GPIO_IF_STRING = "GPIO_IF"; const char *SPI_COM_IF_STRING = "SPI_COM_IF"; +const char *UART_COM_IF_STRING = "UART_COM_IF"; +const char *I2C_COM_IF_STRING = "I2C_COM_IF"; +const char *CSP_COM_IF_STRING = "CSP_COM_IF"; const char *CCSDS_PACKET_DISTRIBUTOR_STRING = "CCSDS_PACKET_DISTRIBUTOR"; const char *PUS_PACKET_DISTRIBUTOR_STRING = "PUS_PACKET_DISTRIBUTOR"; const char *UDP_BRIDGE_STRING = "UDP_BRIDGE"; const char *UDP_POLLING_TASK_STRING = "UDP_POLLING_TASK"; -const char *PUS_SERVICE_3_STRING = "PUS_SERVICE_3"; -const char *PUS_SERVICE_5_STRING = "PUS_SERVICE_5"; const char *PUS_SERVICE_6_STRING = "PUS_SERVICE_6"; -const char *PUS_SERVICE_8_STRING = "PUS_SERVICE_8"; -const char *PUS_SERVICE_23_STRING = "PUS_SERVICE_23"; -const char *PUS_SERVICE_201_STRING = "PUS_SERVICE_201"; -const char *TM_FUNNEL_STRING = "TM_FUNNEL"; const char *FSFW_OBJECTS_START_STRING = "FSFW_OBJECTS_START"; const char *PUS_SERVICE_1_VERIFICATION_STRING = "PUS_SERVICE_1_VERIFICATION"; const char *PUS_SERVICE_2_DEVICE_ACCESS_STRING = "PUS_SERVICE_2_DEVICE_ACCESS"; @@ -75,109 +97,150 @@ const char *TM_STORE_STRING = "TM_STORE"; const char *IPC_STORE_STRING = "IPC_STORE"; const char *TIME_STAMPER_STRING = "TIME_STAMPER"; const char *FSFW_OBJECTS_END_STRING = "FSFW_OBJECTS_END"; -const char *HEATER_HANDLER_STRING = "HEATER_HANDLER"; -const char *RTD_IC3_STRING = "RTD_IC3"; -const char *RTD_IC4_STRING = "RTD_IC4"; -const char *RTD_IC5_STRING = "RTD_IC5"; -const char *RTD_IC6_STRING = "RTD_IC6"; -const char *RTD_IC7_STRING = "RTD_IC7"; -const char *RTD_IC8_STRING = "RTD_IC8"; -const char *RTD_IC9_STRING = "RTD_IC9"; -const char *RTD_IC10_STRING = "RTD_IC10"; -const char *RTD_IC11_STRING = "RTD_IC11"; -const char *RTD_IC12_STRING = "RTD_IC12"; -const char *RTD_IC13_STRING = "RTD_IC13"; -const char *RTD_IC14_STRING = "RTD_IC14"; const char *SPI_TEST_STRING = "SPI_TEST"; -const char *RTD_IC15_STRING = "RTD_IC15"; -const char *RTD_IC16_STRING = "RTD_IC16"; -const char *RTD_IC17_STRING = "RTD_IC17"; -const char *RTD_IC18_STRING = "RTD_IC18"; -const char *RAD_SENSOR_STRING = "RAD_SENSOR"; +const char *UART_TEST_STRING = "UART_TEST"; const char *DUMMY_HANDLER_STRING = "DUMMY_HANDLER"; const char *DUMMY_INTERFACE_STRING = "DUMMY_INTERFACE"; const char *LIBGPIOD_TEST_STRING = "LIBGPIOD_TEST"; const char *TEST_TASK_STRING = "TEST_TASK"; +const char *TM_FUNNEL_STRING = "TM_FUNNEL"; +const char *CCSDS_IP_CORE_BRIDGE_STRING = "CCSDS_IP_CORE_BRIDGE"; const char *NO_OBJECT_STRING = "NO_OBJECT"; const char* translateObject(object_id_t object) { switch( (object & 0xFFFFFFFF) ) { case 0x00005060: return P60DOCK_TEST_TASK_STRING; - case 0x44000001: - return P60DOCK_HANDLER_STRING; - case 0x44000002: - return PDU1_HANDLER_STRING; - case 0x44000003: - return PDU2_HANDLER_STRING; - case 0x44000004: - return ACU_HANDLER_STRING; - case 0x44000005: - return TMP1075_HANDLER_1_STRING; - case 0x44000006: - return TMP1075_HANDLER_2_STRING; - case 0x44000007: + case 0x43000003: + return CORE_CONTROLLER_STRING; + case 0x43100002: + return ACS_CONTROLLER_STRING; + case 0x43400001: + return THERMAL_CONTROLLER_STRING; + case 0x44120006: return MGM_0_LIS3_HANDLER_STRING; - case 0x44000008: - return MGM_1_RM3100_HANDLER_STRING; - case 0x44000009: - return MGM_2_LIS3_HANDLER_STRING; - case 0x44000010: - return MGM_3_RM3100_HANDLER_STRING; - case 0x44000011: + case 0x44120010: return GYRO_0_ADIS_HANDLER_STRING; - case 0x44000012: - return GYRO_1_L3G_HANDLER_STRING; - case 0x44000013: - return GYRO_2_L3G_HANDLER_STRING; - case 0x44000014: - return IMTQ_HANDLER_STRING; - case 0x44000015: - return PLOC_HANDLER_STRING; - case 0x44000016: + case 0x44120032: return SUS_1_STRING; - case 0x44000017: + case 0x44120033: return SUS_2_STRING; - case 0x44000018: + case 0x44120034: return SUS_3_STRING; - case 0x44000019: + case 0x44120035: return SUS_4_STRING; - case 0x4400001A: + case 0x44120036: return SUS_5_STRING; - case 0x4400001B: + case 0x44120037: return SUS_6_STRING; - case 0x4400001C: + case 0x44120038: return SUS_7_STRING; - case 0x4400001D: + case 0x44120039: return SUS_8_STRING; - case 0x4400001E: + case 0x44120040: return SUS_9_STRING; - case 0x4400001F: + case 0x44120041: return SUS_10_STRING; - case 0x44000021: + case 0x44120042: return SUS_11_STRING; - case 0x44000022: + case 0x44120043: return SUS_12_STRING; - case 0x44000023: + case 0x44120044: return SUS_13_STRING; - case 0x44001000: + case 0x44120107: + return MGM_1_RM3100_HANDLER_STRING; + case 0x44120111: + return GYRO_1_L3G_HANDLER_STRING; + case 0x44120208: + return MGM_2_LIS3_HANDLER_STRING; + case 0x44120212: + return GYRO_2_ADIS_HANDLER_STRING; + case 0x44120309: + return MGM_3_RM3100_HANDLER_STRING; + case 0x44120313: + return GYRO_3_L3G_HANDLER_STRING; + case 0x44130045: + return GPS0_HANDLER_STRING; + case 0x44130146: + return GPS1_HANDLER_STRING; + case 0x44140014: + return IMTQ_HANDLER_STRING; + case 0x442000A1: return PCDU_HANDLER_STRING; - case 0x44001001: + case 0x44210001: + return RW1_STRING; + case 0x44210002: + return RW2_STRING; + case 0x44210003: + return RW3_STRING; + case 0x44210004: + return RW4_STRING; + case 0x44250000: + return P60DOCK_HANDLER_STRING; + case 0x44250001: + return PDU1_HANDLER_STRING; + case 0x44250002: + return PDU2_HANDLER_STRING; + case 0x44250003: + return ACU_HANDLER_STRING; + case 0x443200A5: + return RAD_SENSOR_STRING; + case 0x44330015: + return PLOC_HANDLER_STRING; + case 0x444100A2: return SOLAR_ARRAY_DEPL_HANDLER_STRING; - case 0x44001002: + case 0x444100A4: + return HEATER_HANDLER_STRING; + case 0x44420004: + return TMP1075_HANDLER_1_STRING; + case 0x44420005: + return TMP1075_HANDLER_2_STRING; + case 0x44420016: + return RTD_IC3_STRING; + case 0x44420017: + return RTD_IC4_STRING; + case 0x44420018: + return RTD_IC5_STRING; + case 0x44420019: + return RTD_IC6_STRING; + case 0x44420020: + return RTD_IC7_STRING; + case 0x44420021: + return RTD_IC8_STRING; + case 0x44420022: + return RTD_IC9_STRING; + case 0x44420023: + return RTD_IC10_STRING; + case 0x44420024: + return RTD_IC11_STRING; + case 0x44420025: + return RTD_IC12_STRING; + case 0x44420026: + return RTD_IC13_STRING; + case 0x44420027: + return RTD_IC14_STRING; + case 0x44420028: + return RTD_IC15_STRING; + case 0x44420029: + return RTD_IC16_STRING; + case 0x44420030: + return RTD_IC17_STRING; + case 0x44420031: + return RTD_IC18_STRING; + case 0x445300A3: return SYRLINKS_HK_HANDLER_STRING; - case 0x47000001: - return GPIO_IF_STRING; - case 0x49000001: + case 0x49000000: return ARDUINO_COM_IF_STRING; - case 0x49000002: - return CSP_COM_IF_STRING; - case 0x49000003: - return I2C_COM_IF_STRING; - case 0x49000004: - return UART_COM_IF_STRING; - case 0x49000005: + case 0x49010005: + return GPIO_IF_STRING; + case 0x49020004: return SPI_COM_IF_STRING; + case 0x49030003: + return UART_COM_IF_STRING; + case 0x49040002: + return I2C_COM_IF_STRING; + case 0x49050001: + return CSP_COM_IF_STRING; case 0x50000100: return CCSDS_PACKET_DISTRIBUTOR_STRING; case 0x50000200: @@ -186,20 +249,8 @@ const char* translateObject(object_id_t object) { return UDP_BRIDGE_STRING; case 0x50000400: return UDP_POLLING_TASK_STRING; - case 0x51000300: - return PUS_SERVICE_3_STRING; - case 0x51000400: - return PUS_SERVICE_5_STRING; case 0x51000500: return PUS_SERVICE_6_STRING; - case 0x51000800: - return PUS_SERVICE_8_STRING; - case 0x51002300: - return PUS_SERVICE_23_STRING; - case 0x51020100: - return PUS_SERVICE_201_STRING; - case 0x52000002: - return TM_FUNNEL_STRING; case 0x53000000: return FSFW_OBJECTS_START_STRING; case 0x53000001: @@ -240,44 +291,10 @@ const char* translateObject(object_id_t object) { return TIME_STAMPER_STRING; case 0x53ffffff: return FSFW_OBJECTS_END_STRING; - case 0x54000003: - return HEATER_HANDLER_STRING; - case 0x54000004: - return RTD_IC3_STRING; - case 0x54000005: - return RTD_IC4_STRING; - case 0x54000006: - return RTD_IC5_STRING; - case 0x54000007: - return RTD_IC6_STRING; - case 0x54000008: - return RTD_IC7_STRING; - case 0x54000009: - return RTD_IC8_STRING; - case 0x5400000A: - return RTD_IC9_STRING; - case 0x5400000B: - return RTD_IC10_STRING; - case 0x5400000C: - return RTD_IC11_STRING; - case 0x5400000D: - return RTD_IC12_STRING; - case 0x5400000E: - return RTD_IC13_STRING; - case 0x5400000F: - return RTD_IC14_STRING; case 0x54000010: return SPI_TEST_STRING; - case 0x5400001F: - return RTD_IC15_STRING; - case 0x5400002F: - return RTD_IC16_STRING; - case 0x5400003F: - return RTD_IC17_STRING; - case 0x5400004F: - return RTD_IC18_STRING; - case 0x54000050: - return RAD_SENSOR_STRING; + case 0x54000020: + return UART_TEST_STRING; case 0x5400AFFE: return DUMMY_HANDLER_STRING; case 0x5400CAFE: @@ -286,6 +303,10 @@ const char* translateObject(object_id_t object) { return LIBGPIOD_TEST_STRING; case 0x54694269: return TEST_TASK_STRING; + case 0x73000100: + return TM_FUNNEL_STRING; + case 0x73500000: + return CCSDS_IP_CORE_BRIDGE_STRING; case 0xFFFFFFFF: return NO_OBJECT_STRING; default: diff --git a/linux/fsfwconfig/events/translateEvents.cpp b/linux/fsfwconfig/events/translateEvents.cpp index c3af08e1..9ae81646 100644 --- a/linux/fsfwconfig/events/translateEvents.cpp +++ b/linux/fsfwconfig/events/translateEvents.cpp @@ -1,7 +1,7 @@ /** - * @brief Auto-generated event translation file. Contains 83 translations. + * @brief Auto-generated event translation file. Contains 92 translations. * @details - * Generated on: 2021-06-08 17:09:32 + * Generated on: 2021-06-29 16:20:09 */ #include "translateEvents.h" @@ -88,6 +88,15 @@ const char *MEMORY_READ_RPT_CRC_FAILURE_STRING = "MEMORY_READ_RPT_CRC_FAILURE"; const char *ACK_FAILURE_STRING = "ACK_FAILURE"; const char *EXE_FAILURE_STRING = "EXE_FAILURE"; const char *CRC_FAILURE_EVENT_STRING = "CRC_FAILURE_EVENT"; +const char *SELF_TEST_I2C_FAILURE_STRING = "SELF_TEST_I2C_FAILURE"; +const char *SELF_TEST_SPI_FAILURE_STRING = "SELF_TEST_SPI_FAILURE"; +const char *SELF_TEST_ADC_FAILURE_STRING = "SELF_TEST_ADC_FAILURE"; +const char *SELF_TEST_PWM_FAILURE_STRING = "SELF_TEST_PWM_FAILURE"; +const char *SELF_TEST_TC_FAILURE_STRING = "SELF_TEST_TC_FAILURE"; +const char *SELF_TEST_MTM_RANGE_FAILURE_STRING = "SELF_TEST_MTM_RANGE_FAILURE"; +const char *SELF_TEST_COIL_CURRENT_FAILURE_STRING = "SELF_TEST_COIL_CURRENT_FAILURE"; +const char *INVALID_ERROR_BYTE_STRING = "INVALID_ERROR_BYTE"; +const char *ERROR_STATE_STRING = "ERROR_STATE"; const char * translateEvents(Event event) { switch( (event & 0xffff) ) { @@ -257,6 +266,24 @@ const char * translateEvents(Event event) { return EXE_FAILURE_STRING; case(11104): return CRC_FAILURE_EVENT_STRING; + case(11201): + return SELF_TEST_I2C_FAILURE_STRING; + case(11202): + return SELF_TEST_SPI_FAILURE_STRING; + case(11203): + return SELF_TEST_ADC_FAILURE_STRING; + case(11204): + return SELF_TEST_PWM_FAILURE_STRING; + case(11205): + return SELF_TEST_TC_FAILURE_STRING; + case(11206): + return SELF_TEST_MTM_RANGE_FAILURE_STRING; + case(11207): + return SELF_TEST_COIL_CURRENT_FAILURE_STRING; + case(11208): + return INVALID_ERROR_BYTE_STRING; + case(11301): + return ERROR_STATE_STRING; default: return "UNKNOWN_EVENT"; } diff --git a/linux/fsfwconfig/objects/translateObjects.cpp b/linux/fsfwconfig/objects/translateObjects.cpp index 47b55435..2068158b 100644 --- a/linux/fsfwconfig/objects/translateObjects.cpp +++ b/linux/fsfwconfig/objects/translateObjects.cpp @@ -1,27 +1,17 @@ -/** +/** * @brief Auto-generated object translation file. * @details - * Contains 93 translations. - * Generated on: 2021-05-18 16:48:46 + * Contains 100 translations. + * Generated on: 2021-06-29 16:19:57 */ #include "translateObjects.h" const char *P60DOCK_TEST_TASK_STRING = "P60DOCK_TEST_TASK"; -const char *P60DOCK_HANDLER_STRING = "P60DOCK_HANDLER"; -const char *PDU1_HANDLER_STRING = "PDU1_HANDLER"; -const char *PDU2_HANDLER_STRING = "PDU2_HANDLER"; -const char *ACU_HANDLER_STRING = "ACU_HANDLER"; -const char *TMP1075_HANDLER_1_STRING = "TMP1075_HANDLER_1"; -const char *TMP1075_HANDLER_2_STRING = "TMP1075_HANDLER_2"; +const char *CORE_CONTROLLER_STRING = "CORE_CONTROLLER"; +const char *ACS_CONTROLLER_STRING = "ACS_CONTROLLER"; +const char *THERMAL_CONTROLLER_STRING = "THERMAL_CONTROLLER"; const char *MGM_0_LIS3_HANDLER_STRING = "MGM_0_LIS3_HANDLER"; -const char *MGM_1_RM3100_HANDLER_STRING = "MGM_1_RM3100_HANDLER"; -const char *MGM_2_LIS3_HANDLER_STRING = "MGM_2_LIS3_HANDLER"; -const char *MGM_3_RM3100_HANDLER_STRING = "MGM_3_RM3100_HANDLER"; const char *GYRO_0_ADIS_HANDLER_STRING = "GYRO_0_ADIS_HANDLER"; -const char *GYRO_1_L3G_HANDLER_STRING = "GYRO_1_L3G_HANDLER"; -const char *GYRO_2_L3G_HANDLER_STRING = "GYRO_2_L3G_HANDLER"; -const char *IMTQ_HANDLER_STRING = "IMTQ_HANDLER"; -const char *PLOC_HANDLER_STRING = "PLOC_HANDLER"; const char *SUS_1_STRING = "SUS_1"; const char *SUS_2_STRING = "SUS_2"; const char *SUS_3_STRING = "SUS_3"; @@ -35,26 +25,58 @@ const char *SUS_10_STRING = "SUS_10"; const char *SUS_11_STRING = "SUS_11"; const char *SUS_12_STRING = "SUS_12"; const char *SUS_13_STRING = "SUS_13"; +const char *MGM_1_RM3100_HANDLER_STRING = "MGM_1_RM3100_HANDLER"; +const char *GYRO_1_L3G_HANDLER_STRING = "GYRO_1_L3G_HANDLER"; +const char *MGM_2_LIS3_HANDLER_STRING = "MGM_2_LIS3_HANDLER"; +const char *GYRO_2_ADIS_HANDLER_STRING = "GYRO_2_ADIS_HANDLER"; +const char *MGM_3_RM3100_HANDLER_STRING = "MGM_3_RM3100_HANDLER"; +const char *GYRO_3_L3G_HANDLER_STRING = "GYRO_3_L3G_HANDLER"; +const char *GPS0_HANDLER_STRING = "GPS0_HANDLER"; +const char *GPS1_HANDLER_STRING = "GPS1_HANDLER"; +const char *IMTQ_HANDLER_STRING = "IMTQ_HANDLER"; const char *PCDU_HANDLER_STRING = "PCDU_HANDLER"; +const char *RW1_STRING = "RW1"; +const char *RW2_STRING = "RW2"; +const char *RW3_STRING = "RW3"; +const char *RW4_STRING = "RW4"; +const char *P60DOCK_HANDLER_STRING = "P60DOCK_HANDLER"; +const char *PDU1_HANDLER_STRING = "PDU1_HANDLER"; +const char *PDU2_HANDLER_STRING = "PDU2_HANDLER"; +const char *ACU_HANDLER_STRING = "ACU_HANDLER"; +const char *RAD_SENSOR_STRING = "RAD_SENSOR"; +const char *PLOC_HANDLER_STRING = "PLOC_HANDLER"; const char *SOLAR_ARRAY_DEPL_HANDLER_STRING = "SOLAR_ARRAY_DEPL_HANDLER"; +const char *HEATER_HANDLER_STRING = "HEATER_HANDLER"; +const char *TMP1075_HANDLER_1_STRING = "TMP1075_HANDLER_1"; +const char *TMP1075_HANDLER_2_STRING = "TMP1075_HANDLER_2"; +const char *RTD_IC3_STRING = "RTD_IC3"; +const char *RTD_IC4_STRING = "RTD_IC4"; +const char *RTD_IC5_STRING = "RTD_IC5"; +const char *RTD_IC6_STRING = "RTD_IC6"; +const char *RTD_IC7_STRING = "RTD_IC7"; +const char *RTD_IC8_STRING = "RTD_IC8"; +const char *RTD_IC9_STRING = "RTD_IC9"; +const char *RTD_IC10_STRING = "RTD_IC10"; +const char *RTD_IC11_STRING = "RTD_IC11"; +const char *RTD_IC12_STRING = "RTD_IC12"; +const char *RTD_IC13_STRING = "RTD_IC13"; +const char *RTD_IC14_STRING = "RTD_IC14"; +const char *RTD_IC15_STRING = "RTD_IC15"; +const char *RTD_IC16_STRING = "RTD_IC16"; +const char *RTD_IC17_STRING = "RTD_IC17"; +const char *RTD_IC18_STRING = "RTD_IC18"; const char *SYRLINKS_HK_HANDLER_STRING = "SYRLINKS_HK_HANDLER"; -const char *GPIO_IF_STRING = "GPIO_IF"; const char *ARDUINO_COM_IF_STRING = "ARDUINO_COM_IF"; -const char *CSP_COM_IF_STRING = "CSP_COM_IF"; -const char *I2C_COM_IF_STRING = "I2C_COM_IF"; -const char *UART_COM_IF_STRING = "UART_COM_IF"; +const char *GPIO_IF_STRING = "GPIO_IF"; const char *SPI_COM_IF_STRING = "SPI_COM_IF"; +const char *UART_COM_IF_STRING = "UART_COM_IF"; +const char *I2C_COM_IF_STRING = "I2C_COM_IF"; +const char *CSP_COM_IF_STRING = "CSP_COM_IF"; const char *CCSDS_PACKET_DISTRIBUTOR_STRING = "CCSDS_PACKET_DISTRIBUTOR"; const char *PUS_PACKET_DISTRIBUTOR_STRING = "PUS_PACKET_DISTRIBUTOR"; const char *UDP_BRIDGE_STRING = "UDP_BRIDGE"; const char *UDP_POLLING_TASK_STRING = "UDP_POLLING_TASK"; -const char *PUS_SERVICE_3_STRING = "PUS_SERVICE_3"; -const char *PUS_SERVICE_5_STRING = "PUS_SERVICE_5"; const char *PUS_SERVICE_6_STRING = "PUS_SERVICE_6"; -const char *PUS_SERVICE_8_STRING = "PUS_SERVICE_8"; -const char *PUS_SERVICE_23_STRING = "PUS_SERVICE_23"; -const char *PUS_SERVICE_201_STRING = "PUS_SERVICE_201"; -const char *TM_FUNNEL_STRING = "TM_FUNNEL"; const char *FSFW_OBJECTS_START_STRING = "FSFW_OBJECTS_START"; const char *PUS_SERVICE_1_VERIFICATION_STRING = "PUS_SERVICE_1_VERIFICATION"; const char *PUS_SERVICE_2_DEVICE_ACCESS_STRING = "PUS_SERVICE_2_DEVICE_ACCESS"; @@ -75,109 +97,150 @@ const char *TM_STORE_STRING = "TM_STORE"; const char *IPC_STORE_STRING = "IPC_STORE"; const char *TIME_STAMPER_STRING = "TIME_STAMPER"; const char *FSFW_OBJECTS_END_STRING = "FSFW_OBJECTS_END"; -const char *HEATER_HANDLER_STRING = "HEATER_HANDLER"; -const char *RTD_IC3_STRING = "RTD_IC3"; -const char *RTD_IC4_STRING = "RTD_IC4"; -const char *RTD_IC5_STRING = "RTD_IC5"; -const char *RTD_IC6_STRING = "RTD_IC6"; -const char *RTD_IC7_STRING = "RTD_IC7"; -const char *RTD_IC8_STRING = "RTD_IC8"; -const char *RTD_IC9_STRING = "RTD_IC9"; -const char *RTD_IC10_STRING = "RTD_IC10"; -const char *RTD_IC11_STRING = "RTD_IC11"; -const char *RTD_IC12_STRING = "RTD_IC12"; -const char *RTD_IC13_STRING = "RTD_IC13"; -const char *RTD_IC14_STRING = "RTD_IC14"; const char *SPI_TEST_STRING = "SPI_TEST"; -const char *RTD_IC15_STRING = "RTD_IC15"; -const char *RTD_IC16_STRING = "RTD_IC16"; -const char *RTD_IC17_STRING = "RTD_IC17"; -const char *RTD_IC18_STRING = "RTD_IC18"; -const char *RAD_SENSOR_STRING = "RAD_SENSOR"; +const char *UART_TEST_STRING = "UART_TEST"; const char *DUMMY_HANDLER_STRING = "DUMMY_HANDLER"; const char *DUMMY_INTERFACE_STRING = "DUMMY_INTERFACE"; const char *LIBGPIOD_TEST_STRING = "LIBGPIOD_TEST"; const char *TEST_TASK_STRING = "TEST_TASK"; +const char *TM_FUNNEL_STRING = "TM_FUNNEL"; +const char *CCSDS_IP_CORE_BRIDGE_STRING = "CCSDS_IP_CORE_BRIDGE"; const char *NO_OBJECT_STRING = "NO_OBJECT"; const char* translateObject(object_id_t object) { switch( (object & 0xFFFFFFFF) ) { case 0x00005060: return P60DOCK_TEST_TASK_STRING; - case 0x44000001: - return P60DOCK_HANDLER_STRING; - case 0x44000002: - return PDU1_HANDLER_STRING; - case 0x44000003: - return PDU2_HANDLER_STRING; - case 0x44000004: - return ACU_HANDLER_STRING; - case 0x44000005: - return TMP1075_HANDLER_1_STRING; - case 0x44000006: - return TMP1075_HANDLER_2_STRING; - case 0x44000007: + case 0x43000003: + return CORE_CONTROLLER_STRING; + case 0x43100002: + return ACS_CONTROLLER_STRING; + case 0x43400001: + return THERMAL_CONTROLLER_STRING; + case 0x44120006: return MGM_0_LIS3_HANDLER_STRING; - case 0x44000008: - return MGM_1_RM3100_HANDLER_STRING; - case 0x44000009: - return MGM_2_LIS3_HANDLER_STRING; - case 0x44000010: - return MGM_3_RM3100_HANDLER_STRING; - case 0x44000011: + case 0x44120010: return GYRO_0_ADIS_HANDLER_STRING; - case 0x44000012: - return GYRO_1_L3G_HANDLER_STRING; - case 0x44000013: - return GYRO_2_L3G_HANDLER_STRING; - case 0x44000014: - return IMTQ_HANDLER_STRING; - case 0x44000015: - return PLOC_HANDLER_STRING; - case 0x44000016: + case 0x44120032: return SUS_1_STRING; - case 0x44000017: + case 0x44120033: return SUS_2_STRING; - case 0x44000018: + case 0x44120034: return SUS_3_STRING; - case 0x44000019: + case 0x44120035: return SUS_4_STRING; - case 0x4400001A: + case 0x44120036: return SUS_5_STRING; - case 0x4400001B: + case 0x44120037: return SUS_6_STRING; - case 0x4400001C: + case 0x44120038: return SUS_7_STRING; - case 0x4400001D: + case 0x44120039: return SUS_8_STRING; - case 0x4400001E: + case 0x44120040: return SUS_9_STRING; - case 0x4400001F: + case 0x44120041: return SUS_10_STRING; - case 0x44000021: + case 0x44120042: return SUS_11_STRING; - case 0x44000022: + case 0x44120043: return SUS_12_STRING; - case 0x44000023: + case 0x44120044: return SUS_13_STRING; - case 0x44001000: + case 0x44120107: + return MGM_1_RM3100_HANDLER_STRING; + case 0x44120111: + return GYRO_1_L3G_HANDLER_STRING; + case 0x44120208: + return MGM_2_LIS3_HANDLER_STRING; + case 0x44120212: + return GYRO_2_ADIS_HANDLER_STRING; + case 0x44120309: + return MGM_3_RM3100_HANDLER_STRING; + case 0x44120313: + return GYRO_3_L3G_HANDLER_STRING; + case 0x44130045: + return GPS0_HANDLER_STRING; + case 0x44130146: + return GPS1_HANDLER_STRING; + case 0x44140014: + return IMTQ_HANDLER_STRING; + case 0x442000A1: return PCDU_HANDLER_STRING; - case 0x44001001: + case 0x44210001: + return RW1_STRING; + case 0x44210002: + return RW2_STRING; + case 0x44210003: + return RW3_STRING; + case 0x44210004: + return RW4_STRING; + case 0x44250000: + return P60DOCK_HANDLER_STRING; + case 0x44250001: + return PDU1_HANDLER_STRING; + case 0x44250002: + return PDU2_HANDLER_STRING; + case 0x44250003: + return ACU_HANDLER_STRING; + case 0x443200A5: + return RAD_SENSOR_STRING; + case 0x44330015: + return PLOC_HANDLER_STRING; + case 0x444100A2: return SOLAR_ARRAY_DEPL_HANDLER_STRING; - case 0x44001002: + case 0x444100A4: + return HEATER_HANDLER_STRING; + case 0x44420004: + return TMP1075_HANDLER_1_STRING; + case 0x44420005: + return TMP1075_HANDLER_2_STRING; + case 0x44420016: + return RTD_IC3_STRING; + case 0x44420017: + return RTD_IC4_STRING; + case 0x44420018: + return RTD_IC5_STRING; + case 0x44420019: + return RTD_IC6_STRING; + case 0x44420020: + return RTD_IC7_STRING; + case 0x44420021: + return RTD_IC8_STRING; + case 0x44420022: + return RTD_IC9_STRING; + case 0x44420023: + return RTD_IC10_STRING; + case 0x44420024: + return RTD_IC11_STRING; + case 0x44420025: + return RTD_IC12_STRING; + case 0x44420026: + return RTD_IC13_STRING; + case 0x44420027: + return RTD_IC14_STRING; + case 0x44420028: + return RTD_IC15_STRING; + case 0x44420029: + return RTD_IC16_STRING; + case 0x44420030: + return RTD_IC17_STRING; + case 0x44420031: + return RTD_IC18_STRING; + case 0x445300A3: return SYRLINKS_HK_HANDLER_STRING; - case 0x47000001: - return GPIO_IF_STRING; - case 0x49000001: + case 0x49000000: return ARDUINO_COM_IF_STRING; - case 0x49000002: - return CSP_COM_IF_STRING; - case 0x49000003: - return I2C_COM_IF_STRING; - case 0x49000004: - return UART_COM_IF_STRING; - case 0x49000005: + case 0x49010005: + return GPIO_IF_STRING; + case 0x49020004: return SPI_COM_IF_STRING; + case 0x49030003: + return UART_COM_IF_STRING; + case 0x49040002: + return I2C_COM_IF_STRING; + case 0x49050001: + return CSP_COM_IF_STRING; case 0x50000100: return CCSDS_PACKET_DISTRIBUTOR_STRING; case 0x50000200: @@ -186,20 +249,8 @@ const char* translateObject(object_id_t object) { return UDP_BRIDGE_STRING; case 0x50000400: return UDP_POLLING_TASK_STRING; - case 0x51000300: - return PUS_SERVICE_3_STRING; - case 0x51000400: - return PUS_SERVICE_5_STRING; case 0x51000500: return PUS_SERVICE_6_STRING; - case 0x51000800: - return PUS_SERVICE_8_STRING; - case 0x51002300: - return PUS_SERVICE_23_STRING; - case 0x51020100: - return PUS_SERVICE_201_STRING; - case 0x52000002: - return TM_FUNNEL_STRING; case 0x53000000: return FSFW_OBJECTS_START_STRING; case 0x53000001: @@ -240,44 +291,10 @@ const char* translateObject(object_id_t object) { return TIME_STAMPER_STRING; case 0x53ffffff: return FSFW_OBJECTS_END_STRING; - case 0x54000003: - return HEATER_HANDLER_STRING; - case 0x54000004: - return RTD_IC3_STRING; - case 0x54000005: - return RTD_IC4_STRING; - case 0x54000006: - return RTD_IC5_STRING; - case 0x54000007: - return RTD_IC6_STRING; - case 0x54000008: - return RTD_IC7_STRING; - case 0x54000009: - return RTD_IC8_STRING; - case 0x5400000A: - return RTD_IC9_STRING; - case 0x5400000B: - return RTD_IC10_STRING; - case 0x5400000C: - return RTD_IC11_STRING; - case 0x5400000D: - return RTD_IC12_STRING; - case 0x5400000E: - return RTD_IC13_STRING; - case 0x5400000F: - return RTD_IC14_STRING; case 0x54000010: return SPI_TEST_STRING; - case 0x5400001F: - return RTD_IC15_STRING; - case 0x5400002F: - return RTD_IC16_STRING; - case 0x5400003F: - return RTD_IC17_STRING; - case 0x5400004F: - return RTD_IC18_STRING; - case 0x54000050: - return RAD_SENSOR_STRING; + case 0x54000020: + return UART_TEST_STRING; case 0x5400AFFE: return DUMMY_HANDLER_STRING; case 0x5400CAFE: @@ -286,6 +303,10 @@ const char* translateObject(object_id_t object) { return LIBGPIOD_TEST_STRING; case 0x54694269: return TEST_TASK_STRING; + case 0x73000100: + return TM_FUNNEL_STRING; + case 0x73500000: + return CCSDS_IP_CORE_BRIDGE_STRING; case 0xFFFFFFFF: return NO_OBJECT_STRING; default: diff --git a/mission/devices/RwHandler.cpp b/mission/devices/RwHandler.cpp index 45c721a8..a5f6dbef 100644 --- a/mission/devices/RwHandler.cpp +++ b/mission/devices/RwHandler.cpp @@ -68,7 +68,7 @@ ReturnValue_t RwHandler::buildNormalDeviceCommand(DeviceCommandId_t * id) { } ReturnValue_t RwHandler::buildTransitionDeviceCommand(DeviceCommandId_t * id) { - return RETURN_OK; + return NOTHING_TO_SEND; } ReturnValue_t RwHandler::buildCommandFromCommand(DeviceCommandId_t deviceCommand, @@ -230,7 +230,7 @@ void RwHandler::setNormalDatapoolEntriesInvalid() { } uint32_t RwHandler::getTransitionDelayMs(Mode_t modeFrom, Mode_t modeTo) { - return 500; + return 5000; } ReturnValue_t RwHandler::initializeLocalDataPool(localpool::DataPool& localDataPoolMap, From e89719e398d506aecf3d2c61c3e3f1e3eaa47268 Mon Sep 17 00:00:00 2001 From: "Jakob.Meier" Date: Wed, 30 Jun 2021 08:21:14 +0200 Subject: [PATCH 21/26] save before using prepareDataLessCmd --- mission/devices/RwHandler.cpp | 56 ++++++++++-- mission/devices/RwHandler.h | 1 + .../devices/devicedefinitions/RwDefinitions.h | 91 ++++++++++++++++++- tmtc | 2 +- 4 files changed, 138 insertions(+), 12 deletions(-) diff --git a/mission/devices/RwHandler.cpp b/mission/devices/RwHandler.cpp index a5f6dbef..b637cbba 100644 --- a/mission/devices/RwHandler.cpp +++ b/mission/devices/RwHandler.cpp @@ -7,7 +7,7 @@ RwHandler::RwHandler(object_id_t objectId, object_id_t comIF, CookieIF * comCookie, LinuxLibgpioIF* gpioComIF, gpioId_t enableGpio) : DeviceHandlerBase(objectId, comIF, comCookie), gpioComIF(gpioComIF), enableGpio(enableGpio), - temperatureSet(this), statusSet(this), lastResetStatusSet(this) { + temperatureSet(this), statusSet(this), lastResetStatusSet(this), tmDataset(this) { if (comCookie == NULL) { sif::error << "RwHandler: Invalid com cookie" << std::endl; } @@ -113,6 +113,10 @@ ReturnValue_t RwHandler::buildCommandFromCommand(DeviceCommandId_t deviceCommand prepareGetTemperatureCmd(); return RETURN_OK; } + case (RwDefinitions::GET_TM): { + prepareGetTelemetryCmd(); + return RETURN_OK; + } default: return DeviceHandlerIF::COMMAND_NOT_IMPLEMENTED; } @@ -246,6 +250,29 @@ ReturnValue_t RwHandler::initializeLocalDataPool(localpool::DataPool& localDataP localDataPoolMap.emplace(RwDefinitions::LAST_RESET_STATUS, new PoolEntry( { 0 })); localDataPoolMap.emplace(RwDefinitions::CURRRENT_RESET_STATUS, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::TM_LAST_RESET_STATUS, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::TM_MCU_TEMPERATURE, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::TM_RW_STATE, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::TM_CLC_MODE, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::TM_RW_CURR_SPEED, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::TM_RW_REF_SPEED, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::INVALID_CRC_PACKETS, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::INVALID_LEN_PACKETS, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::INVALID_CMD_PACKETS, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::EXECUTED_REPLIES, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::COMMAND_REPLIES, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::UART_BYTES_WRITTEN, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::UART_BYTES_READ, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::UART_PARITY_ERRORS, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::UART_NOISE_ERRORS, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::UART_FRAME_ERRORS, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::UART_REG_OVERRUN_ERRORS, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::UART_TOTAL_ERRORS, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::SPI_BYTES_WRITTEN, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::SPI_BYTES_READ, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::SPI_REG_OVERRUN_ERRORS, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::SPI_TOTAL_ERRORS, new PoolEntry( { 0 })); + return RETURN_OK; } @@ -312,15 +339,6 @@ void RwHandler::prepareInitRwCommand() { rawPacketLen = 3; } -void RwHandler::prepareGetTemperatureCmd() { - commandBuffer[0] = static_cast(RwDefinitions::GET_TEMPERATURE); - uint16_t crc = CRC::crc16ccitt(commandBuffer, 1, 0xFFFF); - commandBuffer[1] = static_cast(crc & 0xFF); - commandBuffer[2] = static_cast(crc >> 8 & 0xFF); - rawPacket = commandBuffer; - rawPacketLen = 3; -} - void RwHandler::prepareSetSpeedCmd(const uint8_t * commandData, size_t commandDataLen) { commandBuffer[0] = static_cast(RwDefinitions::SET_SPEED); @@ -340,6 +358,24 @@ void RwHandler::prepareSetSpeedCmd(const uint8_t * commandData, size_t commandDa rawPacketLen = 9; } +void RwHandler::prepareGetTemperatureCmd() { + commandBuffer[0] = static_cast(RwDefinitions::GET_TEMPERATURE); + uint16_t crc = CRC::crc16ccitt(commandBuffer, 1, 0xFFFF); + commandBuffer[1] = static_cast(crc & 0xFF); + commandBuffer[2] = static_cast(crc >> 8 & 0xFF); + rawPacket = commandBuffer; + rawPacketLen = 3; +} + +void RwHandler::prepareGetTelemetryCmd() { + commandBuffer[0] = static_cast(RwDefinitions::GET_TM); + uint16_t crc = CRC::crc16ccitt(commandBuffer, 1, 0xFFFF); + commandBuffer[1] = static_cast(crc & 0xFF); + commandBuffer[2] = static_cast(crc >> 8 & 0xFF); + rawPacket = commandBuffer; + rawPacketLen = 3; +} + void RwHandler::handleResetStatusReply(const uint8_t* packet) { PoolReadGuard rg(&lastResetStatusSet); uint8_t offset = 2; diff --git a/mission/devices/RwHandler.h b/mission/devices/RwHandler.h index 11fb4a30..e447932d 100644 --- a/mission/devices/RwHandler.h +++ b/mission/devices/RwHandler.h @@ -88,6 +88,7 @@ private: RwDefinitions::TemperatureSet temperatureSet; RwDefinitions::StatusSet statusSet; RwDefinitions::LastResetSatus lastResetStatusSet; + RwDefinitions::TmDataset tmDataset; uint8_t commandBuffer[RwDefinitions::MAX_CMD_SIZE]; diff --git a/mission/devices/devicedefinitions/RwDefinitions.h b/mission/devices/devicedefinitions/RwDefinitions.h index fbdbd5cf..a477f47c 100644 --- a/mission/devices/devicedefinitions/RwDefinitions.h +++ b/mission/devices/devicedefinitions/RwDefinitions.h @@ -17,7 +17,30 @@ enum PoolIds: lp_id_t { STATE, CLC_MODE, LAST_RESET_STATUS, - CURRRENT_RESET_STATUS + CURRRENT_RESET_STATUS, + TM_LAST_RESET_STATUS, + TM_MCU_TEMPERATURE, + TM_RW_STATE, + TM_CLC_MODE, + TM_RW_CURR_SPEED, + TM_RW_REF_SPEED, + INVALID_CRC_PACKETS, + INVALID_LEN_PACKETS, + INVALID_CMD_PACKETS, + EXECUTED_REPLIES, + COMMAND_REPLIES, + UART_BYTES_WRITTEN, + UART_BYTES_READ, + UART_PARITY_ERRORS, + UART_NOISE_ERRORS, + UART_FRAME_ERRORS, + UART_REG_OVERRUN_ERRORS, + UART_TOTAL_ERRORS, + TOTAL_ERRORS, + SPI_BYTES_WRITTEN, + SPI_BYTES_READ, + SPI_REG_OVERRUN_ERRORS, + SPI_TOTAL_ERRORS }; enum States: uint8_t { @@ -46,10 +69,12 @@ static const DeviceCommandId_t GET_RW_STATUS = 4; static const DeviceCommandId_t INIT_RW_CONTROLLER = 5; static const DeviceCommandId_t SET_SPEED = 6; static const DeviceCommandId_t GET_TEMPERATURE = 8; +static const DeviceCommandId_t GET_TM = 9; static const uint32_t TEMPERATURE_SET_ID = GET_TEMPERATURE; static const uint32_t STATUS_SET_ID = GET_RW_STATUS; static const uint32_t LAST_RESET_ID = GET_LAST_RESET_STATUS; +static const uint32_t TM_SET_ID = GET_TM; static const size_t SIZE_GET_RESET_STATUS = 5; static const size_t SIZE_CLEAR_RESET_STATUS = 4; @@ -67,6 +92,7 @@ static const size_t MAX_REPLY_SIZE = SIZE_GET_TELEMETRY_REPLY; static const uint8_t LAST_RESET_ENTRIES = 2; static const uint8_t TEMPERATURE_SET_ENTRIES = 1; static const uint8_t STATUS_SET_ENTRIES = 4; +static const uint8_t TM_SET_ENTRIES = 22; /** * @brief This dataset can be used to store the temperature of a reaction wheel. @@ -133,6 +159,69 @@ public: PoolIds::CURRRENT_RESET_STATUS, this); }; +/** + * @brief This dataset stores telemetry data as specified in the datasheet of the nano avionics + * reaction wheels. https://eive-cloud.irs.uni-stuttgart.de/index.php/apps/files/?dir=/ + * EIVE_IRS/Arbeitsdaten/08_Used%20Components/Nanoavionics_Reactionwheels&fileid=181622 + */ +class TmDataset: + public StaticLocalDataSet { +public: + + TmDataset(HasLocalDataPoolIF* owner): + StaticLocalDataSet(owner, TM_SET_ID) { + } + + TmDataset(object_id_t objectId): + StaticLocalDataSet(sid_t(objectId, TM_SET_ID)) { + } + + lp_var_t lastResetStatus = lp_var_t(sid.objectId, + PoolIds::TM_LAST_RESET_STATUS, this); + lp_var_t mcuTemperature = lp_var_t(sid.objectId, + PoolIds::TM_MCU_TEMPERATURE, this); + lp_var_t rwState = lp_var_t(sid.objectId, + PoolIds::TM_RW_STATE, this); + lp_var_t rwClcMode = lp_var_t(sid.objectId, + PoolIds::TM_CLC_MODE, this); + lp_var_t rwCurrSpeed = lp_var_t(sid.objectId, + PoolIds::TM_RW_CURR_SPEED, this); + lp_var_t rwRefSpeed = lp_var_t(sid.objectId, + PoolIds::TM_RW_REF_SPEED, this); + lp_var_t numOfInvalidCrcPackets = lp_var_t(sid.objectId, + PoolIds::INVALID_CRC_PACKETS, this); + lp_var_t numOfInvalidLenPackets = lp_var_t(sid.objectId, + PoolIds::INVALID_LEN_PACKETS, this); + lp_var_t numOfInvalidCmdPackets = lp_var_t(sid.objectId, + PoolIds::INVALID_CMD_PACKETS, this); + lp_var_t numOfCmdExecutedReplies = lp_var_t(sid.objectId, + PoolIds::EXECUTED_REPLIES, this); + lp_var_t numOfCmdeplies = lp_var_t(sid.objectId, + PoolIds::COMMAND_REPLIES, this); + lp_var_t uartNumOfBytesWritten = lp_var_t(sid.objectId, + PoolIds::UART_BYTES_WRITTEN, this); + lp_var_t uartNumOfBytesRead = lp_var_t(sid.objectId, + PoolIds::UART_BYTES_READ, this); + lp_var_t uartNumOfParityErrors = lp_var_t(sid.objectId, + PoolIds::UART_PARITY_ERRORS, this); + lp_var_t uartNumOfNoiseErrors = lp_var_t(sid.objectId, + PoolIds::UART_NOISE_ERRORS, this); + lp_var_t uartNumOfFrameErrors = lp_var_t(sid.objectId, + PoolIds::UART_FRAME_ERRORS, this); + lp_var_t uartNumOfRegisterOverrunErrors = lp_var_t(sid.objectId, + PoolIds::UART_REG_OVERRUN_ERRORS, this); + lp_var_t uartTotalNumOfErrors = lp_var_t(sid.objectId, + PoolIds::UART_TOTAL_ERRORS, this); + lp_var_t spiNumOfBytesWritten = lp_var_t(sid.objectId, + PoolIds::SPI_BYTES_WRITTEN, this); + lp_var_t spiNumOfBytesRead = lp_var_t(sid.objectId, + PoolIds::SPI_BYTES_READ, this); + lp_var_t spiNumOfRegisterOverrunErrors = lp_var_t(sid.objectId, + PoolIds::SPI_REG_OVERRUN_ERRORS, this); + lp_var_t spiTotalNumOfErrors = lp_var_t(sid.objectId, + PoolIds::SPI_TOTAL_ERRORS, this); +}; + } #endif /* MISSION_DEVICES_DEVICEDEFINITIONS_RWDEFINITIONS_H_ */ diff --git a/tmtc b/tmtc index 09cab194..78b68307 160000 --- a/tmtc +++ b/tmtc @@ -1 +1 @@ -Subproject commit 09cab1941fad0bbe8fa54234f7513c61e22038ca +Subproject commit 78b68307825754b468404ee4ff006ee87e0bdd5f From 11776fe3319b7b039cb99cc7b31808957c66111b Mon Sep 17 00:00:00 2001 From: "Jakob.Meier" Date: Wed, 30 Jun 2021 15:07:26 +0200 Subject: [PATCH 22/26] added get telemetry command --- mission/devices/RwHandler.cpp | 202 ++++++++++++------ mission/devices/RwHandler.h | 41 +--- .../devices/devicedefinitions/RwDefinitions.h | 10 +- 3 files changed, 155 insertions(+), 98 deletions(-) diff --git a/mission/devices/RwHandler.cpp b/mission/devices/RwHandler.cpp index b637cbba..beb17602 100644 --- a/mission/devices/RwHandler.cpp +++ b/mission/devices/RwHandler.cpp @@ -77,23 +77,23 @@ ReturnValue_t RwHandler::buildCommandFromCommand(DeviceCommandId_t deviceCommand switch (deviceCommand) { case (RwDefinitions::RESET_MCU): { - prepareResetMcuCommand(); + prepareSimpleCommand(deviceCommand); return RETURN_OK; } case (RwDefinitions::GET_LAST_RESET_STATUS): { - prepareGetLastResetStatusCommand(); + prepareSimpleCommand(deviceCommand); return RETURN_OK; } case (RwDefinitions::CLEAR_LAST_RESET_STATUS): { - prepareClearResetStatusCommand(); + prepareSimpleCommand(deviceCommand); return RETURN_OK; } case (RwDefinitions::GET_RW_STATUS): { - prepareGetStatusCmd(commandData, commandDataLen); + prepareSimpleCommand(deviceCommand); return RETURN_OK; } case (RwDefinitions::INIT_RW_CONTROLLER): { - prepareInitRwCommand(); + prepareSimpleCommand(deviceCommand); return RETURN_OK; } case (RwDefinitions::SET_SPEED): { @@ -110,11 +110,11 @@ ReturnValue_t RwHandler::buildCommandFromCommand(DeviceCommandId_t deviceCommand return result; } case (RwDefinitions::GET_TEMPERATURE): { - prepareGetTemperatureCmd(); + prepareSimpleCommand(deviceCommand); return RETURN_OK; } case (RwDefinitions::GET_TM): { - prepareGetTelemetryCmd(); + prepareSimpleCommand(deviceCommand); return RETURN_OK; } default: @@ -137,6 +137,8 @@ void RwHandler::fillCommandAndReplyMap() { RwDefinitions::SIZE_GET_TEMPERATURE_REPLY); this->insertInCommandAndReplyMap(RwDefinitions::SET_SPEED, 1, nullptr, RwDefinitions::SIZE_SET_SPEED_REPLY); + this->insertInCommandAndReplyMap(RwDefinitions::GET_TM, 1, &tmDataset, + RwDefinitions::SIZE_GET_TELEMETRY_REPLY); } ReturnValue_t RwHandler::scanForReply(const uint8_t *start, size_t remainingSize, @@ -173,6 +175,12 @@ ReturnValue_t RwHandler::scanForReply(const uint8_t *start, size_t remainingSize *foundId = RwDefinitions::GET_TEMPERATURE; break; } + case (static_cast(RwDefinitions::GET_TM)): { +// *foundLen = RwDefinitions::SIZE_GET_TELEMETRY_REPLY; + *foundLen = 91; + *foundId = RwDefinitions::GET_TM; + break; + } default: { sif::debug << "RwHandler::scanForReply: Reply contains invalid command code" << std::endl; return RETURN_FAILED; @@ -220,6 +228,10 @@ ReturnValue_t RwHandler::interpretDeviceReply(DeviceCommandId_t id, const uint8_ handleTemperatureReply(packet); break; } + case (RwDefinitions::GET_TM): { + handleGetTelemetryReply(packet); + break; + } default: { sif::debug << "RwHandler::interpretDeviceReply: Unknown device reply id" << std::endl; return DeviceHandlerIF::UNKNOWN_DEVICE_REPLY; @@ -251,11 +263,11 @@ ReturnValue_t RwHandler::initializeLocalDataPool(localpool::DataPool& localDataP localDataPoolMap.emplace(RwDefinitions::CURRRENT_RESET_STATUS, new PoolEntry( { 0 })); localDataPoolMap.emplace(RwDefinitions::TM_LAST_RESET_STATUS, new PoolEntry( { 0 })); - localDataPoolMap.emplace(RwDefinitions::TM_MCU_TEMPERATURE, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::TM_MCU_TEMPERATURE, new PoolEntry( { 0 })); localDataPoolMap.emplace(RwDefinitions::TM_RW_STATE, new PoolEntry( { 0 })); localDataPoolMap.emplace(RwDefinitions::TM_CLC_MODE, new PoolEntry( { 0 })); - localDataPoolMap.emplace(RwDefinitions::TM_RW_CURR_SPEED, new PoolEntry( { 0 })); - localDataPoolMap.emplace(RwDefinitions::TM_RW_REF_SPEED, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::TM_RW_CURR_SPEED, new PoolEntry( { 0 })); + localDataPoolMap.emplace(RwDefinitions::TM_RW_REF_SPEED, new PoolEntry( { 0 })); localDataPoolMap.emplace(RwDefinitions::INVALID_CRC_PACKETS, new PoolEntry( { 0 })); localDataPoolMap.emplace(RwDefinitions::INVALID_LEN_PACKETS, new PoolEntry( { 0 })); localDataPoolMap.emplace(RwDefinitions::INVALID_CMD_PACKETS, new PoolEntry( { 0 })); @@ -276,33 +288,8 @@ ReturnValue_t RwHandler::initializeLocalDataPool(localpool::DataPool& localDataP return RETURN_OK; } -void RwHandler::prepareResetMcuCommand() { - commandBuffer[0] = static_cast(RwDefinitions::RESET_MCU); - rawPacket = commandBuffer; - rawPacketLen = 1; -} - -void RwHandler::prepareGetLastResetStatusCommand() { - commandBuffer[0] = static_cast(RwDefinitions::GET_LAST_RESET_STATUS); - uint16_t crc = CRC::crc16ccitt(commandBuffer, 1, 0xFFFF); - commandBuffer[1] = static_cast(crc & 0xFF); - commandBuffer[2] = static_cast(crc >> 8 & 0xFF); - rawPacket = commandBuffer; - rawPacketLen = 3; -} - -void RwHandler::prepareClearResetStatusCommand() { - commandBuffer[0] = static_cast(RwDefinitions::CLEAR_LAST_RESET_STATUS); - uint16_t crc = CRC::crc16ccitt(commandBuffer, 1, 0xFFFF); - commandBuffer[1] = static_cast(crc & 0xFF); - commandBuffer[2] = static_cast(crc >> 8 & 0xFF); - rawPacket = commandBuffer; - rawPacketLen = 3; -} - -void RwHandler::prepareGetStatusCmd(const uint8_t * commandData, size_t commandDataLen) { - commandBuffer[0] = static_cast(RwDefinitions::GET_RW_STATUS); - +void RwHandler::prepareSimpleCommand(DeviceCommandId_t id) { + commandBuffer[0] = static_cast(id); uint16_t crc = CRC::crc16ccitt(commandBuffer, 1, 0xFFFF); commandBuffer[1] = static_cast(crc & 0xFF); commandBuffer[2] = static_cast(crc >> 8 & 0xFF); @@ -330,15 +317,6 @@ ReturnValue_t RwHandler::checkSpeedAndRampTime(const uint8_t* commandData, size_ return RETURN_OK; } -void RwHandler::prepareInitRwCommand() { - commandBuffer[0] = static_cast(RwDefinitions::INIT_RW_CONTROLLER); - uint16_t crc = CRC::crc16ccitt(commandBuffer, 1, 0xFFFF); - commandBuffer[1] = static_cast(crc & 0xFF); - commandBuffer[2] = static_cast(crc >> 8 & 0xFF); - rawPacket = commandBuffer; - rawPacketLen = 3; -} - void RwHandler::prepareSetSpeedCmd(const uint8_t * commandData, size_t commandDataLen) { commandBuffer[0] = static_cast(RwDefinitions::SET_SPEED); @@ -358,24 +336,6 @@ void RwHandler::prepareSetSpeedCmd(const uint8_t * commandData, size_t commandDa rawPacketLen = 9; } -void RwHandler::prepareGetTemperatureCmd() { - commandBuffer[0] = static_cast(RwDefinitions::GET_TEMPERATURE); - uint16_t crc = CRC::crc16ccitt(commandBuffer, 1, 0xFFFF); - commandBuffer[1] = static_cast(crc & 0xFF); - commandBuffer[2] = static_cast(crc >> 8 & 0xFF); - rawPacket = commandBuffer; - rawPacketLen = 3; -} - -void RwHandler::prepareGetTelemetryCmd() { - commandBuffer[0] = static_cast(RwDefinitions::GET_TM); - uint16_t crc = CRC::crc16ccitt(commandBuffer, 1, 0xFFFF); - commandBuffer[1] = static_cast(crc & 0xFF); - commandBuffer[2] = static_cast(crc >> 8 & 0xFF); - rawPacket = commandBuffer; - rawPacketLen = 3; -} - void RwHandler::handleResetStatusReply(const uint8_t* packet) { PoolReadGuard rg(&lastResetStatusSet); uint8_t offset = 2; @@ -438,3 +398,117 @@ void RwHandler::handleTemperatureReply(const uint8_t* packet) { << temperatureSet.temperatureCelcius << " °C" << std::endl; #endif } + +void RwHandler::handleGetTelemetryReply(const uint8_t* packet) { + PoolReadGuard rg(&tmDataset); + uint8_t offset = 2; + tmDataset.lastResetStatus = *(packet + offset); + offset += 1; + tmDataset.mcuTemperature = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 + | *(packet + offset + 1) << 8 | *(packet + offset); + offset += 4; + offset += 8; + tmDataset.rwState = *(packet + offset); + offset += 1; + tmDataset.rwClcMode = *(packet + offset); + offset += 1; + tmDataset.rwCurrSpeed = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 + | *(packet + offset + 1) << 8 | *(packet + offset); + offset += 4; + tmDataset.rwRefSpeed = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 + | *(packet + offset + 1) << 8 | *(packet + offset); + offset += 4; + tmDataset.numOfInvalidCrcPackets = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 + | *(packet + offset + 1) << 8 | *(packet + offset); + offset += 4; + tmDataset.numOfInvalidLenPackets = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 + | *(packet + offset + 1) << 8 | *(packet + offset); + offset += 4; + tmDataset.numOfInvalidCmdPackets = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 + | *(packet + offset + 1) << 8 | *(packet + offset); + offset += 4; + tmDataset.numOfCmdExecutedReplies = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 + | *(packet + offset + 1) << 8 | *(packet + offset); + offset += 4; + tmDataset.numOfCmdReplies = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 + | *(packet + offset + 1) << 8 | *(packet + offset); + offset += 4; + tmDataset.uartNumOfBytesWritten = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 + | *(packet + offset + 1) << 8 | *(packet + offset); + offset += 4; + tmDataset.uartNumOfBytesRead = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 + | *(packet + offset + 1) << 8 | *(packet + offset); + offset += 4; + tmDataset.uartNumOfParityErrors = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 + | *(packet + offset + 1) << 8 | *(packet + offset); + offset += 4; + tmDataset.uartNumOfNoiseErrors = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 + | *(packet + offset + 1) << 8 | *(packet + offset); + offset += 4; + tmDataset.uartNumOfFrameErrors = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 + | *(packet + offset + 1) << 8 | *(packet + offset); + offset += 4; + tmDataset.uartNumOfRegisterOverrunErrors = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 + | *(packet + offset + 1) << 8 | *(packet + offset); + offset += 4; + tmDataset.uartTotalNumOfErrors = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 + | *(packet + offset + 1) << 8 | *(packet + offset); + offset += 4; + tmDataset.spiNumOfBytesWritten = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 + | *(packet + offset + 1) << 8 | *(packet + offset); + offset += 4; + tmDataset.spiNumOfBytesRead = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 + | *(packet + offset + 1) << 8 | *(packet + offset); + offset += 4; + tmDataset.spiNumOfRegisterOverrunErrors = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 + | *(packet + offset + 1) << 8 | *(packet + offset); + offset += 4; + tmDataset.spiTotalNumOfErrors = *(packet + offset + 3) << 24 | *(packet + offset + 2) << 16 + | *(packet + offset + 1) << 8 | *(packet + offset); +#if OBSW_VERBOSE_LEVEL >= 1 && RW_DEBUG == 1 + sif::info << "RwHandler::handleTemperatureReply: Last reset status: " + << static_cast(tmDataset.lastResetStatus.value) << std::endl; + sif::info << "RwHandler::handleTemperatureReply: MCU temperature: " << tmDataset.mcuTemperature + << std::endl; + sif::info << "RwHandler::handleTemperatureReply: State: " + << static_cast(tmDataset.rwState.value) << std::endl; + sif::info << "RwHandler::handleTemperatureReply: CLC mode: " + << static_cast(tmDataset.rwClcMode.value) << std::endl; + sif::info << "RwHandler::handleTemperatureReply: Current speed: " << tmDataset.rwCurrSpeed + << std::endl; + sif::info << "RwHandler::handleTemperatureReply: Reference speed: " << tmDataset.rwRefSpeed + << std::endl; + sif::info << "RwHandler::handleTemperatureReply: Number of invalid CRC packets: " + << tmDataset.numOfInvalidCrcPackets << std::endl; + sif::info << "RwHandler::handleTemperatureReply: Number of invalid length packets: " + << tmDataset.numOfInvalidLenPackets << std::endl; + sif::info << "RwHandler::handleTemperatureReply: Number of invalid command packets: " + << tmDataset.numOfInvalidCmdPackets << std::endl; + sif::info << "RwHandler::handleTemperatureReply: Number of command executed replies: " + << tmDataset.numOfCmdExecutedReplies << std::endl; + sif::info << "RwHandler::handleTemperatureReply: Number of command replies: " + << tmDataset.numOfCmdReplies << std::endl; + sif::info << "RwHandler::handleTemperatureReply: UART number of bytes written: " + << tmDataset.uartNumOfBytesWritten << std::endl; + sif::info << "RwHandler::handleTemperatureReply: UART number of bytes read: " + << tmDataset.uartNumOfBytesRead << std::endl; + sif::info << "RwHandler::handleTemperatureReply: UART number of parity errors: " + << tmDataset.uartNumOfParityErrors << std::endl; + sif::info << "RwHandler::handleTemperatureReply: UART number of noise errors: " + << tmDataset.uartNumOfNoiseErrors << std::endl; + sif::info << "RwHandler::handleTemperatureReply: UART number of frame errors: " + << tmDataset.uartNumOfFrameErrors << std::endl; + sif::info << "RwHandler::handleTemperatureReply: UART number of register overrun errors: " + << tmDataset.uartNumOfRegisterOverrunErrors << std::endl; + sif::info << "RwHandler::handleTemperatureReply: UART number of total errors: " + << tmDataset.uartTotalNumOfErrors << std::endl; + sif::info << "RwHandler::handleTemperatureReply: SPI number of bytes written: " + << tmDataset.spiNumOfBytesWritten << std::endl; + sif::info << "RwHandler::handleTemperatureReply: SPI number of bytes read: " + << tmDataset.spiNumOfBytesRead << std::endl; + sif::info << "RwHandler::handleTemperatureReply: SPI number of register overrun errors: " + << tmDataset.spiNumOfRegisterOverrunErrors << std::endl; + sif::info << "RwHandler::handleTemperatureReply: SPI number of register total errors: " + << tmDataset.spiTotalNumOfErrors << std::endl; +#endif +} diff --git a/mission/devices/RwHandler.h b/mission/devices/RwHandler.h index e447932d..cd753be0 100644 --- a/mission/devices/RwHandler.h +++ b/mission/devices/RwHandler.h @@ -105,26 +105,11 @@ private: size_t sizeOfReply = 0; /** - * @brief This function fills the command buffer with the data to reset the MCU on a reaction - * wheel. + * @brief This function can be used to build commands which do not contain any data apart + * from the command id and the CRC. + * @param commandId The command id of the command to build. */ - void prepareResetMcuCommand(); - - /** - * @brief This function prepares the command to request the last reset status - */ - void prepareGetLastResetStatusCommand(); - - /** - * @brief Fills the command buffer with the command to clear the reset status. - */ - void prepareClearResetStatusCommand(); - - /** - * @brief This function prepares the send buffer with the data to request the status of - * the reaction wheel. - */ - void prepareGetStatusCmd(const uint8_t * commandData, size_t commandDataLen); + void prepareSimpleCommand(DeviceCommandId_t id); /** * @brief This function checks if the receiced speed and ramp time to set are in a valid @@ -133,24 +118,12 @@ private: */ ReturnValue_t checkSpeedAndRampTime(const uint8_t * commandData, size_t commandDataLen); - /** - * @brief This function fills the commandBuffer with the data to request initialize the - * reaction wheel controller. This command must be sent as soon as the state of a - * reaction wheel is equal to 1 which indicates an error. - */ - void prepareInitRwCommand(); - /** * @brief This function prepares the set speed command from the commandData received with * an action message. */ void prepareSetSpeedCmd(const uint8_t * commandData, size_t commandDataLen); - /** - * @brief This function fills the commandBuffer with the data to request the temperature. - */ - void prepareGetTemperatureCmd(); - /** * @brief This function writes the last reset status retrieved with the get last reset status * command into the reset status dataset. @@ -170,6 +143,12 @@ private: * @brief This function fills the status set with the data from the get-status-reply. */ void handleGetRwStatusReply(const uint8_t* packet); + + /** + * @brief This function fills the tmDataset with the reply data requested with get telemetry + * command. + */ + void handleGetTelemetryReply(const uint8_t* packet); }; #endif /* MISSION_DEVICES_RWHANDLER_H_ */ diff --git a/mission/devices/devicedefinitions/RwDefinitions.h b/mission/devices/devicedefinitions/RwDefinitions.h index a477f47c..d87c09fd 100644 --- a/mission/devices/devicedefinitions/RwDefinitions.h +++ b/mission/devices/devicedefinitions/RwDefinitions.h @@ -87,7 +87,11 @@ static const size_t SIZE_GET_TELEMETRY_REPLY = 83; /** Set speed command has maximum size */ static const size_t MAX_CMD_SIZE = 9; -static const size_t MAX_REPLY_SIZE = SIZE_GET_TELEMETRY_REPLY; +/** + * Max reply is reached when each byte is replaced by its substitude which should normally never + * happen. + */ +static const size_t MAX_REPLY_SIZE = 2 * SIZE_GET_TELEMETRY_REPLY; static const uint8_t LAST_RESET_ENTRIES = 2; static const uint8_t TEMPERATURE_SET_ENTRIES = 1; @@ -178,7 +182,7 @@ public: lp_var_t lastResetStatus = lp_var_t(sid.objectId, PoolIds::TM_LAST_RESET_STATUS, this); - lp_var_t mcuTemperature = lp_var_t(sid.objectId, + lp_var_t mcuTemperature = lp_var_t(sid.objectId, PoolIds::TM_MCU_TEMPERATURE, this); lp_var_t rwState = lp_var_t(sid.objectId, PoolIds::TM_RW_STATE, this); @@ -196,7 +200,7 @@ public: PoolIds::INVALID_CMD_PACKETS, this); lp_var_t numOfCmdExecutedReplies = lp_var_t(sid.objectId, PoolIds::EXECUTED_REPLIES, this); - lp_var_t numOfCmdeplies = lp_var_t(sid.objectId, + lp_var_t numOfCmdReplies = lp_var_t(sid.objectId, PoolIds::COMMAND_REPLIES, this); lp_var_t uartNumOfBytesWritten = lp_var_t(sid.objectId, PoolIds::UART_BYTES_WRITTEN, this); From 11419676cf8621ede1b179d8a9880e22e6e73fdb Mon Sep 17 00:00:00 2001 From: "Jakob.Meier" Date: Wed, 30 Jun 2021 15:46:58 +0200 Subject: [PATCH 23/26] added tmtc --- tmtc | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/tmtc b/tmtc index 78b68307..7a15062e 160000 --- a/tmtc +++ b/tmtc @@ -1 +1 @@ -Subproject commit 78b68307825754b468404ee4ff006ee87e0bdd5f +Subproject commit 7a15062efe696802e8a602a7b3b675265d75dac8 From 89581d03aa31a265dab5c885f9f6a9f622862478 Mon Sep 17 00:00:00 2001 From: "Jakob.Meier" Date: Thu, 1 Jul 2021 07:25:28 +0200 Subject: [PATCH 24/26] comment in readme --- README.md | 3 +++ 1 file changed, 3 insertions(+) diff --git a/README.md b/README.md index 53c1cfad..69aa4dc1 100644 --- a/README.md +++ b/README.md @@ -626,6 +626,9 @@ gpioget Example to get state: gpioget gpiochip7 14 +Both the MIOs and EMIOs can be accessed via the zynq_gpio instance which comprises 118 pins +(54 MIOs and 64 EMIOs). + ## Running the EIVE OBSW on a Raspberry Pi Special section for running the EIVE OBSW on the Raspberry Pi. From 8e98de6f3cdb985065b1408dd871ebbd0b2bc3df Mon Sep 17 00:00:00 2001 From: "Jakob.Meier" Date: Thu, 1 Jul 2021 10:53:50 +0200 Subject: [PATCH 25/26] added spi mux functionality to the rwSpiCallback --- bsp_q7s/ObjectFactory.cpp | 37 +++++++++------- bsp_q7s/spi/Q7sSpiComIF.cpp | 9 ++++ bsp_q7s/spi/Q7sSpiComIF.h | 33 +++++++++++++++ bsp_q7s/spiCallbacks/rwSpiCallback.cpp | 58 ++++++++++++++++---------- bsp_q7s/spiCallbacks/rwSpiCallback.h | 16 ++++++- linux/fsfwconfig/devices/gpioIds.h | 4 +- 6 files changed, 117 insertions(+), 40 deletions(-) create mode 100644 bsp_q7s/spi/Q7sSpiComIF.cpp create mode 100644 bsp_q7s/spi/Q7sSpiComIF.h diff --git a/bsp_q7s/ObjectFactory.cpp b/bsp_q7s/ObjectFactory.cpp index 936b1cd2..991cd8b2 100644 --- a/bsp_q7s/ObjectFactory.cpp +++ b/bsp_q7s/ObjectFactory.cpp @@ -521,12 +521,6 @@ void ObjectFactory::produce(void* args){ Max31865PT1000Handler* rtdIc16 = new Max31865PT1000Handler(objects::RTD_IC16, objects::SPI_COM_IF, spiRtdIc16, 0); Max31865PT1000Handler* rtdIc17 = new Max31865PT1000Handler(objects::RTD_IC17, objects::SPI_COM_IF, spiRtdIc17, 0); Max31865PT1000Handler* rtdIc18 = new Max31865PT1000Handler(objects::RTD_IC18, objects::SPI_COM_IF, spiRtdIc18, 0); -<<<<<<< HEAD - rtdIc3->setStartUpImmediately(); -======= - rtdIc17->setStartUpImmediately(); ->>>>>>> develop -// rtdIc4->setStartUpImmediately(); (void) rtdIc3; (void) rtdIc4; @@ -542,7 +536,7 @@ void ObjectFactory::produce(void* args){ (void) rtdIc14; (void) rtdIc15; (void) rtdIc16; -// (void) rtdIc17; + (void) rtdIc17; (void) rtdIc18; #endif /* Q7S_ADD_RTD_DEVICES == 1 */ @@ -582,16 +576,29 @@ void ObjectFactory::produce(void* args){ std::string("Enable reaction wheel 4"), gpio::OUT, 0); gpioCookieRw->addGpio(gpioIds::EN_RW4, enRw4); + /** + * This GPIO is only internally connected to the SPI MUX module and responsible to disconnect + * the PS SPI peripheral from the SPI interface and route out the SPI lines of the AXI SPI core. + * Per default the PS SPI is selected (EMIO = 0). + */ + GpiodRegular* spiMux = new GpiodRegular(std::string("gpiochip11"), 54, + std::string("EMIO 0 SPI Mux"), gpio::OUT, 0); + gpioCookieRw->addGpio(gpioIds::SPI_MUX, spiMux); + gpioComIF->addGpios(gpioCookieRw); - auto rw1SpiCookie = new SpiCookie(addresses::RW1, gpioIds::CS_RW1, "/dev/spidev2.0", - RwDefinitions::MAX_REPLY_SIZE, spi::RW_MODE, spi::RW_SPEED, &rwSpiCallback, nullptr); - auto rw2SpiCookie = new SpiCookie(addresses::RW2, gpioIds::CS_RW2, "/dev/spidev2.0", - RwDefinitions::MAX_REPLY_SIZE, spi::RW_MODE, spi::RW_SPEED, &rwSpiCallback, nullptr); - auto rw3SpiCookie = new SpiCookie(addresses::RW3, gpioIds::CS_RW3, "/dev/spidev2.0", - RwDefinitions::MAX_REPLY_SIZE, spi::RW_MODE, spi::RW_SPEED, &rwSpiCallback, nullptr); - auto rw4SpiCookie = new SpiCookie(addresses::RW4, gpioIds::CS_RW4, "/dev/spidev2.0", - RwDefinitions::MAX_REPLY_SIZE, spi::RW_MODE, spi::RW_SPEED, &rwSpiCallback, nullptr); + auto rw1SpiCookie = new SpiCookie(addresses::RW1, gpioIds::CS_RW1, "/dev/spidev3.0", + RwDefinitions::MAX_REPLY_SIZE, spi::RW_MODE, spi::RW_SPEED, &rwSpiCallback::spiCallback, + nullptr); + auto rw2SpiCookie = new SpiCookie(addresses::RW2, gpioIds::CS_RW2, "/dev/spidev3.0", + RwDefinitions::MAX_REPLY_SIZE, spi::RW_MODE, spi::RW_SPEED, &rwSpiCallback::spiCallback, + nullptr); + auto rw3SpiCookie = new SpiCookie(addresses::RW3, gpioIds::CS_RW3, "/dev/spidev3.0", + RwDefinitions::MAX_REPLY_SIZE, spi::RW_MODE, spi::RW_SPEED, &rwSpiCallback::spiCallback, + nullptr); + auto rw4SpiCookie = new SpiCookie(addresses::RW4, gpioIds::CS_RW4, "/dev/spidev3.0", + RwDefinitions::MAX_REPLY_SIZE, spi::RW_MODE, spi::RW_SPEED, &rwSpiCallback::spiCallback, + nullptr); auto rwHandler1 = new RwHandler(objects::RW1, objects::SPI_COM_IF, rw1SpiCookie, gpioComIF, gpioIds::EN_RW1); diff --git a/bsp_q7s/spi/Q7sSpiComIF.cpp b/bsp_q7s/spi/Q7sSpiComIF.cpp new file mode 100644 index 00000000..23dbe551 --- /dev/null +++ b/bsp_q7s/spi/Q7sSpiComIF.cpp @@ -0,0 +1,9 @@ +#include + +Q7sSpiComIF::Q7sSpiComIF(object_id_t objectId, GpioIF* gpioComIF) : + SpiComIF(objectId, gpioComIF) { +} + +Q7sSpiComIF::~Q7sSpiComIF() { +} + diff --git a/bsp_q7s/spi/Q7sSpiComIF.h b/bsp_q7s/spi/Q7sSpiComIF.h new file mode 100644 index 00000000..a10d63dd --- /dev/null +++ b/bsp_q7s/spi/Q7sSpiComIF.h @@ -0,0 +1,33 @@ +#ifndef BSP_Q7S_SPI_Q7SSPICOMIF_H_ +#define BSP_Q7S_SPI_Q7SSPICOMIF_H_ + +#include + + +/** + * @brief This additional communication interface is required because the SPI busses behind the + * devices "/dev/spi2.0" and "dev/spidev3.0" are multiplexed to one SPI interface. + * This was necessary because the processing system spi (/dev/spi2.0) does not support + * frequencies lower than 650 kHz. To reach lower frequencies also the CPU frequency must + * be reduced which leads to other effects compromising kernel drivers. + * The nano avionics reaction wheels require a spi frequency between 150 kHz and 300 kHz + * why an additional AXI SPI core has been implemented in the programmable logic. However, + * the spi frequency of the AXI SPI core is not configurable during runtime. Therefore, + * this communication interface multiplexes either the hard-wired SPI or the AXI SPI to + * the SPI interface. The multiplexing is performed via a GPIO connected to a VHDL + * module responsible for switching between the to SPI peripherals. + */ +class Q7sSpiComIF: public SpiComIF { +public: + /** + * @brief Constructor + * + * @param objectId + * @param gpioComIF + * @param gpioSwitchId The gpio ID of the GPIO connected to the SPI mux module in the PL. + */ + Q7sSpiComIF(object_id_t objectId, GpioIF* gpioComIF, gpioId_t gpioSwitchId); + virtual ~Q7sSpiComIF(); +}; + +#endif /* BSP_Q7S_SPI_Q7SSPICOMIF_H_ */ diff --git a/bsp_q7s/spiCallbacks/rwSpiCallback.cpp b/bsp_q7s/spiCallbacks/rwSpiCallback.cpp index bfb1892c..f05fbbdf 100644 --- a/bsp_q7s/spiCallbacks/rwSpiCallback.cpp +++ b/bsp_q7s/spiCallbacks/rwSpiCallback.cpp @@ -3,15 +3,18 @@ #include #include #include +#include "devices/gpioIds.h" -ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *sendData, +namespace rwSpiCallback { + +ReturnValue_t spiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *sendData, size_t sendLen, void* args) { ReturnValue_t result = HasReturnvaluesIF::RETURN_OK; RwHandler* handler = reinterpret_cast(args); if(handler == nullptr) { - sif::error << "rwSpiCallback: Pointer to handler is invalid" + sif::error << "rwSpiCallback::spiCallback: Pointer to handler is invalid" << std::endl; return HasReturnvaluesIF::RETURN_FAILED; } @@ -21,9 +24,9 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s int fileDescriptor = 0; std::string device = cookie->getSpiDevice(); - UnixFileGuard fileHelper(device, &fileDescriptor, O_RDWR, "rwSpiCallback: "); + UnixFileGuard fileHelper(device, &fileDescriptor, O_RDWR, "rwSpiCallback::spiCallback: "); if(fileHelper.getOpenResult() != HasReturnvaluesIF::RETURN_OK) { - sif::error << "rwSpiCallback: Failed to open device file" << std::endl; + sif::error << "rwSpiCallback::spiCallback: Failed to open device file" << std::endl; return SpiComIF::OPENING_FILE_FAILED; } spi::SpiModes spiMode = spi::SpiModes::MODE_0; @@ -37,16 +40,19 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s uint32_t timeoutMs = 0; MutexIF* mutex = comIf->getMutex(&timeoutType, &timeoutMs); if(mutex == nullptr or gpioIF == nullptr) { - sif::debug << "rwSpiCallback: Mutex or GPIO interface invalid" << std::endl; + sif::debug << "rwSpiCallback::spiCallback: Mutex or GPIO interface invalid" << std::endl; return HasReturnvaluesIF::RETURN_FAILED; } - if(gpioId != gpio::NO_GPIO) { - result = mutex->lockMutex(timeoutType, timeoutMs); - if (result != HasReturnvaluesIF::RETURN_OK) { - sif::debug << "rwSpiCallback: Failed to lock mutex" << std::endl; - return result; - } + result = mutex->lockMutex(timeoutType, timeoutMs); + if (result != HasReturnvaluesIF::RETURN_OK) { + sif::debug << "rwSpiCallback::spiCallback: Failed to lock mutex" << std::endl; + return result; + } + + /** Disconnect PS SPI peripheral and select AXI SPI core */ + if(gpioIF->pullHigh(gpioIds::SPI_MUX) != HasReturnvaluesIF::RETURN_OK) { + sif::error << "rwSpiCallback::spiCallback: Failed to pull spi mux gpio high" << std::endl; } /** Sending frame start sign */ @@ -56,12 +62,12 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s // Pull SPI CS low. For now, no support for active high given if(gpioId != gpio::NO_GPIO) { if(gpioIF->pullLow(gpioId) != HasReturnvaluesIF::RETURN_OK) { - sif::error << "rwSpiCallback: Failed to pull chip select low" << std::endl; + sif::error << "rwSpiCallback::spiCallback: Failed to pull chip select low" << std::endl; } } if (write(fileDescriptor, writeBuffer, writeSize) != static_cast(writeSize)) { - sif::error << "rwSpiCallback: Write failed!" << std::endl; + sif::error << "rwSpiCallback::spiCallback: Write failed!" << std::endl; closeSpi(gpioId, gpioIF, mutex); return RwHandler::SPI_WRITE_FAILURE; } @@ -86,7 +92,7 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s break; } if (write(fileDescriptor, writeBuffer, writeSize) != static_cast(writeSize)) { - sif::error << "rwSpiCallback: Write failed!" << std::endl; + sif::error << "rwSpiCallback::spiCallback: Write failed!" << std::endl; closeSpi(gpioId, gpioIF, mutex); return RwHandler::SPI_WRITE_FAILURE; } @@ -98,7 +104,7 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s writeSize = 1; if (write(fileDescriptor, writeBuffer, writeSize) != static_cast(writeSize)) { - sif::error << "rwSpiCallback: Write failed!" << std::endl; + sif::error << "rwSpiCallback::spiCallback: Write failed!" << std::endl; closeSpi(gpioId, gpioIF, mutex); return RwHandler::SPI_WRITE_FAILURE; } @@ -122,7 +128,7 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s uint8_t byteRead = 0; for (int idx = 0; idx < 10; idx++) { if(read(fileDescriptor, &byteRead, 1) != 1) { - sif::error << "rwSpiCallback: Read failed" << std::endl; + sif::error << "rwSpiCallback::spiCallback: Read failed" << std::endl; closeSpi(gpioId, gpioIF, mutex); return RwHandler::SPI_READ_FAILURE; } @@ -132,7 +138,7 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s } if (idx == 9) { - sif::error << "rwSpiCallback: Empty frame timeout" << std::endl; + sif::error << "rwSpiCallback::spiCallback: Empty frame timeout" << std::endl; closeSpi(gpioId, gpioIF, mutex); return RwHandler::NO_REPLY; } @@ -145,7 +151,7 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s if (decodedFrameLen != 0) { byteRead = 0; if(read(fileDescriptor, &byteRead, 1) != 1) { - sif::error << "rwSpiCallback: Read failed" << std::endl; + sif::error << "rwSpiCallback::spiCallback: Read failed" << std::endl; result = RwHandler::SPI_READ_FAILURE; break; } @@ -157,7 +163,7 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s } else if (byteRead == 0x7D) { if(read(fileDescriptor, &byteRead, 1) != 1) { - sif::error << "rwSpiCallback: Read failed" << std::endl; + sif::error << "rwSpiCallback::spiCallback: Read failed" << std::endl; result = RwHandler::SPI_READ_FAILURE; break; } @@ -172,7 +178,7 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s continue; } else { - sif::error << "rwSpiCallback: Invalid substitute" << std::endl; + sif::error << "rwSpiCallback::spiCallback: Invalid substitute" << std::endl; closeSpi(gpioId, gpioIF, mutex); result = RwHandler::INVALID_SUBSTITUTE; break; @@ -191,12 +197,12 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s */ if (decodedFrameLen == replyBufferSize) { if(read(fileDescriptor, &byteRead, 1) != 1) { - sif::error << "rwSpiCallback: Failed to read last byte" << std::endl; + sif::error << "rwSpiCallback::spiCallback: Failed to read last byte" << std::endl; result = RwHandler::SPI_READ_FAILURE; break; } if (byteRead != 0x7E) { - sif::error << "rwSpiCallback: Missing end sign 0x7E" << std::endl; + sif::error << "rwSpiCallback::spiCallback: Missing end sign 0x7E" << std::endl; decodedFrameLen--; result = RwHandler::MISSING_END_SIGN; break; @@ -219,6 +225,12 @@ void closeSpi (gpioId_t gpioId, GpioIF* gpioIF, MutexIF* mutex) { } } if(mutex->unlockMutex() != HasReturnvaluesIF::RETURN_OK) { - sif::error << "closeSpi: Failed to unlock mutex" << std::endl;; + sif::error << "rwSpiCallback::closeSpi: Failed to unlock mutex" << std::endl;; + } + + /** Route SPI interface again to PS SPI peripheral */ + if(gpioIF->pullLow(gpioIds::SPI_MUX) != HasReturnvaluesIF::RETURN_OK) { + sif::error << "rwSpiCallback::spiCallback: Failed to pull spi mux gpio low" << std::endl; } } +} diff --git a/bsp_q7s/spiCallbacks/rwSpiCallback.h b/bsp_q7s/spiCallbacks/rwSpiCallback.h index e684c1c1..e5a79e64 100644 --- a/bsp_q7s/spiCallbacks/rwSpiCallback.h +++ b/bsp_q7s/spiCallbacks/rwSpiCallback.h @@ -3,6 +3,10 @@ #include #include +#include + + +namespace rwSpiCallback { /** * @brief This is the callback function to send commands to the nano avionics reaction wheels and @@ -14,8 +18,17 @@ * Arbeitsdaten/08_Used%20Components/Nanoavionics_Reactionwheels&fileid=181622 * Each command entails exactly one reply which will also be read in and decoded by this * function. + * Because the reaction wheels require a spi clock frequency of maximum 300 kHZ and minimum + * 150 kHz which is not supported by the processing system SPI peripheral an AXI SPI core + * has been implemented in the programmable logic. This AXI SPI core works with a fixed + * frequency of 250 kHz. + * To allow the parallel usage of the same physical SPI bus, a VHDL module has been + * implemented which is able to disconnect the hard-wired SPI peripheral of the PS and + * route the AXI SPI to the SPI lines. + * To switch between the to SPI peripherals, an EMIO is used which will also be controlled + * by this function. */ -ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *sendData, +ReturnValue_t spiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *sendData, size_t sendLen, void* args); /** @@ -27,4 +40,5 @@ ReturnValue_t rwSpiCallback(SpiComIF* comIf, SpiCookie *cookie, const uint8_t *s */ void closeSpi(gpioId_t gpioId, GpioIF* gpioIF, MutexIF* mutex); +} #endif /* BSP_Q7S_RW_SPI_CALLBACK_H_ */ diff --git a/linux/fsfwconfig/devices/gpioIds.h b/linux/fsfwconfig/devices/gpioIds.h index 718bc9bf..aad06629 100644 --- a/linux/fsfwconfig/devices/gpioIds.h +++ b/linux/fsfwconfig/devices/gpioIds.h @@ -80,7 +80,9 @@ namespace gpioIds { CS_RW3, CS_RW4, - EN_RW_CS + EN_RW_CS, + + SPI_MUX }; } From b82ed37766c4669289cdeac9388045887881b52c Mon Sep 17 00:00:00 2001 From: "Jakob.Meier" Date: Thu, 1 Jul 2021 11:56:13 +0200 Subject: [PATCH 26/26] commend rad sensor in again --- .../pollingsequence/pollingSequenceFactory.cpp | 18 ++++++++---------- mission/devices/RadiationSensorHandler.cpp | 2 +- tmtc | 2 +- 3 files changed, 10 insertions(+), 12 deletions(-) diff --git a/linux/fsfwconfig/pollingsequence/pollingSequenceFactory.cpp b/linux/fsfwconfig/pollingsequence/pollingSequenceFactory.cpp index be184b6b..4b201f2b 100644 --- a/linux/fsfwconfig/pollingsequence/pollingSequenceFactory.cpp +++ b/linux/fsfwconfig/pollingsequence/pollingSequenceFactory.cpp @@ -18,16 +18,6 @@ ReturnValue_t pst::pstGpio(FixedTimeslotTaskIF *thisSequence) thisSequence->addSlot(objects::SOLAR_ARRAY_DEPL_HANDLER, length * 0, DeviceHandlerIF::PERFORM_OPERATION); - // Radiation sensor - // thisSequence->addSlot(objects::RAD_SENSOR, length * 0, DeviceHandlerIF::PERFORM_OPERATION); - // thisSequence->addSlot(objects::RAD_SENSOR, length * 0.2, DeviceHandlerIF::SEND_WRITE); - // thisSequence->addSlot(objects::RAD_SENSOR, length * 0.4, DeviceHandlerIF::GET_WRITE); - // thisSequence->addSlot(objects::RAD_SENSOR, length * 0.6, DeviceHandlerIF::SEND_READ); - // thisSequence->addSlot(objects::RAD_SENSOR, length * 0.8, DeviceHandlerIF::GET_READ); - // if (length != 3000) { - // sif::warning << "pollingSequenceInitDefault: Frequency changed. Make sure timing critical " - // << "SUS sensors still produce correct values" << std::endl; - // } if (thisSequence->checkSequence() == HasReturnvaluesIF::RETURN_OK) { return HasReturnvaluesIF::RETURN_OK; } @@ -145,6 +135,14 @@ ReturnValue_t pst::pstSpi(FixedTimeslotTaskIF *thisSequence) { thisSequence->addSlot(objects::RTD_IC17, length * 0.8, DeviceHandlerIF::GET_READ); thisSequence->addSlot(objects::RTD_IC18, length * 0.8, DeviceHandlerIF::GET_READ); #endif /* Q7S_ADD_RTD_DEVICES */ + + /* Radiation sensor */ + thisSequence->addSlot(objects::RAD_SENSOR, length * 0, DeviceHandlerIF::PERFORM_OPERATION); + thisSequence->addSlot(objects::RAD_SENSOR, length * 0.2, DeviceHandlerIF::SEND_WRITE); + thisSequence->addSlot(objects::RAD_SENSOR, length * 0.4, DeviceHandlerIF::GET_WRITE); + thisSequence->addSlot(objects::RAD_SENSOR, length * 0.6, DeviceHandlerIF::SEND_READ); + thisSequence->addSlot(objects::RAD_SENSOR, length * 0.8, DeviceHandlerIF::GET_READ); + /** * The sun sensor will be shutdown as soon as the chip select is pulled high. Thus all * requests to a sun sensor must be performed consecutively. Another reason for calling multiple diff --git a/mission/devices/RadiationSensorHandler.cpp b/mission/devices/RadiationSensorHandler.cpp index bd16ddaf..65a877b6 100644 --- a/mission/devices/RadiationSensorHandler.cpp +++ b/mission/devices/RadiationSensorHandler.cpp @@ -44,7 +44,7 @@ ReturnValue_t RadiationSensorHandler::buildNormalDeviceCommand( break; } default: { - sif::debug << "RadiationSensorHandler::buildNormalDeviceCommand: Unknwon communication " + sif::debug << "RadiationSensorHandler::buildNormalDeviceCommand: Unknown communication " << "step" << std::endl; return HasReturnvaluesIF::RETURN_OK; } diff --git a/tmtc b/tmtc index 7a15062e..fe1bed90 160000 --- a/tmtc +++ b/tmtc @@ -1 +1 @@ -Subproject commit 7a15062efe696802e8a602a7b3b675265d75dac8 +Subproject commit fe1bed900adb688cbd3906617c974188a43c5535