/**
|
******************************************************************************
|
* @file : MyQueue.c
|
* @brief : MyQueue program body
|
******************************************************************************
|
*/
|
#include "../inc/MyQueue.h"
|
|
#include "string.h"
|
int initQueue(stMyQueue * theQueue, void * pBuf, int nSize)
|
{
|
theQueue->buf1=pBuf;
|
theQueue->Caps=nSize;
|
theQueue->wp=0;
|
theQueue->rp=0;
|
theQueue->RecvBytes=0;
|
theQueue->bFull=0;
|
theQueue->bEmpty=1;
|
theQueue->state=0;
|
return 0;
|
}
|
int EmptyQueue(stMyQueue * theQueue)
|
{
|
theQueue->wp=0;
|
theQueue->rp=0;
|
theQueue->bFull=0;
|
theQueue->bEmpty=1;
|
theQueue->state=0;
|
return 0;
|
}
|
int GetContinueEmptyRoom(stMyQueue * theQueue)
|
{
|
int rp=theQueue->rp;
|
int wp=theQueue->wp;
|
if (wp < rp)
|
{
|
return rp - wp;
|
}else if (wp > rp)
|
{
|
return theQueue->Caps - wp;
|
}else if (IsEmpty(theQueue))
|
{
|
return theQueue->Caps - wp;
|
}else if (IsFull(theQueue))
|
{
|
return 0;
|
}
|
return 0;
|
}
|
int GetContinueData(stMyQueue * theQueue)
|
{
|
int rp=theQueue->rp;
|
int wp=theQueue->wp;
|
if (rp < wp)
|
{
|
return wp - rp;
|
}else if (rp > wp)
|
{
|
return theQueue->Caps - rp;
|
}else if (IsFull(theQueue))
|
{
|
return theQueue->Caps - rp;
|
}else if (IsEmpty(theQueue))
|
{
|
return 0;
|
}
|
return 0;
|
}
|
|
int AddSpace(stMyQueue * theQueue, int nSize)
|
{
|
if (nSize==0) return nSize;
|
int wp=theQueue->wp+=nSize;
|
if (wp>=theQueue->Caps) wp-=theQueue->Caps;
|
theQueue->bEmpty=0;
|
if (wp == theQueue->rp) theQueue->bFull=1;
|
theQueue->wp = wp;
|
theQueue->RecvBytes+=nSize;
|
return nSize;
|
}
|
|
int DelData(stMyQueue * theQueue, int nSize)
|
{
|
if (nSize==0) return nSize;
|
int rp=theQueue->rp+nSize;
|
if (rp>=theQueue->Caps) rp-=theQueue->Caps;
|
theQueue->bFull=0;
|
theQueue->rp = rp;
|
if (rp == theQueue->wp)
|
{
|
theQueue->bEmpty=1;
|
theQueue->wp=0;
|
theQueue->rp=0;
|
theQueue->state=0;
|
}
|
return nSize;
|
}
|
|
int CopyData(stMyQueue * theQueue, void * pData, int nSize)
|
{
|
int len1=GetContinueData(theQueue);
|
if (nSize <= len1)
|
{
|
memcpy(pData,theQueue->buf1+theQueue->rp,nSize);
|
return nSize;
|
}
|
else
|
{
|
memcpy(pData,theQueue->buf1+theQueue->rp,len1);
|
memcpy((char *)pData+len1,theQueue->buf1,nSize-len1);
|
return nSize;
|
}
|
|
}
|
|
|
int PushOne(stMyQueue * theQueue, unsigned char ch)
|
{
|
theQueue->bEmpty=0;
|
if (!IsFull(theQueue))
|
{
|
theQueue->buf1[theQueue->wp]=ch;
|
AddSpace(theQueue,1);
|
return 0;
|
}
|
return -1;
|
}
|
int PopOne(stMyQueue * theQueue)
|
{
|
theQueue->bFull=0;
|
unsigned char ch=theQueue->buf1[theQueue->rp];
|
if (!IsEmpty(theQueue))
|
{
|
DelData(theQueue,1);
|
}
|
return ch;
|
}
|
|
int PushIn(stMyQueue * theQueue, void * pData, int nSize)
|
{
|
int len1=GetContinueEmptyRoom(theQueue);
|
if (nSize <= len1)
|
{
|
memcpy(GetWriteBuffer(theQueue),pData,nSize);
|
AddSpace(theQueue, nSize);
|
return nSize;
|
}
|
|
memcpy(GetWriteBuffer(theQueue),pData,len1);
|
AddSpace(theQueue,len1);
|
int len2=GetContinueEmptyRoom(theQueue);
|
if (nSize-len1 <= len2)
|
{
|
memcpy(GetWriteBuffer(theQueue),(char *)pData+len1,nSize-len1);
|
AddSpace(theQueue, nSize-len1);
|
return nSize;
|
}
|
if (len2>0)
|
{
|
memcpy(GetWriteBuffer(theQueue),(char *)pData+len1,len2);
|
AddSpace(theQueue, len2);
|
len1+=len2;
|
}
|
return len1;
|
}
|
|
int PopOut(stMyQueue * theQueue, void * pData, int nSize)
|
{
|
// theQueue->rp+=nSize;
|
// if (theQueue->rp >= theQueue ->Caps) theQueue->rp-=theQueue->Caps;
|
// theQueue->DataSize-=nSize;
|
CopyData(theQueue,pData,nSize);
|
DelData(theQueue,nSize);
|
return nSize;
|
}
|
|
