diff --git a/device_ring_buffer.c b/device_ring_buffer.c new file mode 100644 index 0000000..7e8dcf7 --- /dev/null +++ b/device_ring_buffer.c @@ -0,0 +1,64 @@ +#include "device_ring_buffer.h" + +void rb_initialize(struct rb* _rb) +{ + memset(_rb, 0, sizeof(struct rb)); +} + +int rb_put(struct rb* _rb, char element) +{ + if (_rb->count < sizeof(_rb->buf)) + { + _rb->count++; + if (_rb->tail != _rb->head) + { + _rb->buf[_rb->tail] = element; + _rb->tail++; + if (_rb->tail == sizeof(_rb->buf)) + { + _rb->tail = 0; + } + return 1; + } + else + { + return 0; + } + } + else + { + return -1; + } + +} + +int rb_get(struct rb* _rb, char *element) +{ + if (_rb->count > 0) + { + _rb->count--; + if (_rb->tail != _rb->head) + { + *element = _rb->buf[_rb->head]; + _rb->head++; + if (_rb->head == sizeof(_rb->buf)) + { + _rb->head = 0; + } + return 1; + } + else + { + return 0; + } + } + else + { + return -1; + } + +} +int count_elements(struct rb* _rb) +{ + return _rb->count; +} diff --git a/device_ring_buffer.h b/device_ring_buffer.h new file mode 100644 index 0000000..a894101 --- /dev/null +++ b/device_ring_buffer.h @@ -0,0 +1,18 @@ +#ifndef DEVICE_RING_BUFFER_H +#define DEVICE_RING_BUFFER_H +#include +#include + +struct rb { + char buf[32]; + int head; + int tail; + int count; +}; + +void rb_initialize(struct rb* _rb); +int rb_put(struct rb* _rb, char element); +int rb_get(struct rb* _rb, char* element); +int count_elements(struct rb* _rb); + +#endif /*DEVICE_RING_BUFFER_H*/