blob: b58d92d6132b9be5f983e64b0923e07b47bcb0c8 (
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
|
#include <libk/string.h>
#include <heap.h>
#include <stdbuff.h>
stdbuff *init_buff(uint32_t buff_size)
{
stdbuff *buffer = kalloc(sizeof(stdbuff));
buffer->head = 0;
buffer->tail = 0;
buffer->size = buff_size;
buffer->data = kalloc(buffer->size);
return buffer;
}
void read_buff(stdbuff *buffer, char *dest_ptr, size_t read_size)
{
size_t i;
for (i = 0; i < read_size; i++) {
memcpy(dest_ptr + i,
buffer->data + ((buffer->tail + i) % buffer->size), 1);
}
dest_ptr[read_size] = '\0';
buffer->tail = (buffer->tail + read_size) % buffer->size;
}
void write_buff(stdbuff *buffer, const char *src_ptr, size_t write_size)
{
size_t i;
for (i = 0; i < write_size; i++) {
memcpy(buffer->data + ((buffer->head + i) % buffer->size),
src_ptr + i, 1);
}
buffer->head = (buffer->head + write_size) % buffer->size;
}
|