|
|
|
@ -12,137 +12,104 @@
|
|
|
|
|
* @{
|
|
|
|
|
* @file ringbuffer.c
|
|
|
|
|
* @author Kaspar Schleiser <kaspar@schleiser.de>
|
|
|
|
|
* @author René Kijewski <rene.kijewski@fu-berlin.de>
|
|
|
|
|
* @}
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
#include <stdio.h>
|
|
|
|
|
#include <stdint.h>
|
|
|
|
|
#include <string.h>
|
|
|
|
|
|
|
|
|
|
#if (defined(__MACH__) || defined(__FreeBSD__))
|
|
|
|
|
#include <stdlib.h>
|
|
|
|
|
#else
|
|
|
|
|
#include "malloc.h"
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
#define ENABLE_DEBUG (0)
|
|
|
|
|
#include "debug.h"
|
|
|
|
|
|
|
|
|
|
#include "ringbuffer.h"
|
|
|
|
|
|
|
|
|
|
void ringbuffer_init(ringbuffer_t *rb, char *buffer, unsigned int bufsize)
|
|
|
|
|
void ringbuffer_init(ringbuffer_t *restrict rb, char *buffer, unsigned bufsize)
|
|
|
|
|
{
|
|
|
|
|
rb->buf = buffer;
|
|
|
|
|
rb->start = 0;
|
|
|
|
|
rb->end = 0;
|
|
|
|
|
rb->size = bufsize;
|
|
|
|
|
rb->start = 0;
|
|
|
|
|
rb->avail = 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void ringbuffer_add(ringbuffer_t *rb, char *buf, int n)
|
|
|
|
|
/**
|
|
|
|
|
* @brief Add an element to the end of the ringbuffer.
|
|
|
|
|
* @details This helper function does not check the pre-requirements for adding,
|
|
|
|
|
* i.e. the caller has to ensure that ringbuffer_full() is false.
|
|
|
|
|
* @param[in,out] rb Ringbuffer to operate on.
|
|
|
|
|
* @param[in] c Element to add.
|
|
|
|
|
*/
|
|
|
|
|
static void add_tail(ringbuffer_t *restrict rb, char c)
|
|
|
|
|
{
|
|
|
|
|
for (int i = 0; i < n; i++) {
|
|
|
|
|
ringbuffer_add_one(rb, buf[i]);
|
|
|
|
|
unsigned pos = rb->start + rb->avail++;
|
|
|
|
|
if (pos >= rb->size) {
|
|
|
|
|
pos -= rb->size;
|
|
|
|
|
}
|
|
|
|
|
rb->buf[pos] = c;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void ringbuffer_add_one(ringbuffer_t *rb, char c)
|
|
|
|
|
/**
|
|
|
|
|
* @brief Remove an element from the start of the ringbuffer.
|
|
|
|
|
* @details This helper function does not check the pre-requirements for reading,
|
|
|
|
|
* i.e. the caller has to ensure that ringbuffer_empty() is false.
|
|
|
|
|
* @param[in,out] rb Ringbuffer to operate on.
|
|
|
|
|
* @returns The removed element.
|
|
|
|
|
*/
|
|
|
|
|
static char get_head(ringbuffer_t *restrict rb)
|
|
|
|
|
{
|
|
|
|
|
if (rb->avail == rb->size) {
|
|
|
|
|
ringbuffer_get_one(rb);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
rb->buf[rb->end++] = c;
|
|
|
|
|
|
|
|
|
|
if (rb->end >= rb->size) {
|
|
|
|
|
rb->end = 0;
|
|
|
|
|
char result = rb->buf[rb->start];
|
|
|
|
|
if ((--rb->avail == 0) || (++rb->start == rb->size)) {
|
|
|
|
|
rb->start = 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
rb->avail++;
|
|
|
|
|
return result;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
int ringbuffer_get_one(ringbuffer_t *rb)
|
|
|
|
|
unsigned ringbuffer_add(ringbuffer_t *restrict rb, const char *buf, unsigned n)
|
|
|
|
|
{
|
|
|
|
|
if (rb->avail == 0) {
|
|
|
|
|
return -1;
|
|
|
|
|
unsigned i;
|
|
|
|
|
for (i = 0; i < n; i++) {
|
|
|
|
|
if (ringbuffer_full(rb)) {
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
add_tail(rb, buf[i]);
|
|
|
|
|
}
|
|
|
|
|
return i;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
rb->avail--;
|
|
|
|
|
|
|
|
|
|
int c = (char)rb->buf[rb->start++];
|
|
|
|
|
|
|
|
|
|
if (rb->start >= rb->size) {
|
|
|
|
|
rb->start = 0;
|
|
|
|
|
int ringbuffer_add_one(ringbuffer_t *restrict rb, char c)
|
|
|
|
|
{
|
|
|
|
|
int result = -1;
|
|
|
|
|
if (ringbuffer_full(rb)) {
|
|
|
|
|
result = (unsigned char) get_head(rb);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return c;
|
|
|
|
|
add_tail(rb, c);
|
|
|
|
|
return result;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
int ringbuffer_get(ringbuffer_t *rb, char *buf, int n)
|
|
|
|
|
int ringbuffer_get_one(ringbuffer_t *restrict rb)
|
|
|
|
|
{
|
|
|
|
|
int count = 0;
|
|
|
|
|
|
|
|
|
|
while (rb->avail && (count < n)) {
|
|
|
|
|
buf[count++] = ringbuffer_get_one(rb);
|
|
|
|
|
if (!ringbuffer_empty(rb)) {
|
|
|
|
|
return (unsigned char) get_head(rb);
|
|
|
|
|
}
|
|
|
|
|
else {
|
|
|
|
|
return -1;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return count;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
int main(int argc, char *argv[] ){
|
|
|
|
|
ringbuffer r;
|
|
|
|
|
char buffer[5];
|
|
|
|
|
ringbuffer_init(&r, buffer, sizeof(buffer));
|
|
|
|
|
|
|
|
|
|
ringbuffer_add_one(&r, 1);
|
|
|
|
|
ringbuffer_add_one(&r, 2);
|
|
|
|
|
ringbuffer_add_one(&r, 3);
|
|
|
|
|
ringbuffer_add_one(&r, 4);
|
|
|
|
|
ringbuffer_add_one(&r, 5);
|
|
|
|
|
ringbuffer_add_one(&r, 6);
|
|
|
|
|
ringbuffer_add_one(&r, 7);
|
|
|
|
|
ringbuffer_add_one(&r, 8);
|
|
|
|
|
ringbuffer_add_one(&r, 9);
|
|
|
|
|
ringbuffer_add_one(&r, 10);
|
|
|
|
|
|
|
|
|
|
int c;
|
|
|
|
|
while ( r.avail ) {
|
|
|
|
|
c = ringbuffer_get_one(&r);
|
|
|
|
|
if (c == -1) break;
|
|
|
|
|
printf("c=%i\n", (int)c);
|
|
|
|
|
unsigned ringbuffer_get(ringbuffer_t *restrict rb, char *buf, unsigned n)
|
|
|
|
|
{
|
|
|
|
|
if (n > rb->avail) {
|
|
|
|
|
n = rb->avail;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
ringbuffer_add_one(&r, 1);
|
|
|
|
|
ringbuffer_add_one(&r, 2);
|
|
|
|
|
ringbuffer_add_one(&r, 3);
|
|
|
|
|
ringbuffer_add_one(&r, 4);
|
|
|
|
|
ringbuffer_add_one(&r, 5);
|
|
|
|
|
|
|
|
|
|
char buffer2[10];
|
|
|
|
|
|
|
|
|
|
int n = ringbuffer_get(&r, buffer2, sizeof(buffer2));
|
|
|
|
|
|
|
|
|
|
for (int i = 0; i < n; i++) {
|
|
|
|
|
printf("%i\n", buffer2[i]);
|
|
|
|
|
for (unsigned i = 0; i < n; ++i) {
|
|
|
|
|
buf[i] = get_head(rb);
|
|
|
|
|
}
|
|
|
|
|
return n;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
ringbuffer_add_one(&r, 1);
|
|
|
|
|
ringbuffer_add_one(&r, 2);
|
|
|
|
|
ringbuffer_add_one(&r, 3);
|
|
|
|
|
ringbuffer_add_one(&r, 4);
|
|
|
|
|
ringbuffer_add_one(&r, 5);
|
|
|
|
|
ringbuffer_add_one(&r, 6);
|
|
|
|
|
ringbuffer_add_one(&r, 7);
|
|
|
|
|
ringbuffer_add_one(&r, 8);
|
|
|
|
|
ringbuffer_add_one(&r, 9);
|
|
|
|
|
ringbuffer_add_one(&r, 10);
|
|
|
|
|
|
|
|
|
|
while ( r.avail ) {
|
|
|
|
|
c = ringbuffer_get_one(&r);
|
|
|
|
|
if (c == -1) break;
|
|
|
|
|
printf("c=%i\n", (int)c);
|
|
|
|
|
}
|
|
|
|
|
int ringbuffer_peek_one(const ringbuffer_t *restrict rb_)
|
|
|
|
|
{
|
|
|
|
|
ringbuffer_t rb = *rb_;
|
|
|
|
|
return ringbuffer_get_one(&rb);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
}*/
|
|
|
|
|
unsigned ringbuffer_peek(const ringbuffer_t *restrict rb_, char *buf, unsigned n)
|
|
|
|
|
{
|
|
|
|
|
ringbuffer_t rb = *rb_;
|
|
|
|
|
return ringbuffer_get(&rb, buf, n);
|
|
|
|
|
}
|
|
|
|
|