75 lines
2.2 KiB
C
75 lines
2.2 KiB
C
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <ringbuffer.h>
|
|
|
|
|
|
void ringbufferInit(ringbuffer_t *handle, uint32_t bufferSize) {
|
|
handle->bufferSize = bufferSize;
|
|
handle->buffer = (uint8_t*) malloc(handle->bufferSize);
|
|
memset(handle->buffer, 0, handle->bufferSize);
|
|
handle->bufferReadIdx = 0;
|
|
handle->bufferWriteIdx = 0;
|
|
}
|
|
|
|
void ringbufferFree(ringbuffer_t *handle) {
|
|
free(handle->buffer);
|
|
handle->buffer = NULL;
|
|
handle->bufferSize = 0;
|
|
handle->bufferReadIdx = 0;
|
|
handle->bufferWriteIdx = 0;
|
|
}
|
|
|
|
int ringbufferPut(ringbuffer_t *handle, uint8_t *data, uint32_t dataLen) {
|
|
uint32_t freeSpace = 0;
|
|
if (handle->bufferReadIdx == handle->bufferWriteIdx) {
|
|
freeSpace = handle->bufferSize;
|
|
} else if (handle->bufferReadIdx > handle->bufferWriteIdx) {
|
|
freeSpace = handle->bufferReadIdx - handle->bufferWriteIdx;
|
|
} else {
|
|
freeSpace = (handle->bufferSize - handle->bufferWriteIdx) + handle->bufferReadIdx;
|
|
}
|
|
|
|
freeSpace--;
|
|
|
|
if (dataLen > freeSpace) {
|
|
return -1;
|
|
}
|
|
|
|
if (dataLen <= (handle->bufferSize - handle->bufferWriteIdx)) {
|
|
memcpy(handle->buffer + handle->bufferWriteIdx, data, dataLen);
|
|
handle->bufferWriteIdx += dataLen;
|
|
if (handle->bufferWriteIdx == handle->bufferSize) {
|
|
handle->bufferWriteIdx = 0;
|
|
}
|
|
} else {
|
|
uint32_t remainingToTop = handle->bufferSize - handle->bufferWriteIdx;
|
|
memcpy(handle->buffer + handle->bufferWriteIdx, data, remainingToTop);
|
|
memcpy(handle->buffer, data + remainingToTop, dataLen - remainingToTop);
|
|
handle->bufferWriteIdx = dataLen - remainingToTop;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
bool ringbufferEmpty(ringbuffer_t *handle) {
|
|
return handle->bufferReadIdx == handle->bufferWriteIdx;
|
|
}
|
|
|
|
uint8_t *ringbufferGet(ringbuffer_t *handle, uint32_t dataLen) {
|
|
return NULL;
|
|
}
|
|
|
|
int ringbufferGetOne(ringbuffer_t *handle) {
|
|
int res = -1;
|
|
if (! ringbufferEmpty(handle)) {
|
|
uint8_t r = *(handle->buffer + handle->bufferReadIdx);
|
|
handle->bufferReadIdx += 1;
|
|
if (handle->bufferReadIdx == handle->bufferSize) {
|
|
handle->bufferReadIdx = 0;
|
|
}
|
|
res = (int) r;
|
|
}
|
|
return res;
|
|
}
|
|
|