blob: a749b16db62322222c8414c408d1e5ccc60d97f6 (
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
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
|
#define FOOLOS_MODULE_NAME "ringbuffer"
#include "lib/logger/log.h"
// TODO: why do we disable interrupts? (Eg. kb input)
#include "ringbuffer.h"
static int sl=9;
ringbuffer ringbuffer_init(uint32_t size)
{
ringbuffer f;
f.data=kballoc(size);
f.size=size*4096;
f.front=f.size-1;
f.back=f.size-1;
f.front=f.size-1;
f.back=f.size-1;
return f;
}
volatile bool ringbuffer_put(ringbuffer* f,uint8_t c)
{
x86_int_disable();
lock_spin(sl);
if((f->back-1+f->size)%f->size==f->front)
{
lock_release(sl);
x86_int_enable();
return false;
}
f->data[f->back]=c;
f->back--;
f->back+=f->size;
f->back%=f->size;
lock_release(sl);
x86_int_enable();
return true;
}
volatile bool ringbuffer_has(ringbuffer* f)
{
bool res=true;
x86_int_disable();
lock_spin(sl);
if(f->front==f->back)
res=false;
lock_release(sl);
x86_int_enable();
return res;
}
volatile uint8_t ringbuffer_get(ringbuffer* f) // non blocking . please check first
{
char c;
x86_int_disable();
lock_spin(sl);
if(f->front==f->back)
{
lock_release(sl);
x86_int_enable();
return ' ';
}
c=f->data[f->front];
f->front--;
f->front+=f->size;
f->front%=f->size;
lock_release(sl);
x86_int_enable();
return c;
}
|
