2021-07-13 20:22:54 +02:00
|
|
|
#include "fsfw/serialize/SerialBufferAdapter.h"
|
2020-09-18 13:15:14 +02:00
|
|
|
|
2022-02-02 10:29:30 +01:00
|
|
|
#include <cstring>
|
2020-09-18 13:15:14 +02:00
|
|
|
|
2022-02-02 10:29:30 +01:00
|
|
|
#include "fsfw/serviceinterface/ServiceInterface.h"
|
2020-09-18 13:15:14 +02:00
|
|
|
|
2022-02-02 10:29:30 +01:00
|
|
|
template <typename count_t>
|
|
|
|
SerialBufferAdapter<count_t>::SerialBufferAdapter(const uint8_t* buffer, count_t bufferLength,
|
|
|
|
bool serializeLength)
|
|
|
|
: serializeLength(serializeLength),
|
|
|
|
constBuffer(buffer),
|
|
|
|
buffer(nullptr),
|
|
|
|
bufferLength(bufferLength) {}
|
|
|
|
|
|
|
|
template <typename count_t>
|
|
|
|
SerialBufferAdapter<count_t>::SerialBufferAdapter(uint8_t* buffer, count_t bufferLength,
|
|
|
|
bool serializeLength)
|
|
|
|
: serializeLength(serializeLength),
|
|
|
|
constBuffer(buffer),
|
|
|
|
buffer(buffer),
|
|
|
|
bufferLength(bufferLength) {}
|
|
|
|
|
|
|
|
template <typename count_t>
|
2022-08-10 09:39:57 +02:00
|
|
|
SerialBufferAdapter<count_t>::~SerialBufferAdapter() = default;
|
2022-02-02 10:29:30 +01:00
|
|
|
|
|
|
|
template <typename count_t>
|
2022-08-10 09:39:57 +02:00
|
|
|
ReturnValue_t SerialBufferAdapter<count_t>::serialize(uint8_t** buffer_, size_t* size,
|
2022-02-02 10:29:30 +01:00
|
|
|
size_t maxSize,
|
|
|
|
Endianness streamEndianness) const {
|
|
|
|
if (serializeLength) {
|
|
|
|
ReturnValue_t result =
|
2022-08-10 09:39:57 +02:00
|
|
|
SerializeAdapter::serialize(&bufferLength, buffer_, size, maxSize, streamEndianness);
|
2022-08-16 01:08:26 +02:00
|
|
|
if (result != returnvalue::OK) {
|
2022-02-02 10:29:30 +01:00
|
|
|
return result;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (*size + bufferLength > maxSize) {
|
|
|
|
return BUFFER_TOO_SHORT;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (this->constBuffer != nullptr) {
|
2022-08-10 09:39:57 +02:00
|
|
|
std::memcpy(*buffer_, this->constBuffer, bufferLength);
|
2022-02-02 10:29:30 +01:00
|
|
|
} else if (this->buffer != nullptr) {
|
|
|
|
// This will propably be never reached, constBuffer should always be
|
|
|
|
// set if non-const buffer is set.
|
2022-08-10 09:39:57 +02:00
|
|
|
std::memcpy(*buffer_, this->buffer, bufferLength);
|
2022-02-02 10:29:30 +01:00
|
|
|
} else {
|
2022-08-16 01:08:26 +02:00
|
|
|
return returnvalue::FAILED;
|
2022-02-02 10:29:30 +01:00
|
|
|
}
|
|
|
|
*size += bufferLength;
|
2022-08-10 09:39:57 +02:00
|
|
|
(*buffer_) += bufferLength;
|
2022-08-16 01:08:26 +02:00
|
|
|
return returnvalue::OK;
|
2020-09-18 13:15:14 +02:00
|
|
|
}
|
|
|
|
|
2022-02-02 10:29:30 +01:00
|
|
|
template <typename count_t>
|
2020-09-18 13:15:14 +02:00
|
|
|
size_t SerialBufferAdapter<count_t>::getSerializedSize() const {
|
2022-02-02 10:29:30 +01:00
|
|
|
if (serializeLength) {
|
|
|
|
return bufferLength + SerializeAdapter::getSerializedSize(&bufferLength);
|
|
|
|
} else {
|
|
|
|
return bufferLength;
|
|
|
|
}
|
2020-09-18 13:15:14 +02:00
|
|
|
}
|
|
|
|
|
2022-02-02 10:29:30 +01:00
|
|
|
template <typename count_t>
|
2022-08-10 09:39:57 +02:00
|
|
|
ReturnValue_t SerialBufferAdapter<count_t>::deSerialize(const uint8_t** buffer_, size_t* size,
|
2022-02-02 10:29:30 +01:00
|
|
|
Endianness streamEndianness) {
|
|
|
|
if (this->buffer == nullptr) {
|
2022-08-16 01:08:26 +02:00
|
|
|
return returnvalue::FAILED;
|
2022-02-02 10:29:30 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
if (serializeLength) {
|
|
|
|
count_t lengthField = 0;
|
|
|
|
ReturnValue_t result =
|
2022-08-10 09:39:57 +02:00
|
|
|
SerializeAdapter::deSerialize(&lengthField, buffer_, size, streamEndianness);
|
2022-08-16 01:08:26 +02:00
|
|
|
if (result != returnvalue::OK) {
|
2022-02-02 10:29:30 +01:00
|
|
|
return result;
|
|
|
|
}
|
|
|
|
if (lengthField > bufferLength) {
|
|
|
|
return TOO_MANY_ELEMENTS;
|
|
|
|
}
|
|
|
|
bufferLength = lengthField;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (bufferLength <= *size) {
|
|
|
|
*size -= bufferLength;
|
2022-08-10 09:39:57 +02:00
|
|
|
std::memcpy(this->buffer, *buffer_, bufferLength);
|
|
|
|
(*buffer_) += bufferLength;
|
2022-08-16 01:08:26 +02:00
|
|
|
return returnvalue::OK;
|
2022-02-02 10:29:30 +01:00
|
|
|
} else {
|
|
|
|
return STREAM_TOO_SHORT;
|
|
|
|
}
|
2020-09-18 13:15:14 +02:00
|
|
|
}
|
|
|
|
|
2022-02-02 10:29:30 +01:00
|
|
|
template <typename count_t>
|
|
|
|
uint8_t* SerialBufferAdapter<count_t>::getBuffer() {
|
|
|
|
if (buffer == nullptr) {
|
2021-01-03 14:16:52 +01:00
|
|
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
2022-02-02 10:29:30 +01:00
|
|
|
sif::error << "Wrong access function for stored type !"
|
|
|
|
" Use getConstBuffer()."
|
|
|
|
<< std::endl;
|
2021-01-03 13:58:18 +01:00
|
|
|
#endif
|
2022-02-02 10:29:30 +01:00
|
|
|
return nullptr;
|
|
|
|
}
|
|
|
|
return buffer;
|
2020-09-18 13:15:14 +02:00
|
|
|
}
|
|
|
|
|
2022-02-02 10:29:30 +01:00
|
|
|
template <typename count_t>
|
|
|
|
const uint8_t* SerialBufferAdapter<count_t>::getConstBuffer() const {
|
|
|
|
if (constBuffer == nullptr) {
|
2021-01-03 14:16:52 +01:00
|
|
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
2022-02-02 10:29:30 +01:00
|
|
|
sif::error << "SerialBufferAdapter::getConstBuffer:"
|
|
|
|
" Buffers are unitialized!"
|
|
|
|
<< std::endl;
|
2021-01-03 13:58:18 +01:00
|
|
|
#endif
|
2022-02-02 10:29:30 +01:00
|
|
|
return nullptr;
|
|
|
|
}
|
|
|
|
return constBuffer;
|
2020-09-18 13:15:14 +02:00
|
|
|
}
|
|
|
|
|
2022-02-02 10:29:30 +01:00
|
|
|
template <typename count_t>
|
2022-09-05 16:27:20 +02:00
|
|
|
void SerialBufferAdapter<count_t>::setConstBuffer(const uint8_t* buf, count_t bufLen) {
|
2022-09-05 15:30:53 +02:00
|
|
|
this->buffer = nullptr;
|
|
|
|
this->bufferLength = bufLen;
|
|
|
|
this->constBuffer = buf;
|
|
|
|
}
|
|
|
|
|
2022-02-02 10:29:30 +01:00
|
|
|
// forward Template declaration for linker
|
2020-09-18 13:15:14 +02:00
|
|
|
template class SerialBufferAdapter<uint8_t>;
|
|
|
|
template class SerialBufferAdapter<uint16_t>;
|
|
|
|
template class SerialBufferAdapter<uint32_t>;
|
|
|
|
template class SerialBufferAdapter<uint64_t>;
|