eive-obsw/mission/devices/PlocSupervisorHandler.h

227 lines
9.3 KiB
C
Raw Normal View History

#ifndef MISSION_DEVICES_PLOCSUPERVISORHANDLER_H_
#define MISSION_DEVICES_PLOCSUPERVISORHANDLER_H_
2021-03-29 14:37:52 +02:00
#include <fsfw/devicehandlers/DeviceHandlerBase.h>
#include <mission/devices/devicedefinitions/PlocSupervisorDefinitions.h>
2021-05-17 16:37:29 +02:00
#include <cstring>
2021-07-23 18:04:51 +02:00
#include <fsfw/hal/linux/uart/UartComIF.h>
2021-03-29 14:37:52 +02:00
/**
* @brief This is the device handler for the supervisor of the PLOC which is programmed by
* Thales.
*
* @details The PLOC uses the space packet protocol for communication. To each command the PLOC
* answers with at least one acknowledgment and one execution report.
* Flight manual:
* https://egit.irs.uni-stuttgart.de/redmine/projects/eive-flight-manual/wiki/PLOC_Commands
* ILH ICD: https://eive-cloud.irs.uni-stuttgart.de/index.php/apps/files/?dir=/EIVE_IRS/
* Arbeitsdaten/08_Used%20Components/PLOC&fileid=940960
2021-03-29 14:37:52 +02:00
* @author J. Meier
*/
class PlocSupervisorHandler: public DeviceHandlerBase {
2021-03-29 14:37:52 +02:00
public:
PlocSupervisorHandler(object_id_t objectId, object_id_t uartComIFid, CookieIF * comCookie);
virtual ~PlocSupervisorHandler();
2021-03-29 14:37:52 +02:00
virtual ReturnValue_t initialize() override;
2021-03-29 14:37:52 +02:00
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;
ReturnValue_t enableReplyInReplyMap(DeviceCommandMap::iterator command,
uint8_t expectedReplies = 1, bool useAlternateId = false,
DeviceCommandId_t alternateReplyID = 0) override;
size_t getNextReplyLength(DeviceCommandId_t deviceCommand) override;
2021-03-29 14:37:52 +02:00
private:
static const uint8_t INTERFACE_ID = CLASS_ID::PLOC_SUPERVISOR_HANDLER;
//! [EXPORT] : [COMMENT] Space Packet received from PLOC supervisor has invalid CRC
static const ReturnValue_t CRC_FAILURE = MAKE_RETURN_CODE(0xA0);
//! [EXPORT] : [COMMENT] Received ACK failure reply from PLOC supervisor
static const ReturnValue_t RECEIVED_ACK_FAILURE = MAKE_RETURN_CODE(0xA1);
//! [EXPORT] : [COMMENT] Received execution failure reply from PLOC supervisor
static const ReturnValue_t RECEIVED_EXE_FAILURE = MAKE_RETURN_CODE(0xA2);
//! [EXPORT] : [COMMENT] Received space packet with invalid APID from PLOC supervisor
static const ReturnValue_t INVALID_APID = MAKE_RETURN_CODE(0xA3);
//! [EXPORT] : [COMMENT] Failed to read current system time
static const ReturnValue_t GET_TIME_FAILURE = MAKE_RETURN_CODE(0xA4);
//! [EXPORT] : [COMMENT] Invalid communication interface specified
static const ReturnValue_t INVALID_UART_COM_IF = MAKE_RETURN_CODE(0xA5);
static const uint8_t SUBSYSTEM_ID = SUBSYSTEM_ID::PLOC_SUPERVISOR_HANDLER;
//! [EXPORT] : [COMMENT] PLOC supervrisor crc failure in telemetry packet
static const Event SUPV_MEMORY_READ_RPT_CRC_FAILURE = MAKE_EVENT(1, severity::LOW);
//! [EXPORT] : [COMMENT] PLOC supervisor received acknowledgment failure report
static const Event SUPV_ACK_FAILURE = MAKE_EVENT(2, severity::LOW);
//! [EXPORT] : [COMMENT] PLOC received execution failure report
static const Event SUPV_EXE_FAILURE = MAKE_EVENT(3, severity::LOW);
//! [EXPORT] : [COMMENT] PLOC supervisor reply has invalid crc
static const Event SUPV_CRC_FAILURE_EVENT = MAKE_EVENT(4, severity::LOW);
2021-03-29 14:37:52 +02:00
2021-04-11 12:04:13 +02:00
static const uint16_t APID_MASK = 0x7FF;
2021-04-27 17:34:50 +02:00
static const uint16_t PACKET_SEQUENCE_COUNT_MASK = 0x3FFF;
2021-03-29 14:37:52 +02:00
uint8_t commandBuffer[PLOC_SPV::MAX_COMMAND_SIZE];
2021-04-15 13:17:15 +02:00
2021-04-26 11:28:19 +02:00
/**
* @brief This object is incremented each time a packet is sent or received. By checking the
* packet sequence count of a received packet, no packets can be lost without noticing
* it. Only the least significant 14 bits represent the packet sequence count in a
* space packet. Thus the maximum value amounts to 16383 (0x3FFF).
* @note Normally this should never happen because the PLOC replies are always sent in a
* fixed order. However, the PLOC software checks this value and will return an ACK
* failure report in case the sequence count is not incremented with each transferred
* space packet.
2021-04-26 11:28:19 +02:00
*/
uint16_t packetSequenceCount = 0x3FFF;
2021-04-26 11:28:19 +02:00
/**
* This variable is used to store the id of the next reply to receive. This is necessary
* because the PLOC sends as reply to each command at least one acknowledgment and execution
* report.
*/
DeviceCommandId_t nextReplyId = PLOC_SPV::NONE;
PLOC_SPV::HkSet hkset;
2021-07-24 13:57:05 +02:00
PLOC_SPV::BootStatusReport bootStatusReport;
2021-03-29 14:37:52 +02:00
UartComIF* uartComIf = nullptr;
2021-03-29 14:37:52 +02:00
/**
2021-04-11 12:04:13 +02:00
* @brief This function checks the crc of the received PLOC reply.
*
* @param start Pointer to the first byte of the reply.
* @param foundLen Pointer to the length of the whole packet.
2021-03-29 14:37:52 +02:00
*
2021-04-11 12:04:13 +02:00
* @return RETURN_OK if CRC is ok, otherwise CRC_FAILURE.
*/
2021-04-15 13:17:15 +02:00
ReturnValue_t verifyPacket(const uint8_t* start, size_t foundLen);
2021-04-11 12:04:13 +02:00
/**
* @brief This function handles the acknowledgment report.
*
* @param data Pointer to the data holding the acknowledgment report.
*
* @return RETURN_OK if successful, otherwise an error code.
2021-04-11 12:04:13 +02:00
*/
ReturnValue_t handleAckReport(const uint8_t* data);
2021-04-11 12:04:13 +02:00
/**
* @brief This function handles the data of a execution report.
2021-03-29 14:37:52 +02:00
*
* @param data Pointer to the received data packet.
2021-04-15 13:17:15 +02:00
*
* @return RETURN_OK if successful, otherwise an error code.
2021-03-29 14:37:52 +02:00
*/
ReturnValue_t handleExecutionReport(const uint8_t* data);
2021-03-29 14:37:52 +02:00
/**
* @brief This function handles the housekeeping report. This means verifying the CRC of the
* reply and filling the appropriate dataset.
*
* @param data Pointer to the data buffer holding the housekeeping read report.
2021-04-11 12:04:13 +02:00
*
* @return RETURN_OK if successful, otherwise an error code.
2021-04-11 12:04:13 +02:00
*/
ReturnValue_t handleHkReport(const uint8_t* data);
2021-07-24 13:57:05 +02:00
/**
* @brief This function calls the function to check the CRC of the received boot status report
* and fills the associated dataset with the boot status information.
*/
ReturnValue_t handleBootStatusReport(const uint8_t* data);
/**
* @brief Depending on the current active command, this function sets the reply id of the
* next reply after a successful acknowledgment report has been received. This is
* required by the function getNextReplyLength() to identify the length of the next
* reply to read.
*/
void setNextReplyId();
2021-03-29 14:37:52 +02:00
2021-04-11 12:04:13 +02:00
/**
* @brief This function handles action message replies in case the telemetry has been
* requested by another object.
2021-03-29 14:37:52 +02:00
*
* @param data Pointer to the telemetry data.
2021-04-11 12:04:13 +02:00
* @param dataSize Size of telemetry in bytes.
* @param replyId Id of the reply. This will be added to the ActionMessage.
2021-03-29 14:37:52 +02:00
*/
2021-04-11 12:04:13 +02:00
void handleDeviceTM(const uint8_t* data, size_t dataSize, DeviceCommandId_t replyId);
/**
* @brief This function prepares a space packet which does not transport any data in the
* packet data field apart from the crc.
*/
void prepareEmptyCmd(uint16_t apid);
/**
* @brief This function initializes the space packet to select the boot image of the MPSoC.
*/
void prepareSelBootImageCmd(const uint8_t * commandData);
2021-07-22 08:06:04 +02:00
void prepareDisableHk();
/**
* @brief This function fills the commandBuffer with the data to update the time of the
* PLOC supervisor.
*/
ReturnValue_t prepareSetTimeRefCmd();
/**
* @brief This function fills the commandBuffer with the data to change the boot timeout
* value in the PLOC supervisor.
*/
void prepareSetBootTimeoutCmd(const uint8_t * commandData);
2021-07-22 08:06:04 +02:00
void prepareRestartTriesCmd(const uint8_t * commandData);
/**
* @brief This function fills the command buffer with the packet to notify the supervisor
* about the availability of an update for the MPSoC
*/
void prepareUpdateAvailableCmd(const uint8_t * commandData);
/**
* @brief In case an acknowledgment failure reply has been received this function disables
* all previously enabled commands and resets the exepected replies variable of an
* active command.
*/
void disableAllReplies();
/**
* @brief This function sends a failure report if the active action was commanded by an other
* object.
*
* @param replyId The id of the reply which signals a failure.
* @param status A status byte which gives information about the failure type.
*/
void sendFailureReport(DeviceCommandId_t replyId, ReturnValue_t status);
/**
* @brief This function disables the execution report reply. Within this function also the
* the variable expectedReplies of an active command will be set to 0.
*/
void disableExeReportReply();
2021-03-29 14:37:52 +02:00
};
#endif /* MISSION_DEVICES_PLOCSUPERVISORHANDLER_H_ */