127 lines
2.6 KiB
C
127 lines
2.6 KiB
C
/*
|
|
* Copyright 2017 Oleg Borodin <onborodin@gmail.com>
|
|
*
|
|
*/
|
|
#include <stdint.h>
|
|
#include <stdbool.h>
|
|
#include <string.h>
|
|
#include <stdio.h>
|
|
|
|
#include <fifo.h>
|
|
#include <tools.h>
|
|
|
|
void fifo_init(fifo_t *fifo, uint8_t * buffer, uint8_t buffer_len) {
|
|
if (fifo && buffer) {
|
|
memset((void **)buffer, 0, buffer_len);
|
|
fifo->buffer_len = buffer_len;
|
|
fifo->buffer = buffer;
|
|
fifo->head = 0;
|
|
fifo->tail = 0;
|
|
}
|
|
}
|
|
|
|
uint8_t fifo_count(const fifo_t *fifo) {
|
|
if (fifo) {
|
|
return (fifo->head - fifo->tail);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
bool fifo_full(const fifo_t *fifo) {
|
|
if (fifo) {
|
|
return (fifo_count(fifo) == fifo->buffer_len);
|
|
}
|
|
return true;
|
|
}
|
|
|
|
bool fifo_empty(const fifo_t *fifo) {
|
|
if (fifo) {
|
|
return (fifo_count(fifo) == 0);
|
|
}
|
|
return true;
|
|
}
|
|
|
|
uint8_t fifo_peek(const fifo_t *fifo) {
|
|
uint8_t data = 0;
|
|
|
|
if (!fifo_empty(fifo)) {
|
|
data = fifo->buffer[fifo->tail % fifo->buffer_len];
|
|
}
|
|
return data;
|
|
}
|
|
|
|
bool fifo_back(fifo_t *fifo) {
|
|
if (!fifo_empty(fifo)) {
|
|
fifo->head--;
|
|
return true;
|
|
}
|
|
return false;
|
|
}
|
|
|
|
uint8_t fifo_getc(fifo_t *fifo) {
|
|
uint8_t data = 0;
|
|
|
|
if (!fifo_empty(fifo)) {
|
|
data = fifo->buffer[fifo->tail % fifo->buffer_len];
|
|
fifo->tail++;
|
|
}
|
|
return data;
|
|
}
|
|
|
|
bool fifo_putc(fifo_t *fifo, uint8_t data) {
|
|
bool status = false;
|
|
|
|
if (fifo) {
|
|
if (!fifo_full(fifo)) {
|
|
fifo->buffer[fifo->head % fifo->buffer_len] = data;
|
|
fifo->head++;
|
|
status = true;
|
|
}
|
|
}
|
|
return status;
|
|
}
|
|
|
|
uint8_t fifo_puts(fifo_t *fifo, uint8_t * string) {
|
|
if (fifo) {
|
|
for (uint8_t i = 0; i < str_len(string); i++) {
|
|
if (!fifo_putc(fifo, string[i]))
|
|
return i;
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
bool fifo_scanc(fifo_t *fifo, uint8_t c) {
|
|
if (fifo) {
|
|
if (!fifo_empty(fifo)) {
|
|
uint8_t tail = fifo->tail;
|
|
for (uint8_t i = 0; i < fifo_count(fifo); i++) {
|
|
uint8_t data = fifo->buffer[tail % fifo->buffer_len];
|
|
if (data == c) {
|
|
return true;
|
|
}
|
|
tail++;
|
|
}
|
|
}
|
|
return false;
|
|
}
|
|
return false;
|
|
}
|
|
|
|
uint8_t fifo_get_token(fifo_t *fifo, uint8_t * str, uint8_t len, uint8_t term) {
|
|
if (fifo) {
|
|
memset((void *)str, 0, len);
|
|
if (fifo_scanc(fifo, term) && str) {
|
|
uint8_t i = 0, c = 0;
|
|
while ((c = fifo_getc(fifo)) != 0 && c != term && i < len) {
|
|
str[i] = c;
|
|
i++;
|
|
}
|
|
return i;
|
|
}
|
|
return 0;
|
|
}
|
|
return 0;
|
|
}
|
|
|