170 lines
3.0 KiB
Plaintext
170 lines
3.0 KiB
Plaintext
U1Fifo *NewU1Fifo(U8 size,TssStruct *tss=NULL)
|
|
{
|
|
U1Fifo *f;
|
|
if (!tss) tss=Fs;
|
|
f=MAlloc(sizeof(U1Fifo),tss);
|
|
f->mem_tss=tss;
|
|
f->buf=MAlloc(size,tss);
|
|
f->mask=size-1;
|
|
f->in_ptr=0;
|
|
f->out_ptr=0;
|
|
return f;
|
|
}
|
|
|
|
void DelU1Fifo(U1Fifo *f)
|
|
{
|
|
Free(f->buf,f->mem_tss);
|
|
Free(f,f->mem_tss);
|
|
}
|
|
|
|
BoolU8 U1FifoInsert(U1Fifo *f,U1 ch)
|
|
{
|
|
U8 old_flags=GetFlags,
|
|
new_in_ptr;
|
|
Cli;
|
|
new_in_ptr=(f->in_ptr+1)&f->mask;
|
|
if (new_in_ptr==f->out_ptr) {
|
|
SetFlags(old_flags);
|
|
return FALSE;
|
|
} else {
|
|
f->buf[f->in_ptr]=ch;
|
|
f->in_ptr=new_in_ptr;
|
|
SetFlags(old_flags);
|
|
return TRUE;
|
|
}
|
|
}
|
|
|
|
BoolU8 U1FifoRemove(U1Fifo *f,U1 *ch)
|
|
{
|
|
U8 old_flags=GetFlags;
|
|
Cli;
|
|
if (f->in_ptr==f->out_ptr) {
|
|
SetFlags(old_flags);
|
|
return FALSE;
|
|
} else {
|
|
*ch=f->buf[f->out_ptr];
|
|
f->out_ptr=(f->out_ptr+1)&f->mask;
|
|
SetFlags(old_flags);
|
|
return TRUE;
|
|
}
|
|
}
|
|
|
|
BoolU8 U1FifoPeek(U1Fifo *f,U1 *ch)
|
|
{
|
|
U8 old_flags=GetFlags;
|
|
Cli;
|
|
if (f->in_ptr==f->out_ptr) {
|
|
SetFlags(old_flags);
|
|
return FALSE;
|
|
} else {
|
|
*ch=f->buf[f->out_ptr];
|
|
SetFlags(old_flags);
|
|
return TRUE;
|
|
}
|
|
}
|
|
|
|
void U1FifoFlush(U1Fifo *f)
|
|
{
|
|
U8 old_flags=GetFlags;
|
|
Cli;
|
|
f->out_ptr=f->in_ptr;
|
|
SetFlags(old_flags);
|
|
}
|
|
|
|
U8 U1FifoCnt(U1Fifo *f)
|
|
{
|
|
U8 result,old_flags=GetFlags;
|
|
Cli;
|
|
if (f->out_ptr>f->in_ptr)
|
|
result=f->mask+1-(f->out_ptr-f->in_ptr);
|
|
else
|
|
result=f->in_ptr-f->out_ptr;
|
|
SetFlags(old_flags);
|
|
return result;
|
|
}
|
|
|
|
U8Fifo *NewU8Fifo(U8 size,TssStruct *tss=NULL)
|
|
{
|
|
U8Fifo *f;
|
|
if (!tss) tss=Fs;
|
|
f=MAlloc(sizeof(U8Fifo),tss);
|
|
f->mem_tss=tss;
|
|
f->buf=MAlloc(size*sizeof(U8),tss);
|
|
f->mask=size-1;
|
|
f->in_ptr=0;
|
|
f->out_ptr=0;
|
|
return f;
|
|
}
|
|
|
|
void DelU8Fifo(U8Fifo *f)
|
|
{
|
|
Free(f->buf,f->mem_tss);
|
|
Free(f,f->mem_tss);
|
|
}
|
|
|
|
BoolU8 U8FifoInsert(U8Fifo *f,U8 d)
|
|
{
|
|
U8 old_flags=GetFlags,
|
|
new_in_ptr;
|
|
Cli;
|
|
new_in_ptr=(f->in_ptr+1)&f->mask;
|
|
if (new_in_ptr==f->out_ptr) {
|
|
SetFlags(old_flags);
|
|
return FALSE;
|
|
} else {
|
|
f->buf[f->in_ptr]=d;
|
|
f->in_ptr=new_in_ptr;
|
|
SetFlags(old_flags);
|
|
return TRUE;
|
|
}
|
|
}
|
|
|
|
BoolU8 U8FifoRemove(U8Fifo *f,U8 *d)
|
|
{
|
|
U8 old_flags=GetFlags;
|
|
Cli;
|
|
if (f->in_ptr==f->out_ptr) {
|
|
SetFlags(old_flags);
|
|
return FALSE;
|
|
} else {
|
|
*d=f->buf[f->out_ptr];
|
|
f->out_ptr=(f->out_ptr+1)&f->mask;
|
|
SetFlags(old_flags);
|
|
return TRUE;
|
|
}
|
|
}
|
|
|
|
BoolU8 U8FifoPeek(U8Fifo *f,U8 *d)
|
|
{
|
|
U8 old_flags=GetFlags;
|
|
Cli;
|
|
if (f->in_ptr==f->out_ptr) {
|
|
SetFlags(old_flags);
|
|
return FALSE;
|
|
} else {
|
|
*d=f->buf[f->out_ptr];
|
|
SetFlags(old_flags);
|
|
return TRUE;
|
|
}
|
|
}
|
|
|
|
void U8FifoFlush(U8Fifo *f)
|
|
{
|
|
U8 old_flags=GetFlags;
|
|
Cli;
|
|
f->out_ptr=f->in_ptr;
|
|
SetFlags(old_flags);
|
|
}
|
|
|
|
U8 U8FifoCnt(U8Fifo *f)
|
|
{
|
|
U8 result,old_flags=GetFlags;
|
|
Cli;
|
|
if (f->out_ptr>f->in_ptr)
|
|
result=f->mask+1-(f->out_ptr-f->in_ptr);
|
|
else
|
|
result=f->in_ptr-f->out_ptr;
|
|
SetFlags(old_flags);
|
|
return result;
|
|
}
|