/*
 * Copyright 2017 Oleg Borodin <onborodin@gmail.com>
 *
 */
#include <stdint.h>
#include <stdbool.h>
#include <string.h>
#include <stdio.h>

#include <fifo.h>
#include <tool.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;
}