radiator-plc/stm32/app/ring.c


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

#include "project.h"


static inline size_t
ring_next (ring_t *r, size_t p)
{
  p++;

  if (p >= r->size)
    p -= r->size;

  return p;
}

void
ring_init (ring_t *r, uint8_t *buf, size_t len)
{
  r->data = buf;
  r->size = len;
  r->write = 0;
  r->read = 0;
}

int
ring_write_byte (ring_t *r, uint8_t c)
{
  size_t n = ring_next (r, r->write);

  if (n == r->read)
    return -1;

  r->data[r->write] = c;

  r->write = n;

  return 0;
}


int
ring_read_byte (ring_t *r, uint8_t *c)
{
  size_t n = ring_next (r, r->read);

  if (r->read == r->write)
    return -1;

  *c = r->data[r->read];
  r->read = n;

  return 0;
}

int
ring_write (ring_t *r, uint8_t *buf, size_t len)
{
  while (len--) {
    if (ring_write_byte (r, * (buf++)))
      return -1;
  }

  return 0;
}

int
ring_empty (ring_t *r)
{
  return (r->read == r->write) ? 1 : 0;
}