/****************************************Copyright (c)**************************************************
**                               廣州周立功單片機(jī)發(fā)展有限公司
**                                     研    究    所
**                                        產(chǎn)品一部 
**
**                                 http://www.zlgmcu.com
**
**--------------文件信息--------------------------------------------------------------------------------
**文   件   名: queue.c
**創(chuàng)   建   人: 陳明計(jì)
**最后修改日期: 2003年7月2日
**描        述: 數(shù)據(jù)隊(duì)列的中間件
**              
**--------------歷史版本信息----------------------------------------------------------------------------
** 創(chuàng)建人: 陳明計(jì)
** 版  本: v1.0
** 日　期: 2003年7月2日
** 描　述: 原始版本
**
**--------------當(dāng)前版本修訂------------------------------------------------------------------------------
** 修改人: 
** 日　期:
** 描　述:
**
**------------------------------------------------------------------------------------------------------
********************************************************************************************************/

#define IN_QUEUE
#include "config.h"
extern char RcvSendBuf[];
/*********************************************************************************************************
** 函數(shù)名稱: QueueCreate
** 功能描述: 初始化數(shù)據(jù)隊(duì)列
** 輸　入: Buf      ：為隊(duì)列分配的存儲(chǔ)空間地址
**         SizeOfBuf：為隊(duì)列分配的存儲(chǔ)空間大小（字節(jié)）
**         ReadEmpty：為隊(duì)列讀空時(shí)處理程序
**         WriteFull：為隊(duì)列寫滿時(shí)處理程序
** 輸　出: NOT_OK:參數(shù)錯(cuò)誤
**         QUEUE_OK:成功
** 全局變量: 無
** 調(diào)用模塊: OS_ENTER_CRITICAL,OS_EXIT_CRITICAL
**
** 作　者: 陳明計(jì)
** 日　期: 2003年7月2日
**-------------------------------------------------------------------------------------------------------
** 修改人:
** 日　期:
**------------------------------------------------------------------------------------------------------
********************************************************************************************************/
        uint8 QueueCreate(void *Buf,
                          uint32 SizeOfBuf,
                          uint8 (* ReadEmpty)(),
                          uint8 (* WriteFull)()
                          )
{
    DataQueue *Queue;
    
    if (Buf != NULL && SizeOfBuf >= (sizeof(DataQueue)))        /* 判斷參數(shù)是否有效 */
    {
        Queue = (DataQueue *)Buf;

        OS_ENTER_CRITICAL();
                                                                /* 初始化結(jié)構(gòu)體數(shù)據(jù) */
        Queue->MaxData = (SizeOfBuf - (uint32)(((DataQueue *)0)->Buf)) / 
                         sizeof(QUEUE_DATA_TYPE);               /* 計(jì)算隊(duì)列可以存儲(chǔ)的數(shù)據(jù)數(shù)目 */
	    myprintf("maxdata:%d\r\n",Queue->MaxData);
        Queue->End = Queue->Buf + Queue->MaxData;               /* 計(jì)算數(shù)據(jù)緩沖的結(jié)束地址 */
        Queue->Out = Queue->Buf;
        Queue->In = Queue->Buf;
        Queue->NData = 0;
        Queue->ReadEmpty = ReadEmpty;
        Queue->WriteFull = WriteFull;
		Queue->MaxData = (SizeOfBuf - (uint32)(((DataQueue *)0)->Buf)) / 
                         sizeof(QUEUE_DATA_TYPE); 

        OS_EXIT_CRITICAL();
		myprintf("sizeof:%d  MaxData:%d Queue:%d\r\n",SizeOfBuf,Queue->MaxData,(uint32)(((DataQueue*)0)->Buf));
		myprintf("in:%i   out:%i  end :%i  ndata:%i\r\n",(uint32)(Queue->In),(uint32)(Queue->Out),(uint32)(Queue->End),Queue->NData);

        return QUEUE_OK;
    }
    else
    {
        return NOT_OK;
    }
}

/*********************************************************************************************************
** 函數(shù)名稱: QueueRead
** 功能描述: 獲取隊(duì)列中的數(shù)據(jù)
** 輸　入: Ret:存儲(chǔ)返回的消息的地址
**         Buf:指向隊(duì)列的指針
** 輸　出: NOT_OK     ：參數(shù)錯(cuò)誤
**         QUEUE_OK   ：收到消息
**         QUEUE_EMPTY：無消息
** 全局變量: 無
** 調(diào)用模塊: OS_ENTER_CRITICAL,OS_EXIT_CRITICAL
**
** 作　者: 陳明計(jì)
** 日　期: 2003年7月2日
**-------------------------------------------------------------------------------------------------------
** 修改人:
** 日　期:
**------------------------------------------------------------------------------------------------------
********************************************************************************************************/
        uint8 QueueRead(QUEUE_DATA_TYPE *Ret, void *Buf)
{
    uint8 err;
    DataQueue *Queue;

    err = NOT_OK;
    if (Buf != NULL)                                            /* 隊(duì)列是否有效 */
    {                                                           /* 有效 */
        Queue = (DataQueue *)Buf;
        
        OS_ENTER_CRITICAL();
        
        if (Queue->NData > 0)                                   /* 隊(duì)列是否為空 */
        {                                                       /* 不空         */
            *Ret = Queue->Out[0];                               /* 數(shù)據(jù)出隊(duì)     */
            Queue->Out++;                                       /* 調(diào)整出隊(duì)指針 */
            if (Queue->Out >= Queue->End)
            {
                Queue->Out = Queue->Buf;
            }
            Queue->NData--;                                     /* 數(shù)據(jù)減少      */
            err = QUEUE_OK;
        }
        else
        {                                                       /* 空              */
            err = QUEUE_EMPTY;
            if (Queue->ReadEmpty != NULL)                       /* 調(diào)用用戶處理函數(shù) */
            {
                err = Queue->ReadEmpty(Ret, Queue);
            }
        }
        OS_EXIT_CRITICAL();
    }
    return err;
}

/*********************************************************************************************************
** 函數(shù)名稱: QueueWrite
** 功能描述: FIFO方式發(fā)送數(shù)據(jù)
** 輸　入: Buf :指向隊(duì)列的指針
**         Data:消息數(shù)據(jù)
** 輸　出: NOT_OK   :參數(shù)錯(cuò)誤
**         OS_Q_FULL:隊(duì)列滿
**         OS_Q_OK  :發(fā)送成功
** 全局變量: 無
** 調(diào)用模塊: OS_ENTER_CRITICAL,OS_EXIT_CRITICAL
**
** 作　者: 陳明計(jì)
** 日　期: 2003年7月2日
**-------------------------------------------------------------------------------------------------------
** 修改人:
** 日　期:
**------------------------------------------------------------------------------------------------------
********************************************************************************************************/
#ifndef EN_QUEUE_WRITE
#define EN_QUEUE_WRITE      0
#endif

#if EN_QUEUE_WRITE > 0

        uint8 QueueWrite(void *Buf, QUEUE_DATA_TYPE Data)
{
    uint8 err;
    DataQueue *Queue;

    err = NOT_OK;
    if (Buf != NULL)                                                    /* 隊(duì)列是否有效 */
    {
        Queue = (DataQueue *)Buf;
        
        OS_ENTER_CRITICAL();
        
        if (Queue->NData < Queue->MaxData)                              /* 隊(duì)列是否滿  */
        {                                                               /* 不滿        */
            Queue->In[0] = Data;                                        /* 數(shù)據(jù)入隊(duì)    */
            Queue->In++;                                                /* 調(diào)整入隊(duì)指針*/
            if (Queue->In >= Queue->End)
            {
                Queue->In = Queue->Buf;
            }
            Queue->NData++;                                             /* 數(shù)據(jù)增加    */
            err = QUEUE_OK;
        }
        else
        {                                                               /* 滿           */
            err = OS_Q_FULL;
            if (Queue->WriteFull != NULL)                               /* 調(diào)用用戶處理函數(shù) */
            {
                err = Queue->WriteFull(Queue, Data, Q_WRITE_MODE);
            }
        }
        OS_EXIT_CRITICAL();
    }
    return err;
}
#endif

/*********************************************************************************************************
** 函數(shù)名稱: QueueWriteFront
** 功能描述: LIFO方式發(fā)送數(shù)據(jù)
** 輸　入: Buf:指向隊(duì)列的指針
**         Data:消息數(shù)據(jù)
** 輸　出: OS_Q_FULL:隊(duì)列滿
**         OS_Q_OK:發(fā)送成功
** 全局變量: 無
** 調(diào)用模塊: OS_ENTER_CRITICAL,OS_EXIT_CRITICAL
**
** 作　者: 陳明計(jì)
** 日　期: 2003年7月2日
**-------------------------------------------------------------------------------------------------------
** 修改人:
** 日　期:
**------------------------------------------------------------------------------------------------------
********************************************************************************************************/
#ifndef EN_QUEUE_WRITE_FRONT
#define EN_QUEUE_WRITE_FRONT    0
#endif

#if EN_QUEUE_WRITE_FRONT > 0

        uint8 QueueWriteFront(void *Buf, QUEUE_DATA_TYPE Data)
{
    uint8 err;
    DataQueue *Queue;

    err = NOT_OK;
    if (Buf != NULL)                                                    /* 隊(duì)列是否有效 */
    {
        Queue = (DataQueue *)Buf;
        
        OS_ENTER_CRITICAL();
        
        if (Queue->NData < Queue->MaxData)                              /* 隊(duì)列是否滿  */
        {                                                               /* 不滿 */
            Queue->Out--;                                               /* 調(diào)整出隊(duì)指針 */
            if (Queue->Out < Queue->Buf)
            {
                Queue->Out = Queue->End - 1;
            }
            Queue->Out[0] = Data;                                       /* 數(shù)據(jù)入隊(duì)     */
            Queue->NData++;                                             /* 數(shù)據(jù)數(shù)目增加 */
            err = QUEUE_OK;
        }
        else
        {                                                               /* 滿           */
            err = OS_Q_FULL;
            if (Queue->WriteFull != NULL)                               /* 調(diào)用用戶處理函數(shù) */
            {
                err = Queue->WriteFull(Queue, Data, Q_WRITE_FRONT_MODE);
            }
        }
        OS_EXIT_CRITICAL();
    }
    return err;
}

#endif

/*********************************************************************************************************
** 函數(shù)名稱: QueueNData
** 功能描述: 取得隊(duì)列中數(shù)據(jù)數(shù)
** 輸　入: Buf:指向隊(duì)列的指針
** 輸　出: 消息數(shù)
** 全局變量: 無
** 調(diào)用模塊: OS_ENTER_CRITICAL,OS_EXIT_CRITICAL
**
** 作　者: 陳明計(jì)
** 日　期: 2003年7月2日
**-------------------------------------------------------------------------------------------------------