71 lines
2.1 KiB
C++
71 lines
2.1 KiB
C++
#include "fsfw/thermal/AbstractTemperatureSensor.h"
|
|
|
|
#include "fsfw/ipc/QueueFactory.h"
|
|
|
|
AbstractTemperatureSensor::AbstractTemperatureSensor(object_id_t setObjectid,
|
|
ThermalModuleIF *thermalModule)
|
|
: SystemObject(setObjectid), healthHelper(this, setObjectid), parameterHelper(this) {
|
|
if (thermalModule != nullptr) {
|
|
thermalModule->registerSensor(this);
|
|
}
|
|
auto mqArgs = MqArgs(setObjectid, static_cast<void *>(this));
|
|
commandQueue = QueueFactory::instance()->createMessageQueue(
|
|
3, MessageQueueMessage::MAX_MESSAGE_SIZE, &mqArgs);
|
|
}
|
|
|
|
AbstractTemperatureSensor::~AbstractTemperatureSensor() {
|
|
QueueFactory::instance()->deleteMessageQueue(commandQueue);
|
|
}
|
|
|
|
MessageQueueId_t AbstractTemperatureSensor::getCommandQueue() const {
|
|
return commandQueue->getId();
|
|
}
|
|
|
|
ReturnValue_t AbstractTemperatureSensor::initialize() {
|
|
ReturnValue_t result = SystemObject::initialize();
|
|
if (result != returnvalue::OK) {
|
|
return result;
|
|
}
|
|
result = healthHelper.initialize();
|
|
if (result != returnvalue::OK) {
|
|
return result;
|
|
}
|
|
result = parameterHelper.initialize();
|
|
return result;
|
|
}
|
|
|
|
ReturnValue_t AbstractTemperatureSensor::performOperation(uint8_t opCode) {
|
|
handleCommandQueue();
|
|
doChildOperation();
|
|
return returnvalue::OK;
|
|
}
|
|
|
|
ReturnValue_t AbstractTemperatureSensor::performHealthOp() {
|
|
handleCommandQueue();
|
|
return returnvalue::OK;
|
|
}
|
|
|
|
void AbstractTemperatureSensor::handleCommandQueue() {
|
|
CommandMessage command;
|
|
ReturnValue_t result = commandQueue->receiveMessage(&command);
|
|
if (result == returnvalue::OK) {
|
|
result = healthHelper.handleHealthCommand(&command);
|
|
if (result == returnvalue::OK) {
|
|
return;
|
|
}
|
|
result = parameterHelper.handleParameterMessage(&command);
|
|
if (result == returnvalue::OK) {
|
|
return;
|
|
}
|
|
command.setToUnknownCommand();
|
|
commandQueue->reply(&command);
|
|
}
|
|
}
|
|
|
|
ReturnValue_t AbstractTemperatureSensor::setHealth(HealthState health) {
|
|
healthHelper.setHealth(health);
|
|
return returnvalue::OK;
|
|
}
|
|
|
|
HasHealthIF::HealthState AbstractTemperatureSensor::getHealth() { return healthHelper.getHealth(); }
|