diff --git a/src/core/RandomAccessBinary.cpp b/src/core/RandomAccessBinary.cpp index 31970aa..8e1c7dd 100644 --- a/src/core/RandomAccessBinary.cpp +++ b/src/core/RandomAccessBinary.cpp @@ -1,8 +1,16 @@ #include "RandomAccessBinary.h" +#include RandomAccessBinary::RandomAccessBinary() { + this->ptr_data = std::make_unique>(); + this->ptr_data->reserve(1548); +} +RandomAccessBinary::RandomAccessBinary(uint possible_packetsize) +{ + this->ptr_data = std::make_unique>(); + this->ptr_data->reserve(possible_packetsize); } RandomAccessBinary::~RandomAccessBinary() @@ -10,84 +18,154 @@ RandomAccessBinary::~RandomAccessBinary() } +const RandomAccessBinary::Endianness RandomAccessBinary::getEndianness() +{ + return this->endianness; +} + void RandomAccessBinary::setEndianess(RandomAccessBinary::Endianness endianess) { - + this->endianness = endianess; } void RandomAccessBinary::setBytes(uint position, const std::vector &data) { - + for(uint i = 0; i < data.size(); ++i) + (*this->ptr_data)[position+i] = data[i]; } void RandomAccessBinary::setByte(uint position, const uint8_t &data) { - + (*this->ptr_data)[position] = data; } void RandomAccessBinary::setBit(uint64_t position, const bool &value) { - + uint64_t bytePosition = position>>3; + uint bitPosition = position%8; + this->setBit(bytePosition, bitPosition, value); } void RandomAccessBinary::setBit(uint bytePosition, uint bitPosition, const bool &value) { - + uint8_t byte = (*this->ptr_data)[bytePosition]; + uint8_t newbyte = 1; + if (value) + newbyte = byte | (newbyte << (7-bitPosition)); + else { + newbyte = byte & ~(newbyte << (7-bitPosition)); + } + (*this->ptr_data)[bytePosition] = newbyte; } -void RandomAccessBinary::setBits(uint64_t position, uint bits, const uint &value) +void RandomAccessBinary::setBits(uint64_t position, uint bits, const uint8_t &value) { - + uint64_t bytePosition = position>>3; + uint bitPosition = position%8; + this->setBits(bytePosition, bitPosition, bits, value); } -void RandomAccessBinary::setBits(uint bytePosition, uint bitPosition, const uint &value) +void RandomAccessBinary::setBits(uint bytePosition, uint bitPosition, uint bits, const uint8_t &value) { - + uint8_t byte = (*this->ptr_data)[bytePosition]; + uint8_t newbyte = value; + uint8_t mask = 0; + for(uint i = bits-1; i >= 0; --i) + mask |= 1 << i; + mask <<= (7-bits-bitPosition); + byte &= ~mask; + newbyte <<= (7-bits-bitPosition); + byte |= newbyte; + (*this->ptr_data)[bytePosition] = byte; } -void RandomAccessBinary::set_uint16(uint position, uint16_t data) +void RandomAccessBinary::set_uint16(uint position, const uint16_t &data) { - + if (this->endianness == Endianness::BIG) { + this->setByte(position, (uint8_t)(data >> 8)); + this->setbyte(position+1, (uint8_t)(data & 0x0FF)); + } else if (this->endianness == Endianness::LITTLE) { + this->setbyte(position, (uint8_t)(data & 0x0FF)); + this->setByte(position+1, (uint8_t)(data >> 8)); + } else { + //TODO + } } -void RandomAccessBinary::set_uint32(uint position, uint32_t data) +void RandomAccessBinary::set_uint32(uint position, const uint32_t &data) { - + if (this->endianness == Endianness::BIG) { + this->setByte(position+0, (uint8_t)((data >> 24) & 0x0FF)); + this->setByte(position+1, (uint8_t)((data >> 16) & 0x0FF)); + this->setByte(position+2, (uint8_t)((data >> 8) & 0x0FF)); + this->setbyte(position+3, (uint8_t)(data & 0x0FF)); + } else if (this->endianness == Endianness::LITTLE) { + this->setByte(position+3, (uint8_t)((data >> 24) & 0x0FF)); + this->setByte(position+2, (uint8_t)((data >> 16) & 0x0FF)); + this->setByte(position+1, (uint8_t)((data >> 8) & 0x0FF)); + this->setbyte(position+0, (uint8_t)(data & 0x0FF)); + } } -void RandomAccessBinary::set_uint64(uint position, uint64_t data) +void RandomAccessBinary::set_uint64(uint position, const uint64_t &data) { - + if (this->endianness == Endianness::BIG) { + this->setByte(position+0, (uint8_t)((data >> 56) & 0x0FF)); + this->setByte(position+1, (uint8_t)((data >> 48) & 0x0FF)); + this->setByte(position+2, (uint8_t)((data >> 40) & 0x0FF)); + this->setByte(position+3, (uint8_t)((data >> 32) & 0x0FF)); + this->setByte(position+4, (uint8_t)((data >> 24) & 0x0FF)); + this->setByte(position+5, (uint8_t)((data >> 16) & 0x0FF)); + this->setByte(position+6, (uint8_t)((data >> 8) & 0x0FF)); + this->setbyte(position+7, (uint8_t)(data & 0x0FF)); + } else if (this->endianness == Endianness::LITTLE) { + this->setByte(position+7, (uint8_t)((data >> 56) & 0x0FF)); + this->setByte(position+6, (uint8_t)((data >> 48) & 0x0FF)); + this->setByte(position+5, (uint8_t)((data >> 40) & 0x0FF)); + this->setByte(position+4, (uint8_t)((data >> 32) & 0x0FF)); + this->setByte(position+3, (uint8_t)((data >> 24) & 0x0FF)); + this->setByte(position+2, (uint8_t)((data >> 16) & 0x0FF)); + this->setByte(position+1, (uint8_t)((data >> 8) & 0x0FF)); + this->setbyte(position+0, (uint8_t)(data & 0x0FF)); + } } -void RandomAccessBinary::set_float(uint position, float data) +void RandomAccessBinary::set_float(uint position, const float &data) { - + const uint32_t * conv = &data; + this->set_uint32(position, *conv); } -void RandomAccessBinary::set_double(uint position, double data) +void RandomAccessBinary::set_double(uint position, const double &data) { - + const uint64_t * conv = &data; + this->set_uint64(position, *conv); } const uint8_t RandomAccessBinary::getByte(uint position) { - + return (*this->ptr_data)[position]; } const std::vector RandomAccessBinary::getBytes(uint position, uint length) { - + std::vector vec; + for(uint i = position; i< position+length; ++i) + vec.push_back((*this->ptr_data)[i]); + return vec; } const bool RandomAccessBinary::getBit(uint byteOffset, uint bitOffset) { - + uint8_t byte = (*this->ptr_data)[byteOffset]; + return (byte & (1 << (7-bitOffset)) > 0; } const bool RandomAccessBinary::getBit(uint64_t position) { - + uint64_t byteOffset = position>>3; + uint bitOffset = position%8; + return this->getbit(byteOffset, bitOffset); } const std::vector RandomAccessBinary::getBits(uint byteOffset, uint8_t bitOffset, uint64_t length) diff --git a/src/core/RandomAccessBinary.h b/src/core/RandomAccessBinary.h index e3bc3d5..723a8c3 100644 --- a/src/core/RandomAccessBinary.h +++ b/src/core/RandomAccessBinary.h @@ -7,14 +7,16 @@ class RandomAccessBinary { +public: enum class Endianness{ BIG, LITTLE, MIDDLE }; -public: + RandomAccessBinary(); + RandomAccessBinary(uint possible_packetsize); explicit ~RandomAccessBinary(); void setEndianness(Endianness endianess); @@ -25,8 +27,8 @@ public: void setBit(uint64_t position, const bool& value); void setBit(uint bytePosition, uint bitPosition, const bool& value); - void setBits(uint64_t position, uint bits, const uint& value); - void setBits(uint bytePosition, uint bitPosition, const uint& value); + void setBits(uint64_t position, uint bits, const uint8_t& value); + void setBits(uint bytePosition, uint bitPosition, uint bits, const uint8_t& value); void set_uint16(uint position, const uint16_t& data); void set_uint32(uint position, const uint32_t& data); @@ -62,6 +64,7 @@ public: std::string get_hex_string(); private: std::unique_ptr> ptr_data; + Endianness endianness; }; #endif // RANDOMACCESSBINARY_H