/*********************************************************************************************************
**				                               Small RTOS(51)
**                                   The Real-Time Kernel(For Keil c51)
**
**                                  (c) Copyright 2002-2003, chenmingji
**                                           All Rights Reserved
**
**                                                  V1.12.0
**
**
**--------------文件信息--------------------------------------------------------------------------------
**文   件   名: OS_Q.C
**創(chuàng)   建   人: 陳明計(jì)
**最后修改日期:  2002年12月2日
**描        述: Small RTOS(51)消息隊(duì)列代碼
**
**--------------歷史版本信息----------------------------------------------------------------------------
** 創(chuàng)建人: 陳明計(jì)
** 版  本: V1.10
** 日　期: 2002年6月20日
** 描　述: 原始版本
**
**------------------------------------------------------------------------------------------------------
** 修改人: 陳明計(jì)
** 版  本: V1.10.2
** 日　期: 2002年9月9日
** 描　述: 修改OSQIntPost()的Keil C51特殊代碼，它編譯沒(méi)有問(wèn)題，但會(huì)造成閱讀
**         障礙。這部分代碼僅在使用Keil C51時(shí)出現(xiàn)。
**------------------------------------------------------------------------------------------------------
** 修改人: 陳明計(jì)
** 版  本: V1.10.5
** 日　期: 2002年10月26日
** 描　述: 修改OSQFlush()使其不再清除等待隊(duì)列，修改OSQCreate()代碼避免重入，修改OSQIntPost()
**        和OSQIntPost()時(shí)其效率更高
**
**------------------------------------------------------------------------------------------------------
** 修改人: 陳明計(jì)
** 版  本: V1.11.0
** 日　期: 2002年12月2日
** 描　述: 根據(jù)新版本需求更改開(kāi)、關(guān)中斷代碼，增加注釋?zhuān)?jiǎn)化
**
**------------------------------------------------------------------------------------------------------
** 修改人: 陳明計(jì)
** 版  本: V1.12.0
** 日　期: 2002年12月30日
** 描　述: 沒(méi)有變化
**
**--------------當(dāng)前版本修訂-----------------------------------------------------------------------------
** 修改人:
** 日　期:
** 描　述:
**
**------------------------------------------------------------------------------------------------------
********************************************************************************************************/

#define  IN_OS_Q
#include "config.h"

#if EN_OS_Q > 0
/*********************************************************************************************************
** 函數(shù)名稱(chēng): OSQCreate
** 功能描述: 初始化消息隊(duì)列
** 輸　入: Buf:為隊(duì)列分配的存儲(chǔ)空間地址
**         SizeOfBuf:為隊(duì)列分配的存儲(chǔ)空間大小
** 輸　出: NOT_OK:參數(shù)錯(cuò)誤
**         OS_Q_OK:成功
** 全局變量: 無(wú)
** 調(diào)用模塊: 無(wú)
**
** 作　者: 陳明計(jì)
** 日　期: 2002年9月1日
**-------------------------------------------------------------------------------------------------------
** 修改人: 陳明計(jì)
** 日　期: 2002年10月27日
**-------------------------------------------------------------------------------------------------------
** 修改人:
** 日　期:
**-------------------------------------------------------------------------------------------------------
********************************************************************************************************/

        uint8 OSQCreate(uint8 OS_Q_MEM_SEL *Buf, uint8 SizeOfBuf)
//Buf[0]:隊(duì)列中字節(jié)數(shù),Buf[1]:Buf總長(zhǎng)度,Buf[2]:出對(duì)端,Buf[3](,Buf[4]):等待隊(duì)列任務(wù)列表
{
    OS_ENTER_CRITICAL();

    if ((SizeOfBuf >= 5) && (Buf != NULL))
    {
        Buf[0] = 0;                         /* 隊(duì)列中消息數(shù)目           */
        Buf[1] = SizeOfBuf;                 /* 消息隊(duì)列占用內(nèi)存字節(jié)數(shù)    */
#if OS_MAX_TASKS < 9
        Buf[2] = 4;                         /* 將要出隊(duì)的消息所在位置    */
#else
        Buf[2] = 5;                         /* 將要出隊(duì)的消息所在位置    */
#endif
        Buf[3] = 0;                         /* 消息隊(duì)列的等待任務(wù)列表    */
        Buf[4] = 0;                         /* 任務(wù)數(shù)大于等于8時(shí)為等待任務(wù)列表的一部分， */
                                            /* 否則為消息緩沖區(qū)         */

        OS_EXIT_CRITICAL();
        return OS_Q_OK;
    }
    else
    {
        OS_EXIT_CRITICAL();
        return NOT_OK;
    }

}

/*********************************************************************************************************
** 函數(shù)名稱(chēng): OSQPend
** 功能描述: 等待消息隊(duì)列中的消息
** 輸　入: Ret:返回的消息
**         Buf:指向隊(duì)列的指針
**         Tick:等待時(shí)間
** 輸　出: NOT_OK:參數(shù)錯(cuò)誤
**         OS_Q_OK:收到消息
**         OS_Q_TMO:超時(shí)到
**         OS_Q_NOT_OK:無(wú)消息
** 全局變量: 無(wú)
** 調(diào)用模塊: OSRunningTaskID,OSClearSignal,OSSched,OS_ENTER_CRITICAL,OS_EXIT_CRITICAL
**
** 作　者: 陳明計(jì)
** 日　期: 2002年9月1日
**-------------------------------------------------------------------------------------------------------
** 修改人: 陳明計(jì)
** 日　期: 2002年10月9日
**------------------------------------------------------------------------------------------------------
** 修改人: 陳明計(jì)
** 日　期: 2002年12月2日
**-------------------------------------------------------------------------------------------------------
** 修改人:
** 日　期:
**-------------------------------------------------------------------------------------------------------
********************************************************************************************************/
#if EN_OS_Q_PENT > 0

        uint8 OSQPend(uint8 data *Ret, uint8 OS_Q_MEM_SEL *Buf, uint8 Tick)
{
#ifdef __C51__
    uint8 data *cp;
#endif

#if EN_OS_Q_CHK > 0
    if (Buf == NULL)
    {
        return NOT_OK;
    }
#endif

    OS_ENTER_CRITICAL();

    OSWaitTick[OSRunningTaskID()] = Tick;       /* 設(shè)置超時(shí)時(shí)間         */
                                                /* 可以?xún)?yōu)化寄存器的使用  */

                /* 使用堆棧是為了使函數(shù)具有重入性 */
#ifdef __C51__
    SP++;
    *((uint8 data * data *)SP) = Ret;
#endif

                /* 把任務(wù)加入等待任務(wù)隊(duì)列 */
#if OS_MAX_TASKS < 9
    Buf[3] |= OSMapTbl[OSRunningTaskID()];
#else
    if (OSRunningTaskID() < 8)
    {
        Buf[3] |= OSMapTbl[OSRunningTaskID()];
    }
    else
    {
        Buf[4] |= OSMapTbl[OSRunningTaskID() & 0x07];
    }
#endif

    while (Buf[0] == 0)             /* 消息隊(duì)列中是否有消息 */
    {
                /* 無(wú)消息 */
#ifdef __C51__
        SP = SP + sizeof(Buf);
        *((uint8 OS_Q_MEM_SEL * data *)(SP + 1 - sizeof(Buf))) = Buf;
#endif

        OSClearSignal(OSRunningTaskID());   /* 任務(wù)進(jìn)入等待狀態(tài) */
        OSSched();                          /* 運(yùn)行下一個(gè)任務(wù) */

#ifdef __C51__
        Buf = *((uint8 OS_Q_MEM_SEL * data *)(SP + 1 - sizeof(Buf)));
        SP = SP - sizeof(Buf);
#endif
                /* 任務(wù)再次運(yùn)行，如果超時(shí)到，退出循環(huán) */
        if (OSWaitTick[OSRunningTaskID()] == 0)
        {
            break;
        }
    }

                /* 將任務(wù)從等待隊(duì)列中清除（可以刪除） */
#if OS_MAX_TASKS < 9
    Buf[3] &= ~OSMapTbl[OSRunningTaskID()];
#else
    if (OSRunningTaskID() < 8)
    {
        Buf[3] &= ~OSMapTbl[OSRunningTaskID()];
    }
    else
    {
        Buf[4] &= ~OSMapTbl[OSRunningTaskID() & 0x07];
    }
#endif
                /* 判斷消息隊(duì)列中是否有消息 */
    if (Buf[0] > 0)
    {
                /* 有，消息出隊(duì) */
        Buf[0]--;           /* 隊(duì)列的消息數(shù)目減一 */
                /* 指向下一個(gè)出隊(duì)位置 */
        Buf[2]++;
        if (Buf[2] >= Buf[1] )
        {
#if OS_MAX_TASKS < 9
            Buf[2] = 4;
#else
            Buf[2] = 5;
#endif
        }
#ifdef __C51__
        cp = (uint8 data *)(*((uint8 data *)SP));
        SP--;
        *cp = Buf[Buf[2]];
#else
        *Ret = Buf[Buf[2]];
#endif
        OS_EXIT_CRITICAL();
        return OS_Q_OK;
    }
    else
    {
                /* 無(wú)，返回錯(cuò)誤碼 */
#ifdef __C51__
        SP--;
#endif

        OS_EXIT_CRITICAL();
        return OS_Q_TMO;
    }
}
#endif

/*********************************************************************************************************
** 函數(shù)名稱(chēng): OSQAccept
** 功能描述: 無(wú)等待從消息隊(duì)列中取得消息
** 輸　入: Ret:返回的消息
**         Buf:指向隊(duì)列的指針
** 輸　出: NOT_OK:參數(shù)錯(cuò)誤
**         OS_Q_OK:收到消息
**         OS_Q_TMO:超時(shí)到
**         OS_Q_NOT_OK:無(wú)消息
** 全局變量: 無(wú)
** 調(diào)用模塊: OSClearSignal,OSSched,OS_ENTER_CRITICAL,OS_EXIT_CRITICAL
**
** 作　者: 陳明計(jì)
** 日　期: 2002年9月1日
**-------------------------------------------------------------------------------------------------------
** 修改人:
** 日　期:
**-------------------------------------------------------------------------------------------------------
********************************************************************************************************/
#if EN_OS_Q_ACCEPT > 0
        uint8 OSQAccept(uint8 data *Ret, uint8 OS_Q_MEM_SEL *Buf)
{
#if EN_OS_Q_CHK > 0
    if (Buf == NULL)
    {
        return NOT_OK;
    }
#endif

    OS_ENTER_CRITICAL();

                /* 判斷消息隊(duì)列中是否有消息 */
    if (*Buf != 0)
    {
                /* 有，消息出隊(duì) */
        Buf[0]--;
        Buf[2]++;
        if (Buf[2] >= Buf[1])
        {
#if OS_MAX_TASKS < 9
            Buf[2] = 4;
#else
            Buf[2] = 5;
#endif
        }
        *Ret = Buf[Buf[2]];
        OS_EXIT_CRITICAL();
        return OS_Q_OK;
    }
    else
    {
                /* 無(wú)，返回錯(cuò)誤碼 */
        OS_EXIT_CRITICAL();
        return OS_Q_NOT_OK;
    }
}
#endif


/*********************************************************************************************************
** 函數(shù)名稱(chēng): OSQIntPost
** 功能描述: 中斷中FIFO方式發(fā)送消息
** 輸　入: Buf:指向隊(duì)列的指針
**         Data:消息數(shù)據(jù)
** 輸　出: OS_Q_FULL:隊(duì)列滿(mǎn)
**         OS_Q_OK:發(fā)送成功
** 全局變量: 無(wú)
** 調(diào)用模塊: OSIntSendSignal,OS_ENTER_CRITICAL,OS_EXIT_CRITICAL
**
** 作　者: 陳明計(jì)
** 日　期: 2002年9月1日
**-------------------------------------------------------------------------------------------------------
** 修改人: 陳明計(jì)
** 日　期: 2002年9月9日
**------------------------------------------------------------------------------------------------------
** 修改人: 陳明計(jì)
** 日　期: 2002年10月26日
**------------------------------------------------------------------------------------------------------
** 修改人:
** 日　期:
**-------------------------------------------------------------------------------------------------------
********************************************************************************************************/
#if EN_OS_Q_INT_POST > 0  || EN_OS_Q_POST > 0
        uint8 OSQIntPost(uint8 OS_Q_MEM_SEL *Buf, uint8 Data)
{
    uint8 temp,i;

#if EN_OS_Q_CHK > 0
    if (Buf == NULL)
    {
        return NOT_OK;
    }
#endif

    OS_ENTER_CRITICAL();

                /* 隊(duì)列是否已滿(mǎn) */
#if OS_MAX_TASKS < 9
    if (Buf[0] < (Buf[1]-4))
#else
    if (Buf[0] < (Buf[1]-5))
#endif
    {
                /* 使用堆棧是為了使函數(shù)具有重入性 */
#ifdef __C51__
        SP++;
        *((uint8 data *)SP) = Data;
#endif
                /* 計(jì)算新入隊(duì)消息存儲(chǔ)位置 */
        temp = Buf[2] + Buf[0] + 1;
        if (temp >= Buf[1])
        {
#if OS_MAX_TASKS < 9
            temp = temp - Buf[1]+4;
#else
            temp = temp - Buf[1]+5;
#endif
        }
                /* 存儲(chǔ)消息 */
#ifdef __C51__
        Buf[temp] = *((uint8 data *)SP);
        SP--;
#else
        Buf[temp] = Data;
#endif

        Buf[0]++;               /* 消息數(shù)目加一 */