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

#define IN_QUEUE
#include "config.h"

/*********************************************************************************************************
** 函數名稱: QueueCreate
** 功能描述: 初始化數據隊列
** 輸　入: Buf      ：為隊列分配的存儲空間地址
**         SizeOfBuf：為隊列分配的存儲空間大小（字節）
**         ReadEmpty：為隊列讀空時處理程序
**         WriteFull：為隊列寫滿時處理程序
** 輸　出: NOT_OK:參數錯誤
**         QUEUE_OK:成功
** 全局變量: 無
** 調用模塊: OS_ENTER_CRITICAL,OS_EXIT_CRITICAL
**
** 作　者: 陳明計
** 日　期: 2003年7月2日
**-------------------------------------------------------------------------------------------------------
** 修改人:
** 日　期:
**------------------------------------------------------------------------------------------------------
********************************************************************************************************/
        uint8 QueueCreate(void *Buf,
                          uint32 SizeOfBuf,
                          uint8 (* ReadEmpty)(),
                          uint8 (* WriteFull)()
                          )
{
    DataQueue *Queue;
    
    if (Buf != NULL && SizeOfBuf >= (sizeof(DataQueue)))        /* 判斷參數是否有效 */
    {
        Queue = (DataQueue *)Buf;

        OS_ENTER_CRITICAL();
                                                                /* 初始化結構體數據 */
        Queue->MaxData = (SizeOfBuf - (uint32)(((DataQueue *)0)->Buf)) / 
                         sizeof(QUEUE_DATA_TYPE);               /* 計算隊列可以存儲的數據數目 */
	    //myprintf("maxdata:%d\r\n",Queue->MaxData);
        Queue->End = Queue->Buf + Queue->MaxData;               /* 計算數據緩沖的結束地址 */
        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;
    }
}

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

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

/*********************************************************************************************************
** 函數名稱: QueueWrite
** 功能描述: FIFO方式發送數據
** 輸　入: Buf :指向隊列的指針
**         Data:消息數據
** 輸　出: NOT_OK   :參數錯誤
**         OS_Q_FULL:隊列滿
**         OS_Q_OK  :發送成功
** 全局變量: 無
** 調用模塊: OS_ENTER_CRITICAL,OS_EXIT_CRITICAL
**
** 作　者: 陳明計
** 日　期: 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)                                                    /* 隊列是否有效 */
    {
        Queue = (DataQueue *)Buf;
        
        OS_ENTER_CRITICAL();
        
        if (Queue->NData < Queue->MaxData)                              /* 隊列是否滿  */
        {                                                               /* 不滿        */
            Queue->In[0] = Data;                                        /* 數據入隊    */
            Queue->In++;                                                /* 調整入隊指針*/
            if (Queue->In >= Queue->End)
            {
                Queue->In = Queue->Buf;
            }
            Queue->NData++;                                             /* 數據增加    */
            err = QUEUE_OK;
        }
        else
        {                                                               /* 滿           */
            err = OS_Q_FULL;
            if (Queue->WriteFull != NULL)                               /* 調用用戶處理函數 */
            {
                err = Queue->WriteFull(Queue, Data, Q_WRITE_MODE);
            }
        }
        OS_EXIT_CRITICAL();
    }
    return err;
}
#endif

/*********************************************************************************************************
** 函數名稱: QueueWriteFront
** 功能描述: LIFO方式發送數據
** 輸　入: Buf:指向隊列的指針
**         Data:消息數據
** 輸　出: OS_Q_FULL:隊列滿
**         OS_Q_OK:發送成功
** 全局變量: 無
** 調用模塊: OS_ENTER_CRITICAL,OS_EXIT_CRITICAL
**
** 作　者: 陳明計
** 日　期: 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)                                                    /* 隊列是否有效 */
    {
        Queue = (DataQueue *)Buf;
        
        OS_ENTER_CRITICAL();
        
        if (Queue->NData < Queue->MaxData)                              /* 隊列是否滿  */
        {                                                               /* 不滿 */
            Queue->Out--;                                               /* 調整出隊指針 */
            if (Queue->Out < Queue->Buf)
            {
                Queue->Out = Queue->End - 1;
            }
            Queue->Out[0] = Data;                                       /* 數據入隊     */
            Queue->NData++;                                             /* 數據數目增加 */
            err = QUEUE_OK;
        }
        else