+/rtos

git clone https://git.julia.blue/+/rtos

Vivek MalneediMerge branch 'master' of github.com:EE445M-Sp20/lab-6-vm22967_jbr2558021d2d4

master
1.5 KiB77 linesraw
1#include "fifo.h"
2#include "OS.h"
3#include "heap.h"
4
5FIFO* fifo_new(uint16_t size) {
6    if (size & size - 1) { // Size must be power of 2
7        return 0;
8    }
9    FIFO* temp = malloc(sizeof(FIFO));
10    if (!temp) {
11        return 0;
12    }
13    temp->size = size - 1;
14    temp->buf = malloc(size);
15    if (!temp->buf) {
16        free(temp);
17        return 0;
18    }
19    temp->putidx = temp->getidx = 0;
20    OS_InitSemaphore(&temp->data_available, -1);
21    return temp;
22}
23
24void fifo_clear(FIFO* fifo) {
25    fifo->putidx = fifo->getidx = 0;
26}
27
28void fifo_free(FIFO* fifo) {
29    free(fifo->buf);
30    free(fifo);
31}
32
33void fifo_put(FIFO* fifo, uint8_t n) {
34    while (!fifo_space(fifo)) { OS_Suspend(); }
35    fifo_try_put(fifo, n);
36}
37
38uint8_t fifo_get(FIFO* fifo) {
39    OS_Wait(&fifo->data_available);
40    uint8_t temp;
41    fifo_try_get(fifo, &temp);
42    return temp;
43}
44
45bool fifo_try_put(FIFO* fifo, uint8_t n) {
46    if (fifo_full(fifo)) {
47        return false;
48    }
49    fifo->buf[fifo->putidx++] = n;
50    fifo->putidx &= fifo->size;
51    return true;
52}
53
54bool fifo_try_get(FIFO* fifo, uint8_t* out) {
55    if (fifo_empty(fifo)) {
56        return false;
57    }
58    *out = fifo->buf[fifo->getidx++];
59    fifo->getidx &= fifo->size;
60    return true;
61}
62
63bool fifo_empty(FIFO* fifo) {
64    return !fifo_size(fifo);
65}
66
67bool fifo_full(FIFO* fifo) {
68    return !fifo_space(fifo);
69}
70
71uint16_t fifo_size(FIFO* fifo) {
72    return (fifo->putidx - fifo->getidx) & fifo->size;
73}
74
75uint16_t fifo_space(FIFO* fifo) {
76    return fifo->size - fifo_size(fifo) - 1;
77}