?? os_q.c
字號:
/*********************************************************************************************************
** Small RTOS(51)
** The Real-Time Kernel(For Keil c51)
**
** (c) Copyright 2002-2003, chenmingji
** All Rights Reserved
**
** V1.12.0
**
**
**--------------文件信息--------------------------------------------------------------------------------
**文 件 名: OS_Q.C
**創 建 人: 陳明計
**最后修改日期: 2002年12月2日
**描 述: Small RTOS(51)消息隊列代碼
**
**--------------歷史版本信息----------------------------------------------------------------------------
** 創建人: 陳明計
** 版 本: V1.10
** 日 期: 2002年6月20日
** 描 述: 原始版本
**
**------------------------------------------------------------------------------------------------------
** 修改人: 陳明計
** 版 本: V1.10.2
** 日 期: 2002年9月9日
** 描 述: 修改OSQIntPost()的Keil C51特殊代碼，它編譯沒有問題，但會造成閱讀
** 障礙。這部分代碼僅在使用Keil C51時出現。
**------------------------------------------------------------------------------------------------------
** 修改人: 陳明計
** 版 本: V1.10.5
** 日 期: 2002年10月26日
** 描 述: 修改OSQFlush()使其不再清除等待隊列，修改OSQCreate()代碼避免重入，修改OSQIntPost()
** 和OSQIntPost()時其效率更高
**
**------------------------------------------------------------------------------------------------------
** 修改人: 陳明計
** 版 本: V1.11.0
** 日 期: 2002年12月2日
** 描 述: 根據新版本需求更改開、關中斷代碼，增加注釋，簡化
**
**------------------------------------------------------------------------------------------------------
** 修改人: 陳明計
** 版 本: V1.12.0
** 日 期: 2002年12月30日
** 描 述: 沒有變化
**
**--------------當前版本修訂-----------------------------------------------------------------------------
** 修改人:
** 日 期:
** 描 述:
**
**------------------------------------------------------------------------------------------------------
********************************************************************************************************/
#define IN_OS_Q
#include "config.h"
#if EN_OS_Q > 0
/*********************************************************************************************************
** 函數名稱: OSQCreate
** 功能描述: 初始化消息隊列
** 輸 入: Buf:為隊列分配的存儲空間地址
** SizeOfBuf:為隊列分配的存儲空間大小
** 輸 出: NOT_OK:參數錯誤
** OS_Q_OK:成功
** 全局變量: 無
** 調用模塊: 無
**
** 作 者: 陳明計
** 日 期: 2002年9月1日
**-------------------------------------------------------------------------------------------------------
** 修改人: 陳明計
** 日 期: 2002年10月27日
**-------------------------------------------------------------------------------------------------------
** 修改人:
** 日 期:
**-------------------------------------------------------------------------------------------------------
********************************************************************************************************/
uint8 OSQCreate(uint8 OS_Q_MEM_SEL *Buf, uint8 SizeOfBuf)
//Buf[0]:隊列中字節數,Buf[1]:Buf總長度,Buf[2]:出對端,Buf[3](,Buf[4]):等待隊列任務列表
{
OS_ENTER_CRITICAL();
if ((SizeOfBuf >= 5) && (Buf != NULL))
{
Buf[0] = 0; /* 隊列中消息數目 */
Buf[1] = SizeOfBuf; /* 消息隊列占用內存字節數 */
#if OS_MAX_TASKS < 9
Buf[2] = 4; /* 將要出隊的消息所在位置 */
#else
Buf[2] = 5; /* 將要出隊的消息所在位置 */
#endif
Buf[3] = 0; /* 消息隊列的等待任務列表 */
Buf[4] = 0; /* 任務數大于等于8時為等待任務列表的一部分， */
/* 否則為消息緩沖區 */
OS_EXIT_CRITICAL();
return OS_Q_OK;
}
else
{
OS_EXIT_CRITICAL();
return NOT_OK;
}
}
/*********************************************************************************************************
** 函數名稱: OSQPend
** 功能描述: 等待消息隊列中的消息
** 輸 入: Ret:返回的消息
** Buf:指向隊列的指針
** Tick:等待時間
** 輸 出: NOT_OK:參數錯誤
** OS_Q_OK:收到消息
** OS_Q_TMO:超時到
** OS_Q_NOT_OK:無消息
** 全局變量: 無
** 調用模塊: OSRunningTaskID,OSClearSignal,OSSched,OS_ENTER_CRITICAL,OS_EXIT_CRITICAL
**
** 作 者: 陳明計
** 日 期: 2002年9月1日
**-------------------------------------------------------------------------------------------------------
** 修改人: 陳明計
** 日 期: 2002年10月9日
**------------------------------------------------------------------------------------------------------
** 修改人: 陳明計
** 日 期: 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; /* 設置超時時間 */
/* 可以優化寄存器的使用 */
/* 使用堆棧是為了使函數具有重入性 */
#ifdef __C51__
SP++;
*((uint8 data * data *)SP) = Ret;
#endif
/* 把任務加入等待任務隊列 */
#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) /* 消息隊列中是否有消息 */
{
/* 無消息 */
#ifdef __C51__
SP = SP + sizeof(Buf);
*((uint8 OS_Q_MEM_SEL * data *)(SP + 1 - sizeof(Buf))) = Buf;
#endif
OSClearSignal(OSRunningTaskID()); /* 任務進入等待狀態 */
OSSched(); /* 運行下一個任務 */
#ifdef __C51__
Buf = *((uint8 OS_Q_MEM_SEL * data *)(SP + 1 - sizeof(Buf)));
SP = SP - sizeof(Buf);
#endif
/* 任務再次運行，如果超時到，退出循環 */
if (OSWaitTick[OSRunningTaskID()] == 0)
{
break;
}
}
/* 將任務從等待隊列中清除（可以刪除） */
#if OS_MAX_TASKS < 9
Buf[3] &= ~OSMapTbl[OSRunningTaskID()];
#else
if (OSRunningTaskID() < 8)
{
Buf[3] &= ~OSMapTbl[OSRunningTaskID()];
}
else
{
Buf[4] &= ~OSMapTbl[OSRunningTaskID() & 0x07];
}
#endif
/* 判斷消息隊列中是否有消息 */
if (Buf[0] > 0)
{
/* 有，消息出隊 */
Buf[0]--; /* 隊列的消息數目減一 */
/* 指向下一個出隊位置 */
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
{
/* 無，返回錯誤碼 */
#ifdef __C51__
SP--;
#endif
OS_EXIT_CRITICAL();
return OS_Q_TMO;
}
}
#endif
/*********************************************************************************************************
** 函數名稱: OSQAccept
** 功能描述: 無等待從消息隊列中取得消息
** 輸 入: Ret:返回的消息
** Buf:指向隊列的指針
** 輸 出: NOT_OK:參數錯誤
** OS_Q_OK:收到消息
** OS_Q_TMO:超時到
** OS_Q_NOT_OK:無消息
** 全局變量: 無
** 調用模塊: OSClearSignal,OSSched,OS_ENTER_CRITICAL,OS_EXIT_CRITICAL
**
** 作 者: 陳明計
** 日 期: 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();
/* 判斷消息隊列中是否有消息 */
if (*Buf != 0)
{
/* 有，消息出隊 */
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
{
/* 無，返回錯誤碼 */
OS_EXIT_CRITICAL();
return OS_Q_NOT_OK;
}
}
#endif
/*********************************************************************************************************
** 函數名稱: OSQIntPost
** 功能描述: 中斷中FIFO方式發送消息
** 輸 入: Buf:指向隊列的指針
** Data:消息數據
** 輸 出: OS_Q_FULL:隊列滿
** OS_Q_OK:發送成功
** 全局變量: 無
** 調用模塊: OSIntSendSignal,OS_ENTER_CRITICAL,OS_EXIT_CRITICAL
**
** 作 者: 陳明計
** 日 期: 2002年9月1日
**-------------------------------------------------------------------------------------------------------
** 修改人: 陳明計
** 日 期: 2002年9月9日
**------------------------------------------------------------------------------------------------------
** 修改人: 陳明計
** 日 期: 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();
/* 隊列是否已滿 */
#if OS_MAX_TASKS < 9
if (Buf[0] < (Buf[1]-4))
#else
if (Buf[0] < (Buf[1]-5))
#endif
{
/* 使用堆棧是為了使函數具有重入性 */
#ifdef __C51__
SP++;
*((uint8 data *)SP) = Data;
#endif
/* 計算新入隊消息存儲位置 */
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
}
/* 存儲消息 */
#ifdef __C51__
Buf[temp] = *((uint8 data *)SP);
SP--;
#else
Buf[temp] = Data;
#endif
Buf[0]++; /* 消息數目加一 */
?? 快捷鍵說明
復制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -