/* FIFO */

#include "bootpack.h"

#define FLAGS_OVERRUN 0x0001

void fifo8_init(struct FIFO8 *fifo, int size, unsigned char *buf)

/* 初始化FIFO缓冲区 */

{

fifo->size = size;

fifo->buf = buf;

fifo->free = size; /* 缓冲区大小 */

fifo->flags = 0;

fifo->p = 0; /* 下一个数据写入位置 */

fifo->q = 0; /* 下一个数据读出位置 */

return;

}

int fifo8_put(struct FIFO8 *fifo, unsigned char data)

/* 向FIFO传送数据并保存 */

{

if (fifo->free == 0) {

/* 没有空间了，溢出 */

fifo->flags |= FLAGS_OVERRUN;

return -1;

}

fifo->buf[fifo->p] = data;

fifo->p ;

if (fifo->p == fifo->size) {

fifo->p = 0;

}

fifo->free--;

return 0;

}

int fifo8_get(struct FIFO8 *fifo)

/* 从FIFO取得一个数据 */

{

int data;

if (fifo->free == fifo->size) {

/* 如果缓冲区为空则返回-1 */

return -1;

}

data = fifo->buf[fifo->q];

fifo->q ;

if (fifo->q == fifo->size) {

fifo->q = 0;

}

fifo->free ;

return data;

}

int fifo8_status(struct FIFO8 *fifo)

/* 报告一下积攒是数据量 */

{

return fifo->size - fifo->free;

}