forked from mohr/ArduinoIO
69 lines
1.8 KiB
C++
69 lines
1.8 KiB
C++
#include "SimpleRingBuffer.h"
|
|
#include <string.h>
|
|
|
|
SimpleRingBuffer::SimpleRingBuffer(size_t size, bool overwriteOld) :
|
|
RingBufferBase<>(0, size, overwriteOld), buffer(NULL) {
|
|
buffer = new uint8_t[size];
|
|
}
|
|
|
|
SimpleRingBuffer::~SimpleRingBuffer() {
|
|
delete[] buffer;
|
|
}
|
|
|
|
ReturnValue_t SimpleRingBuffer::writeData(const uint8_t* data,
|
|
size_t amount) {
|
|
if (availableWriteSpace() >= amount || overwriteOld) {
|
|
size_t amountTillWrap = writeTillWrap();
|
|
if (amountTillWrap >= amount) {
|
|
memcpy(&buffer[write], data, amount);
|
|
} else {
|
|
memcpy(&buffer[write], data, amountTillWrap);
|
|
memcpy(buffer, data + amountTillWrap, amount - amountTillWrap);
|
|
}
|
|
incrementWrite(amount);
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
} else {
|
|
return HasReturnvaluesIF::RETURN_FAILED;
|
|
}
|
|
}
|
|
|
|
ReturnValue_t SimpleRingBuffer::readData(uint8_t* data, size_t amount,
|
|
bool readRemaining, size_t* trueAmount) {
|
|
size_t availableData = availableReadData(READ_PTR);
|
|
size_t amountTillWrap = readTillWrap(READ_PTR);
|
|
if (availableData < amount) {
|
|
if (readRemaining) {
|
|
amount = availableData;
|
|
} else {
|
|
return HasReturnvaluesIF::RETURN_FAILED;
|
|
}
|
|
}
|
|
if (trueAmount != NULL) {
|
|
*trueAmount = amount;
|
|
}
|
|
if (amountTillWrap >= amount) {
|
|
memcpy(data, &buffer[read[READ_PTR]], amount);
|
|
} else {
|
|
memcpy(data, &buffer[read[READ_PTR]], amountTillWrap);
|
|
memcpy(data + amountTillWrap, buffer, amount - amountTillWrap);
|
|
}
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
}
|
|
|
|
ReturnValue_t SimpleRingBuffer::deleteData(size_t amount,
|
|
bool deleteRemaining, size_t* trueAmount) {
|
|
size_t availableData = availableReadData(READ_PTR);
|
|
if (availableData < amount) {
|
|
if (deleteRemaining) {
|
|
amount = availableData;
|
|
} else {
|
|
return HasReturnvaluesIF::RETURN_FAILED;
|
|
}
|
|
}
|
|
if (trueAmount != NULL) {
|
|
*trueAmount = amount;
|
|
}
|
|
incrementRead(amount, READ_PTR);
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
}
|