82 lines
2.6 KiB
C++
82 lines
2.6 KiB
C++
#include "fsfw/ipc/MessageQueueMessage.h"
|
|
|
|
#include <cstring>
|
|
|
|
#include "fsfw/globalfunctions/arrayprinter.h"
|
|
#include "fsfw/serviceinterface/ServiceInterface.h"
|
|
|
|
MessageQueueMessage::MessageQueueMessage() : messageSize(getMinimumMessageSize()) {
|
|
memset(this->internalBuffer, 0, sizeof(this->internalBuffer));
|
|
}
|
|
|
|
MessageQueueMessage::MessageQueueMessage(uint8_t* data, size_t size)
|
|
: messageSize(MessageQueueMessage::HEADER_SIZE + size) {
|
|
if (size <= MessageQueueMessage::MAX_DATA_SIZE) {
|
|
std::memcpy(internalBuffer + MessageQueueMessage::HEADER_SIZE, data, size);
|
|
this->messageSize = MessageQueueMessage::HEADER_SIZE + size;
|
|
} else {
|
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
|
sif::warning << "MessageQueueMessage: Passed size larger than maximum"
|
|
"allowed size! Setting content to 0"
|
|
<< std::endl;
|
|
#endif
|
|
memset(this->internalBuffer, 0, sizeof(this->internalBuffer));
|
|
this->messageSize = MessageQueueMessage::HEADER_SIZE;
|
|
}
|
|
}
|
|
|
|
MessageQueueMessage::~MessageQueueMessage() = default;
|
|
|
|
const uint8_t* MessageQueueMessage::getBuffer() const { return this->internalBuffer; }
|
|
|
|
uint8_t* MessageQueueMessage::getBuffer() { return this->internalBuffer; }
|
|
|
|
const uint8_t* MessageQueueMessage::getData() const {
|
|
return this->internalBuffer + MessageQueueMessage::HEADER_SIZE;
|
|
}
|
|
|
|
uint8_t* MessageQueueMessage::getData() {
|
|
return this->internalBuffer + MessageQueueMessage::HEADER_SIZE;
|
|
}
|
|
|
|
MessageQueueId_t MessageQueueMessage::getSender() const {
|
|
MessageQueueId_t temp_id;
|
|
memcpy(&temp_id, this->internalBuffer, sizeof(MessageQueueId_t));
|
|
return temp_id;
|
|
}
|
|
|
|
void MessageQueueMessage::setSender(MessageQueueId_t setId) {
|
|
memcpy(this->internalBuffer, &setId, sizeof(MessageQueueId_t));
|
|
}
|
|
|
|
void MessageQueueMessage::print(bool printWholeMessage) {
|
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
|
sif::debug << "MessageQueueMessage content: " << std::endl;
|
|
#endif
|
|
if (printWholeMessage) {
|
|
arrayprinter::print(getData(), getMaximumMessageSize());
|
|
} else {
|
|
arrayprinter::print(getData(), getMessageSize());
|
|
}
|
|
}
|
|
|
|
void MessageQueueMessage::clear() {
|
|
memset(this->getBuffer(), 0, MessageQueueMessage::MAX_MESSAGE_SIZE);
|
|
}
|
|
|
|
size_t MessageQueueMessage::getMessageSize() const { return this->messageSize; }
|
|
|
|
void MessageQueueMessage::setMessageSize(size_t messageSize_) { this->messageSize = messageSize_; }
|
|
|
|
size_t MessageQueueMessage::getMinimumMessageSize() const {
|
|
return MessageQueueMessage::MIN_MESSAGE_SIZE;
|
|
}
|
|
|
|
size_t MessageQueueMessage::getMaximumMessageSize() const {
|
|
return MessageQueueMessage::MAX_MESSAGE_SIZE;
|
|
}
|
|
|
|
size_t MessageQueueMessage::getMaximumDataSize() const {
|
|
return MessageQueueMessage::MAX_DATA_SIZE;
|
|
}
|