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
|
#define FOOLOS_MODULE_NAME "ringbuffer"
#include "lib/logger/log.h"
#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;
return f;
}
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);
log(FOOLOS_MODULE_NAME,FOOLOS_LOG_FINE,"unlocked by put");
x86_int_enable();
return false;
}
f->data[f->back]=c;
log(FOOLOS_MODULE_NAME,FOOLOS_LOG_FINE,"put %d %d (%c)", f->back, f->front,c);
f->back--;
f->back+=f->size;
f->back%=f->size;
lock_release(sl);
x86_int_enable();
return true;
}
uint8_t ringbuffer_get(ringbuffer* f) // blocking
{
char c;
x86_int_disable();
lock_spin(sl);
if(f->front==f->back)
{
lock_release(sl);
log(FOOLOS_MODULE_NAME,FOOLOS_LOG_FINE,"unlocked by get");
x86_int_enable();
c='_';
return false;
}
c=f->data[f->front];
log(FOOLOS_MODULE_NAME,FOOLOS_LOG_FINE,"get %d %d (%c)", f->back, f->front,c);
f->front--;
f->front+=f->size;
f->front%=f->size;
lock_release(sl);
x86_int_enable();
return true;
}
|
