summaryrefslogtreecommitdiff
path: root/include/kernel/data/ringbuf.h
blob: 25a7125aafdc2055bccb4e59d8a9b0df120b296f (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
#ifndef KERNEL_RINGBUF_H
#define KERNEL_RINGBUF_H

#include <kernel/kmalloc.h>
#include <kernel/string.h>
#include <stdint.h>

struct ringbuf {
        void *buffer;
        void *buf_end;
        uint32_t capacity;
        uint32_t count;
        uint32_t size;
        void *head;
        void *tail;
};

static inline void rb_init(struct ringbuf *rb, uint32_t capacity, uint32_t size) {
        rb->buffer = kmalloc(capacity * size);
        rb->buf_end = (char*)rb->buffer + (capacity * size);
        rb->capacity = capacity;
        rb->size = size;
        rb->head = rb->buffer;
        rb->tail = rb->buffer;
}

static inline int rb_push_back(struct ringbuf *rb, const void *item, size_t size) {
        if (rb->count == rb->capacity)
                return -1;
        if (size > rb->size)
                return -1;

        void *tmp = rb->tail + rb->size;
        if (tmp > rb->head + rb->capacity * rb->size)
                rb->tail = rb->head;
        memcpy(rb->tail, item, size);
        rb->tail += rb->size;
        rb->count++;
        return 0;
}

static inline void rb_pop_front(struct ringbuf *rb, void *item) {
        memcpy(item, rb->tail, rb->size);
        rb->tail = (char*)rb->tail + rb->size;
        if (rb->tail == rb->buf_end)
                rb->tail = rb->buffer;
        rb->count--;
}

#endif