fsfw/devicehandlers/HealthDevice.cpp

#include <framework/devicehandlers/HealthDevice.h>
#include <framework/ipc/QueueFactory.h>

HealthDevice::HealthDevice(object_id_t setObjectId,
		MessageQueueId_t parentQueue) :
		SystemObject(setObjectId), lastHealth(HEALTHY), parentQueue(
				parentQueue), commandQueue(), healthHelper(this, setObjectId) {
	commandQueue = QueueFactory::instance()->createMessageQueue(3, CommandMessage::MINIMUM_COMMAND_MESSAGE_SIZE);
}

HealthDevice::~HealthDevice() {
	QueueFactory::instance()->deleteMessageQueue(commandQueue);
}

ReturnValue_t HealthDevice::performOperation(uint8_t opCode) {
	CommandMessage command;
	ReturnValue_t result = commandQueue->receiveMessage(&command);
	if (result == HasReturnvaluesIF::RETURN_OK) {
		healthHelper.handleHealthCommand(&command);
	}
	return HasReturnvaluesIF::RETURN_OK;
}

ReturnValue_t HealthDevice::initialize() {
	ReturnValue_t result = SystemObject::initialize();
	if (result != HasReturnvaluesIF::RETURN_OK) {
		return result;
	}
	if (parentQueue != 0) {
		return healthHelper.initialize(parentQueue);
	} else {
		return healthHelper.initialize();
	}
}

MessageQueueId_t HealthDevice::getCommandQueue() const {
	return commandQueue->getId();
}

void HealthDevice::setParentQueue(MessageQueueId_t parentQueue) {
	healthHelper.setParentQueue(parentQueue);
}

bool HealthDevice::hasHealthChanged() {
	bool changed;
	HealthState currentHealth = healthHelper.getHealth();
	changed = currentHealth != lastHealth;
	lastHealth = currentHealth;
	return changed;
}

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

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