#include <framework/ipc/CommandMessageBase.h>
#include <cstring>

CommandMessageBase::CommandMessageBase(MessageQueueMessageIF *message):
		internalMessage(message) {
}

Command_t CommandMessageBase::getCommand() const {
	Command_t command;
	std::memcpy(&command, internalMessage->getData(), sizeof(Command_t));
	return command;
}

void CommandMessageBase::setCommand(Command_t command) {
	std::memcpy(internalMessage->getData(), &command, sizeof(Command_t));
}

uint8_t CommandMessageBase::getMessageType() const {
	// first byte of command ID.
	return getCommand() >> 8 & 0xff;
}

MessageQueueId_t CommandMessageBase::getSender() const {
	return internalMessage->getSender();
}

uint8_t* CommandMessageBase::getBuffer() {
	return internalMessage->getBuffer();
}

void CommandMessageBase::setSender(MessageQueueId_t setId) {
	internalMessage->setSender(setId);
}

const uint8_t* CommandMessageBase::getBuffer() const {
	return internalMessage->getBuffer();
}

// Header includes command ID.
uint8_t* CommandMessageBase::getData() {
	return internalMessage->getData() + sizeof(Command_t);
}

// Header includes command ID.
const uint8_t* CommandMessageBase::getData() const {
	return internalMessage->getData() + sizeof(Command_t);
}

void CommandMessageBase::setMessageSize(size_t messageSize) {
	internalMessage->setMessageSize(messageSize);
}

size_t CommandMessageBase::getMessageSize() const {
	return internalMessage->getMessageSize();
}

MessageQueueMessageIF* CommandMessageBase::getInternalMessage() const {
	return internalMessage;
}