fsfw/thermal/AbstractTemperatureSensor.cpp

#include "AbstractTemperatureSensor.h"
#include "../ipc/QueueFactory.h"

AbstractTemperatureSensor::AbstractTemperatureSensor(object_id_t setObjectid,
		ThermalModuleIF *thermalModule) :
		SystemObject(setObjectid), commandQueue(NULL), healthHelper(this,
				setObjectid), parameterHelper(this) {
	if (thermalModule != NULL) {
		thermalModule->registerSensor(this);
	}
	commandQueue = QueueFactory::instance()->createMessageQueue();
}

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 != HasReturnvaluesIF::RETURN_OK) {
		return result;
	}
	result = healthHelper.initialize();
	if (result != HasReturnvaluesIF::RETURN_OK) {
		return result;
	}
	result = parameterHelper.initialize();
	return result;
}

ReturnValue_t AbstractTemperatureSensor::performOperation(uint8_t opCode) {
	handleCommandQueue();
	doChildOperation();
	return HasReturnvaluesIF::RETURN_OK;
}

ReturnValue_t AbstractTemperatureSensor::performHealthOp() {
	handleCommandQueue();
	return HasReturnvaluesIF::RETURN_OK;
}

void AbstractTemperatureSensor::handleCommandQueue() {
	CommandMessage message;
	ReturnValue_t result = commandQueue->receiveMessage(&message);
	if (result == HasReturnvaluesIF::RETURN_OK) {
		result = healthHelper.handleHealthCommand(&message);
		if (result == HasReturnvaluesIF::RETURN_OK) {
			return;
		}
		result = parameterHelper.handleParameterMessage(&message);
		if (result == HasReturnvaluesIF::RETURN_OK) {
			return;
		}
		message.setToUnknownCommand();
		commandQueue->reply(&message);
	}
}

ReturnValue_t AbstractTemperatureSensor::setHealth(HealthState health) {
	healthHelper.setHealth(health);
	return HasReturnvaluesIF::RETURN_OK;
}

HasHealthIF::HealthState AbstractTemperatureSensor::getHealth() {
	return healthHelper.getHealth();
}