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