fsfw/ipc/CommandMessage.cpp

116 lines
3.0 KiB
C++
Raw Normal View History

/**
* @file CommandMessage.cpp
* @brief This file defines the CommandMessage class.
* @date 20.06.2013
* @author baetz
*/
#include <framework/devicehandlers/DeviceHandlerMessage.h>
#include <framework/health/HealthMessage.h>
#include <framework/ipc/CommandMessage.h>
#include <framework/memory/MemoryMessage.h>
#include <framework/modes/ModeMessage.h>
#include <framework/monitoring/MonitoringMessage.h>
#include <framework/subsystem/modes/ModeSequenceMessage.h>
#include <framework/tmstorage/TmStoreMessage.h>
#include <mission/payloaddevices/commonPayloadStuff/PayloadHandlerMessage.h>
CommandMessage::CommandMessage() {
this->messageSize = COMMAND_MESSAGE_SIZE;
setCommand(CMD_NONE);
}
CommandMessage::CommandMessage(Command_t command, uint32_t parameter1,
uint32_t parameter2) {
this->messageSize = COMMAND_MESSAGE_SIZE;
setCommand(command);
setParameter(parameter1);
setParameter2(parameter2);
}
Command_t CommandMessage::getCommand() const {
Command_t command;
memcpy(&command, getData(), sizeof(Command_t));
return command;
}
void CommandMessage::setCommand(Command_t command) {
memcpy(getData(), &command, sizeof(command));
}
uint32_t CommandMessage::getParameter() const {
uint32_t parameter1;
memcpy(&parameter1, getData() + sizeof(Command_t), sizeof(parameter1));
return parameter1;
}
void CommandMessage::setParameter(uint32_t parameter1) {
memcpy(getData() + sizeof(Command_t), &parameter1, sizeof(parameter1));
}
uint32_t CommandMessage::getParameter2() const {
uint32_t parameter2;
memcpy(&parameter2, getData() + sizeof(Command_t) + sizeof(uint32_t),
sizeof(parameter2));
return parameter2;
}
void CommandMessage::setParameter2(uint32_t parameter2) {
memcpy(getData() + sizeof(Command_t) + sizeof(uint32_t), &parameter2,
sizeof(parameter2));
}
void CommandMessage::clearCommandMessage() {
switch((getCommand()>>8) & 0xff){
case MODE_COMMAND_MESSAGE_ID:
ModeMessage::clear(this);
break;
case HEALTH_COMMAND_MESSAGE_ID:
HealthMessage::clear(this);
break;
case MODE_SEQUENCE_MESSAGE_ID:
ModeSequenceMessage::clear(this);
break;
case FUNCTION_MESSAGE_ID:
ActionMessage::clear(this);
break;
case DEVICE_HANDLER_COMMAND_MESSAGE_ID:
DeviceHandlerMessage::clear(this);
break;
case MEMORY_MESSAGE_ID:
MemoryMessage::clear(this);
break;
case PAYLOAD_HANDLER_MESSAGE_ID:
PayloadHandlerMessage::clear(this);
break;
case LIMIT_MESSAGE_ID:
MonitoringMessage::clear(this);
break;
case TM_STORE_MESSAGE_ID:
TmStoreMessage::clear(this);
break;
default:
setCommand(CMD_NONE);
break;
}
}
bool CommandMessage::isClearedCommandMessage() {
return getCommand() == CMD_NONE;
}
size_t CommandMessage::getMinimumMessageSize() const {
return COMMAND_MESSAGE_SIZE;
}
void CommandMessage::setToUnknownCommand(Command_t initialCommand) {
setReplyRejected(UNKNOW_COMMAND, initialCommand);
}
void CommandMessage::setReplyRejected(ReturnValue_t reason,
Command_t initialCommand) {
setCommand(REPLY_REJECTED);
setParameter(reason);
setParameter2(initialCommand);
}