forked from backup/30dayMakeOS
Add 11 day code
This commit is contained in:
57
11_day/fifo.c
Normal file
57
11_day/fifo.c
Normal file
@@ -0,0 +1,57 @@
|
||||
/* 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;
|
||||
}
|
||||
Reference in New Issue
Block a user