filipecalasans / ringbuffer Goto Github PK

You forgot to move the pointer correctly before memory copy in the following functions.

void ringBufferAppendMultiple(RingBuffer *buffer, uint8_t *data, uint32_t len){
if(buffer->tail + len > buffer->sizeMask) {
uint32_t lenToTheEnd = buffer->sizeMask - buffer->tail + 1;
uint32_t lenFromBegin = len - lenToTheEnd;
memcpy(buffer->data + buffer->tail, data, lenToTheEnd);
memcpy(buffer->data, data + lenToTheEnd, lenFromBegin);
}
else {
memcpy(buffer->data + buffer->tail, data, len);
}
buffer->tail = (buffer->tail + len) & buffer->sizeMask;
}

void ringBufferPeekMultiple(RingBuffer *buffer, uint8_t *dst, uint32_t len){
if(buffer->head + len > buffer->sizeMask) {
uint32_t lenToTheEnd = buffer->sizeMask - buffer->head + 1;
uint32_t lenFromBegin = len - lenToTheEnd;
memcpy(dst, buffer->data + buffer->head, lenToTheEnd);
memcpy(dst + lenToTheEnd, buffer->data, lenFromBegin);
}
else {
memcpy(dst, buffer->data + buffer->head, len);
}
}