fifo.c

来自「TinyWorks操作系统。 每个任务占6~10个字节的RAM空间」· C语言 代码 · 共 48 行

#include "TinyWorks.h"
#include "fifo.h"

u16 fifo_len( fifo_t *fifo )
{
    u16 result;
    result = fifo->len;
    result += fifo->in;
    result -= fifo->out;
    if (result >= fifo->len)
        result -= fifo->len;
    return result;
}

void fifo_add( fifo_t *fifo, u8 c )
{
    fifo->buff[fifo->in] = c;
    fifo->in ++;
    if (fifo->in == fifo->len)
        fifo->in = 0;
    if (fifo->in == fifo->out)
    {
        fifo->out ++;
        if (fifo->out == fifo->len)
            fifo->out = 0;
    }
}

u8 fifo_get( fifo_t *fifo )
{
    u8 result;
    result = fifo->buff[fifo->out];
    if (fifo->out != fifo->in)
    {
        fifo->out ++;
        if (fifo->out == fifo->len)
            fifo->out = 0;
    }
    return result;
}

s8 fifo_dummy( fifo_t *fifo )
{
    if (fifo->out != fifo->in)
        return true;
    return false;
}