📄 dataqueue.c
字号:
/*
* TOPPERS/JSP Kernel
* Toyohashi Open Platform for Embedded Real-Time Systems/
* Just Standard Profile Kernel
*
* Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
* Toyohashi Univ. of Technology, JAPAN
*
* 忋婰挊嶌尃幰偼丆埲壓偺 (1)乣(4) 偺忦審偐丆Free Software Foundation
* 偵傛偭偰岞昞偝傟偰偄傞 GNU General Public License 偺 Version 2 偵婰
* 弎偝傟偰偄傞忦審傪枮偨偡応崌偵尷傝丆杮僜僼僩僂僃傾乮杮僜僼僩僂僃傾
* 傪夵曄偟偨傕偺傪娷傓丏埲壓摨偠乯傪巊梡丒暋惢丒夵曄丒嵞攝晍乮埲壓丆
* 棙梡偲屇傇乯偡傞偙偲傪柍彏偱嫋戻偡傞丏
* (1) 杮僜僼僩僂僃傾傪僜乕僗僐乕僪偺宍偱棙梡偡傞応崌偵偼丆忋婰偺挊嶌
* 尃昞帵丆偙偺棙梡忦審偍傛傃壓婰偺柍曐徹婯掕偑丆偦偺傑傑偺宍偱僜乕
* 僗僐乕僪拞偵娷傑傟偰偄傞偙偲丏
* (2) 杮僜僼僩僂僃傾傪丆儔僀僽儔儕宍幃側偳丆懠偺僜僼僩僂僃傾奐敪偵巊
* 梡偱偒傞宍偱嵞攝晍偡傞応崌偵偼丆嵞攝晍偵敽偆僪僉儏儊儞僩乮棙梡
* 幰儅僯儏傾儖側偳乯偵丆忋婰偺挊嶌尃昞帵丆偙偺棙梡忦審偍傛傃壓婰
* 偺柍曐徹婯掕傪宖嵹偡傞偙偲丏
* (3) 杮僜僼僩僂僃傾傪丆婡婍偵慻傒崬傓側偳丆懠偺僜僼僩僂僃傾奐敪偵巊
* 梡偱偒側偄宍偱嵞攝晍偡傞応崌偵偼丆師偺偄偢傟偐偺忦審傪枮偨偡偙
* 偲丏
* (a) 嵞攝晍偵敽偆僪僉儏儊儞僩乮棙梡幰儅僯儏傾儖側偳乯偵丆忋婰偺挊
* 嶌尃昞帵丆偙偺棙梡忦審偍傛傃壓婰偺柍曐徹婯掕傪宖嵹偡傞偙偲丏
* (b) 嵞攝晍偺宍懺傪丆暿偵掕傔傞曽朄偵傛偭偰丆TOPPERS僾儘僕僃僋僩偵
* 曬崘偡傞偙偲丏
* (4) 杮僜僼僩僂僃傾偺棙梡偵傛傝捈愙揑傑偨偼娫愙揑偵惗偠傞偄偐側傞懝
* 奞偐傜傕丆忋婰挊嶌尃幰偍傛傃TOPPERS僾儘僕僃僋僩傪柶愑偡傞偙偲丏
*
* 杮僜僼僩僂僃傾偼丆柍曐徹偱採嫙偝傟偰偄傞傕偺偱偁傞丏忋婰挊嶌尃幰偍
* 傛傃TOPPERS僾儘僕僃僋僩偼丆杮僜僼僩僂僃傾偵娭偟偰丆偦偺揔梡壜擻惈傕
* 娷傔偰丆偄偐側傞曐徹傕峴傢側偄丏傑偨丆杮僜僼僩僂僃傾偺棙梡偵傛傝捈
* 愙揑傑偨偼娫愙揑偵惗偠偨偄偐側傞懝奞偵娭偟偰傕丆偦偺愑擟傪晧傢側偄丏
*
* @(#) $Id: dataqueue.c,v 1.9 2003/06/04 01:46:16 hiro Exp $
*/
/*
* 僨乕僞僉儏乕婡擻
*/
#include "jsp_kernel.h"
#include "check.h"
#include "task.h"
#include "wait.h"
#include "dataqueue.h"
/*
* 僨乕僞僉儏乕ID偺嵟戝抣乮kernel_cfg.c乯
*/
extern const ID tmax_dtqid;
/*
* 僨乕僞僉儏乕弶婜壔僽儘僢僋偺僄儕傾乮kernel_cfg.c乯
*/
extern const DTQINIB dtqinib_table[];
/*
* 僨乕僞僉儏乕偺悢
*/
#define TNUM_DTQ ((UINT)(tmax_dtqid - TMIN_DTQID + 1))
/*
* 僨乕僞僉儏乕娗棟僽儘僢僋偺僄儕傾乮kernel_cfg.c乯
*/
extern DTQCB dtqcb_table[];
/*
* 僨乕僞僉儏乕ID偐傜僨乕僞僉儏乕娗棟僽儘僢僋傪庢傝弌偡偨傔偺儅僋儘
*/
#define INDEX_DTQ(dtqid) ((UINT)((dtqid) - TMIN_DTQID))
#define get_dtqcb(dtqid) (&(dtqcb_table[INDEX_DTQ(dtqid)]))
/*
* 僨乕僞僉儏乕懸偪忣曬僽儘僢僋偺掕媊
*
* 僨乕僞僉儏乕傊偺憲怣懸偪偲僨乕僞僉儏乕偐傜偺庴怣懸偪偱丆摨偠懸偪忣
* 曬僽儘僢僋傪巊偆丏
*/
typedef struct dataqueue_waiting_information {
WINFO winfo; /* 昗弨偺懸偪忣曬僽儘僢僋 */
WOBJCB *wobjcb; /* 懸偪僆僽僕僃僋僩偺娗棟僽儘僢僋 */
VP_INT data; /* 憲庴怣僨乕僞 */
} WINFO_DTQ;
/*
* 僨乕僞僉儏乕婡擻偺弶婜壔
*/
#ifdef __dtqini
void
dataqueue_initialize(void)
{
UINT i;
DTQCB *dtqcb;
for (dtqcb = dtqcb_table, i = 0; i < TNUM_DTQ; dtqcb++, i++) {
queue_initialize(&(dtqcb->swait_queue));
dtqcb->dtqinib = &(dtqinib_table[i]);
queue_initialize(&(dtqcb->rwait_queue));
dtqcb->count = 0;
dtqcb->head = 0;
dtqcb->tail = 0;
}
}
#endif /* __dtqini */
/*
* 僨乕僞僉儏乕椞堟偵僨乕僞傪奿擺
*/
#ifdef __dtqenq
BOOL
enqueue_data(DTQCB *dtqcb, VP_INT data)
{
if (dtqcb->count < dtqcb->dtqinib->dtqcnt) {
*((VP_INT *)(dtqcb->dtqinib->dtq) + dtqcb->tail) = data;
dtqcb->count++;
dtqcb->tail++;
if (dtqcb->tail >= dtqcb->dtqinib->dtqcnt) {
dtqcb->tail = 0;
}
return(TRUE);
}
return(FALSE);
}
#endif /* __dtqenq */
/*
* 僨乕僞僉儏乕椞堟偵僨乕僞傪嫮惂奿擺
*/
#ifdef __dtqfenq
void
force_enqueue_data(DTQCB *dtqcb, VP_INT data)
{
*((VP_INT *)(dtqcb->dtqinib->dtq) + dtqcb->tail) = data;
dtqcb->tail++;
if (dtqcb->tail >= dtqcb->dtqinib->dtqcnt) {
dtqcb->tail = 0;
}
if (dtqcb->count < dtqcb->dtqinib->dtqcnt) {
dtqcb->count++;
}
else {
dtqcb->head = dtqcb->tail;
}
}
#endif /* __dtqfenq */
/*
* 僨乕僞僉儏乕椞堟偐傜僨乕僞傪庢弌偟
*/
#ifdef __dtqdeq
BOOL
dequeue_data(DTQCB *dtqcb, VP_INT *p_data)
{
if (dtqcb->count > 0) {
*p_data = *((VP_INT *)(dtqcb->dtqinib->dtq) + dtqcb->head);
dtqcb->count--;
dtqcb->head++;
if (dtqcb->head >= dtqcb->dtqinib->dtqcnt) {
dtqcb->head = 0;
}
return(TRUE);
}
return(FALSE);
}
#endif /* __dtqdeq */
/*
* 庴怣懸偪僉儏乕偺愭摢僞僗僋傊偺僨乕僞憲怣
*/
#ifdef __dtqsnd
TCB *
send_data_rwait(DTQCB *dtqcb, VP_INT data)
{
TCB *tcb;
if (!(queue_empty(&(dtqcb->rwait_queue)))) {
tcb = (TCB *) queue_delete_next(&(dtqcb->rwait_queue));
((WINFO_DTQ *)(tcb->winfo))->data = data;
return(tcb);
}
return(NULL);
}
#endif /* __dtqsnd */
/*
* 憲怣懸偪僉儏乕偺愭摢僞僗僋偐傜偺僨乕僞庴怣
*/
#ifdef __dtqrcv
TCB *
receive_data_swait(DTQCB *dtqcb, VP_INT *p_data)
{
TCB *tcb;
if (!(queue_empty(&(dtqcb->swait_queue)))) {
tcb = (TCB *) queue_delete_next(&(dtqcb->swait_queue));
*p_data = ((WINFO_DTQ *)(tcb->winfo))->data;
return(tcb);
}
return(NULL);
}
#endif /* __dtqrcv */
/*
* 僨乕僞僉儏乕傊偺憲怣
*/
#ifdef __snd_dtq
extern void exit_to_dispatch(void);
SYSCALL ER
snd_dtq(ID dtqid, VP_INT data)
{
DTQCB *dtqcb;
WINFO_DTQ winfo;
TCB *tcb;
ER ercd;
LOG_SND_DTQ_ENTER(dtqid, data);
CHECK_DISPATCH();
CHECK_DTQID(dtqid);
dtqcb = get_dtqcb(dtqid);
t_lock_cpu();
if ((tcb = send_data_rwait(dtqcb, data)) != NULL) {
if (wait_complete(tcb)) {
// dispatch();
}
ercd = E_OK;
}
else if (enqueue_data(dtqcb, data)) {
ercd = E_OK;
}
else {
winfo.data = data;
wobj_make_wait((WOBJCB *) dtqcb, (WINFO_WOBJ *) &winfo);
t_unlock_cpu();
exit_to_dispatch();
ercd = winfo.winfo.wercd;
}
t_unlock_cpu();
exit:
LOG_SND_DTQ_LEAVE(ercd);
return(ercd);
}
#endif /* __snd_dtq */
/*
* 僨乕僞僉儏乕傊偺憲怣乮億乕儕儞僌乯
*/
#ifdef __psnd_dtq
SYSCALL ER
psnd_dtq(ID dtqid, VP_INT data)
{
DTQCB *dtqcb;
TCB *tcb;
ER ercd;
LOG_PSND_DTQ_ENTER(dtqid, data);
CHECK_TSKCTX_UNL();
CHECK_DTQID(dtqid);
dtqcb = get_dtqcb(dtqid);
t_lock_cpu();
if ((tcb = send_data_rwait(dtqcb, data)) != NULL) {
if (wait_complete(tcb)) {
// dispatch();
}
ercd = E_OK;
}
else if (enqueue_data(dtqcb, data)) {
ercd = E_OK;
}
else {
ercd = E_TMOUT;
}
t_unlock_cpu();
exit:
LOG_PSND_DTQ_LEAVE(ercd);
return(ercd);
}
#endif /* __psnd_dtq */
/*
* 僨乕僞僉儏乕傊偺憲怣乮億乕儕儞僌丆旕僞僗僋僐儞僥僉僗僩梡乯
*/
#ifdef __ipsnd_dtq
SYSCALL ER
ipsnd_dtq(ID dtqid, VP_INT data)
{
DTQCB *dtqcb;
TCB *tcb;
ER ercd;
LOG_IPSND_DTQ_ENTER(dtqid, data);
CHECK_INTCTX_UNL();
CHECK_DTQID(dtqid);
dtqcb = get_dtqcb(dtqid);
i_lock_cpu();
if ((tcb = send_data_rwait(dtqcb, data)) != NULL) {
if (wait_complete(tcb)) {
reqflg = TRUE;
}
ercd = E_OK;
}
else if (enqueue_data(dtqcb, data)) {
ercd = E_OK;
}
else {
ercd = E_TMOUT;
}
i_unlock_cpu();
exit:
LOG_IPSND_DTQ_LEAVE(ercd);
return(ercd);
}
#endif /* __ipsnd_dtq */
/*
* 僨乕僞僉儏乕傊偺憲怣乮僞僀儉傾僂僩偁傝乯
*/
#ifdef __tsnd_dtq
SYSCALL ER
tsnd_dtq(ID dtqid, VP_INT data, TMO tmout)
{
DTQCB *dtqcb;
WINFO_DTQ winfo;
TMEVTB tmevtb;
TCB *tcb;
ER ercd;
LOG_TSND_DTQ_ENTER(dtqid, data, tmout);
CHECK_DISPATCH();
CHECK_DTQID(dtqid);
CHECK_TMOUT(tmout);
dtqcb = get_dtqcb(dtqid);
t_lock_cpu();
if ((tcb = send_data_rwait(dtqcb, data)) != NULL) {
if (wait_complete(tcb)) {
//dispatch();
}
ercd = E_OK;
}
else if (enqueue_data(dtqcb, data)) {
ercd = E_OK;
}
else if (tmout == TMO_POL) {
ercd = E_TMOUT;
}
else {
winfo.data = data;
wobj_make_wait_tmout((WOBJCB *) dtqcb, (WINFO_WOBJ *) &winfo,
&tmevtb, tmout);
t_unlock_cpu();
exit_to_dispatch();
ercd = winfo.winfo.wercd;
}
t_unlock_cpu();
exit:
LOG_TSND_DTQ_LEAVE(ercd);
return(ercd);
}
#endif /* __tsnd_dtq */
/*
* 僨乕僞僉儏乕傊偺嫮惂憲怣
*/
#ifdef __fsnd_dtq
SYSCALL ER
fsnd_dtq(ID dtqid, VP_INT data)
{
DTQCB *dtqcb;
TCB *tcb;
ER ercd;
LOG_FSND_DTQ_ENTER(dtqid, data);
CHECK_TSKCTX_UNL();
CHECK_DTQID(dtqid);
dtqcb = get_dtqcb(dtqid);
CHECK_ILUSE(dtqcb->dtqinib->dtqcnt > 0);
t_lock_cpu();
if ((tcb = send_data_rwait(dtqcb, data)) != NULL) {
if (wait_complete(tcb)) {
//dispatch();
}
}
else {
force_enqueue_data(dtqcb, data);
}
ercd = E_OK;
t_unlock_cpu();
exit:
LOG_FSND_DTQ_LEAVE(ercd);
return(ercd);
}
#endif /* __fsnd_dtq */
/*
* 僨乕僞僉儏乕傊偺嫮惂憲怣乮旕僞僗僋僐儞僥僉僗僩梡乯
*/
#ifdef __ifsnd_dtq
SYSCALL ER
ifsnd_dtq(ID dtqid, VP_INT data)
{
DTQCB *dtqcb;
TCB *tcb;
ER ercd;
LOG_IFSND_DTQ_ENTER(dtqid, data);
CHECK_INTCTX_UNL();
CHECK_DTQID(dtqid);
dtqcb = get_dtqcb(dtqid);
CHECK_ILUSE(dtqcb->dtqinib->dtqcnt > 0);
i_lock_cpu();
if ((tcb = send_data_rwait(dtqcb, data)) != NULL) {
if (wait_complete(tcb)) {
reqflg = TRUE;
}
}
else {
force_enqueue_data(dtqcb, data);
}
ercd = E_OK;
i_unlock_cpu();
exit:
LOG_IFSND_DTQ_LEAVE(ercd);
return(ercd);
}
#endif /* __ifsnd_dtq */
/*
* 僨乕僞僉儏乕偐傜偺庴怣
*/
#ifdef __rcv_dtq
SYSCALL ER
rcv_dtq(ID dtqid, VP_INT *p_data)
{
DTQCB *dtqcb;
WINFO_DTQ winfo;
TCB *tcb;
VP_INT data;
ER ercd;
LOG_RCV_DTQ_ENTER(dtqid, p_data);
CHECK_DISPATCH();
CHECK_DTQID(dtqid);
dtqcb = get_dtqcb(dtqid);
t_lock_cpu();
if (dequeue_data(dtqcb, p_data)) {
if ((tcb = receive_data_swait(dtqcb, &data)) != NULL) {
enqueue_data(dtqcb, data);
if (wait_complete(tcb)) {
// dispatch();
}
}
ercd = E_OK;
}
else if ((tcb = receive_data_swait(dtqcb, p_data)) != NULL) {
if (wait_complete(tcb)) {
// dispatch();
}
ercd = E_OK;
}
else {
runtsk->tstat = (TS_WAITING | TS_WAIT_WOBJ);
make_wait(&(winfo.winfo));
queue_insert_prev(&(dtqcb->rwait_queue),
&(runtsk->task_queue));
winfo.wobjcb = (WOBJCB *) dtqcb;
LOG_TSKSTAT(runtsk);
t_unlock_cpu();
exit_to_dispatch();
ercd = winfo.winfo.wercd;
if (ercd == E_OK) {
*p_data = winfo.data;
}
}
t_unlock_cpu();
exit:
LOG_RCV_DTQ_LEAVE(ercd, *p_data);
return(ercd);
}
#endif /* __rcv_dtq */
/*
* 僨乕僞僉儏乕偐傜偺庴怣乮億乕儕儞僌乯
*/
#ifdef __prcv_dtq
SYSCALL ER
prcv_dtq(ID dtqid, VP_INT *p_data)
{
DTQCB *dtqcb;
TCB *tcb;
VP_INT data;
ER ercd;
LOG_PRCV_DTQ_ENTER(dtqid, p_data);
CHECK_TSKCTX_UNL();
CHECK_DTQID(dtqid);
dtqcb = get_dtqcb(dtqid);
t_lock_cpu();
if (dequeue_data(dtqcb, p_data)) {
if ((tcb = receive_data_swait(dtqcb, &data)) != NULL) {
enqueue_data(dtqcb, data);
if (wait_complete(tcb)) {
//dispatch();
}
}
ercd = E_OK;
}
else if ((tcb = receive_data_swait(dtqcb, p_data)) != NULL) {
if (wait_complete(tcb)) {
//dispatch();
}
ercd = E_OK;
}
else {
ercd = E_TMOUT;
}
t_unlock_cpu();
exit:
LOG_PRCV_DTQ_LEAVE(ercd, *p_data);
return(ercd);
}
#endif /* __prcv_dtq */
/*
* 僨乕僞僉儏乕偐傜偺庴怣乮僞僀儉傾僂僩偁傝乯
*/
#ifdef __trcv_dtq
SYSCALL ER
trcv_dtq(ID dtqid, VP_INT *p_data, TMO tmout)
{
DTQCB *dtqcb;
WINFO_DTQ winfo;
TMEVTB tmevtb;
TCB *tcb;
VP_INT data;
ER ercd;
LOG_TRCV_DTQ_ENTER(dtqid, p_data, tmout);
CHECK_DISPATCH();
CHECK_DTQID(dtqid);
CHECK_TMOUT(tmout);
dtqcb = get_dtqcb(dtqid);
t_lock_cpu();
if (dequeue_data(dtqcb, p_data)) {
if ((tcb = receive_data_swait(dtqcb, &data)) != NULL) {
enqueue_data(dtqcb, data);
if (wait_complete(tcb)) {
//dispatch();
}
}
ercd = E_OK;
}
else if ((tcb = receive_data_swait(dtqcb, p_data)) != NULL) {
if (wait_complete(tcb)) {
//dispatch();
}
ercd = E_OK;
}
else if (tmout == TMO_POL) {
ercd = E_TMOUT;
}
else {
runtsk->tstat = (TS_WAITING | TS_WAIT_WOBJ);
make_wait_tmout(&(winfo.winfo), &tmevtb, tmout);
queue_insert_prev(&(dtqcb->rwait_queue),
&(runtsk->task_queue));
winfo.wobjcb = (WOBJCB *) dtqcb;
LOG_TSKSTAT(runtsk);
t_unlock_cpu();
exit_to_dispatch();
ercd = winfo.winfo.wercd;
if (ercd == E_OK) {
*p_data = winfo.data;
}
}
t_unlock_cpu();
exit:
LOG_TRCV_DTQ_LEAVE(ercd, *p_data);
return(ercd);
}
#endif /* __trcv_dtq */
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -