fsfw/src/fsfw/thermal/AbstractTemperatureSensor.cpp

#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(); }