Commit: 85b0e77d02b663c84a72ffa35384f41843fcc205 - hos-v4a (git)

HOS-V4 Advance の開発リポジトリ

Commit MetaInfo

• Revision: 85b0e77d02b663c84a72ffa35384f41843fcc205 (tree)
• Time: 2009-08-16 10:40:47
• Author: ryuz <ryuz>
• Commiter: ryuz

Log Message

(none)

Change Summary

• modified: kernel/include/config/cfgknl.h
• modified: kernel/include/kernel.h
• modified: kernel/include/parser/parsknl.h
• modified: kernel/source/object/dtq/prcv_dtq.c
• modified: kernel/source/object/dtq/rcv_dtq.c
• modified: kernel/source/object/dtq/snd_dtq.c
• modified: kernel/source/object/dtq/trcv_dtq.c

Incremental Difference

--- a/kernel/include/config/cfgknl.h
+++ b/kernel/include/config/cfgknl.h
@@ -228,6 +228,10 @@ C言語構文(例えばtypedefなど)はこの中には記載せず、マクロ
 /*  Data queues                                   */
 /* ---------------------------------------------- */
 
+/* Configuration */
+#define _KERNEL_CFG_DTQ_DTQCNT_ZERO		TRUE				/**< %jp{キューサイズ0に対応する} */
+#define _KERNEL_CFG_DTQ_DTQCNT_NONZERO	TRUE				/**< %jp{キューサイズ非0に対応する} */
+
 /* Attribute */
 #define _KERNEL_CFG_DTQ_TA_TFIFO		TRUE				/**< %jp{TA_TFIFO属性に対応する} */
 #define _KERNEL_CFG_DTQ_TA_TPRI			TRUE				/**< %jp{TA_TPRI属性に対応する} */

--- a/kernel/include/kernel.h
+++ b/kernel/include/kernel.h
@@ -181,9 +181,9 @@ typedef struct t_cdtq
 /** %jp{データキュー状態}%en{Data queue state packet} */
 typedef struct t_rdtq
 {
-	ID   stskid;			/**< %jp{データキューの送信待ち行列の先頭のタスクのID番号}%en{ID number of the task at the head of the send-wait queue} */
-	ID   rtskid;			/**< %jp{データキューの受信待ち行列の先頭のタスクのID番号}%en{ID number of the task at the head of the receive-wait queue} */
-	UINT sdtqcnt;			/**< %jp{データキューに入っているデータの数}%en{The number of data elemnts int the data queue} */
+	ID		stskid;			/**< %jp{データキューの送信待ち行列の先頭のタスクのID番号}%en{ID number of the task at the head of the send-wait queue} */
+	ID		rtskid;			/**< %jp{データキューの受信待ち行列の先頭のタスクのID番号}%en{ID number of the task at the head of the receive-wait queue} */
+	UINT	sdtqcnt;		/**< %jp{データキューに入っているデータの数}%en{The number of data elemnts int the data queue} */
 } T_RDTQ;
 
 

--- a/kernel/include/parser/parsknl.h
+++ b/kernel/include/parser/parsknl.h
@@ -182,6 +182,12 @@
 #define _KERNEL_SPT_KSND_DTQ		FALSE
 #endif
 
+#if _KERNEL_SPT_TRCV_DTQ || (_KERNEL_SPT_RCV_DTQ && _KERNEL_SPT_PRCV_DTQ)
+#define _KERNEL_SPT_KRCV_DTQ		TRUE
+#else
+#define _KERNEL_SPT_KRCV_DTQ		FALSE
+#endif
+
 
 /* Mailboxes */
 #define _KERNEL_SPT_CRE_MBX 		_KERNEL_CFG_CRE_MBX 		/* cre_mbx */
@@ -985,6 +991,12 @@
 #define _KERNEL_DTQCB_SPLIT_RO		_KERNEL_CFG_DTQCB_SPLIT_RO
 #endif
 
+/* Configuration */
+#define _KERNEL_SPT_DTQ_DTQCNT_ZERO		_KERNEL_CFG_DTQ_DTQCNT_ZERO		/**< %jp{キューサイズ0に対応する} */
+#define _KERNEL_SPT_DTQ_DTQCNT_NONZERO	_KERNEL_CFG_DTQ_DTQCNT_NONZERO	/**< %jp{キューサイズ非0に対応する} */
+#if !_KERNEL_SPT_DTQ_DTQCNT_ZERO && !_KERNEL_SPT_DTQ_DTQCNT_NONZERO
+#error "!_KERNEL_SPT_DTQ_DTQCNT_ZERO && !_KERNEL_SPT_DTQ_DTQCNT_NONZERO"
+#endif
 
 /* Attribute */
 #define _KERNEL_SPT_DTQ_TA_TFIFO	_KERNEL_CFG_DTQ_TA_TFIFO			/**< %jp{TA_TFIFO属性に対応する} */

--- a/kernel/source/object/dtq/prcv_dtq.c
+++ b/kernel/source/object/dtq/prcv_dtq.c
@@ -21,10 +21,13 @@
 /** %jp{データキューへの送信(ポーリング)}%en{Send to Data Queue(Polling)} */
 ER prcv_dtq(ID dtqid, VP_INT *p_data)
 {
-	_KERNEL_T_DTQCB  *dtqcb;
-	_KERNEL_T_TSKHDL tskhdl;
-	_KERNEL_T_TCB    *tcb;
-	ER               ercd;
+	_KERNEL_T_DTQCB				*dtqcb;
+	const _KERNEL_T_DTQCB_RO	*dtqcb_ro;
+	_KERNEL_T_TSKHDL			tskhdl;
+	_KERNEL_T_TCB				*tcb;
+	_KERNEL_DTQ_T_DTQCNT		sdtqcnt;
+	ER							ercd;
+
 
 	/* %jp{コンテキストチェック} */
 #if _KERNEL_SPT_PRCV_DTQ_E_CTX
@@ -63,65 +66,87 @@ ER prcv_dtq(ID dtqid, VP_INT *p_data)
 		/* %jp{待ちタスクがあれば待ち解除} */
 		tcb = _KERNEL_TSK_TSKHDL2TCB(tskhdl);		/* %jp{TCB取得} */
 		
-		/* %jp{送信データ取得} */
-		*p_data = (VP_INT)_KERNEL_TSK_GET_DATA(tcb);
-		
 		/* %jp{タスクを起す} */
 		_KERNEL_TSK_SET_ERCD(tcb, E_OK);	/* %jp{エラーコード設定} */
 		_KERNEL_DSP_WUP_TSK(tskhdl);		/* %jp{タスクの待ち解除} */
 		_KERNEL_DTQ_RMV_STOQ(tskhdl);		/* %jp{タイムアウトキューからはずす} */
-		
-		/* %jp{タスクディスパッチの実行} */
-		_KERNEL_DSP_TSK();
-
-		ercd = E_OK;	/* %jp{正常終了}%en{Normal completion} */
 	}
-	else
+	
+	
+#if _KERNEL_SPT_DTQ_DTQCNT_NONZERO		/* %jp{データキュー情報取得} */
+	sdtqcnt = _KERNEL_DTQ_GET_SDTQCNT(dtqcb);
+	if ( sdtqcnt > 0 )		/* %jp{キューにデータはあるか？} */
 	{
-		const _KERNEL_T_DTQCB_RO *dtqcb_ro;
-		_KERNEL_DTQ_T_DTQCNT     sdtqcnt;
-		VP_INT		             *dtq;
+		_KERNEL_DTQ_T_DTQCNT		dtqcnt;
+		VP_INT						*dtq;
+		_KERNEL_DTQ_T_DTQCNT		head;
 		
 		/* %jp{RO部取得} */
 		dtqcb_ro = _KERNEL_DTQ_GET_DTQCB_RO(dtqid, dtqcb);
-
-		/* %jp{データキュー情報取得} */
-		sdtqcnt = _KERNEL_DTQ_GET_SDTQCNT(dtqcb);
-		dtq     = _KERNEL_DTQ_GET_DTQ(dtqcb_ro);
-
-		if ( sdtqcnt > 0 )		/* %jp{キューにデータはあるか？} */
+		
+		/* %jp{データキュー取得} */
+		dtq = _KERNEL_DTQ_GET_DTQ(dtqcb_ro);
+		
+		/* %jp{キューからデータを取り出し} */
+		head   = _KERNEL_DTQ_GET_HEAD(dtqcb);
+		dtqcnt = _KERNEL_DTQ_GET_DTQCNT(dtqcb_ro);
+		*p_data = dtq[head];
+		
+		/* %jp{送信待ちタスクがあればデータを追加} */
+		if ( tskhdl != _KERNEL_TSKHDL_NULL )
 		{
-			_KERNEL_DTQ_T_DTQCNT head;
-			_KERNEL_DTQ_T_DTQCNT dtqcnt;
-
-			/* %jp{キューからデータを取り出し} */
-			head   = _KERNEL_DTQ_GET_HEAD(dtqcb);
-			dtqcnt = _KERNEL_DTQ_GET_DTQCNT(dtqcb_ro);
-			*p_data = dtq[head];
-			
-			/* %jp{データ個数を減ずる} */
+			/* %jp{送信データ格納} */
+			tcb = _KERNEL_TSK_TSKHDL2TCB(tskhdl);		/* %jp{TCB取得} */
+			dtq[head] = (VP_INT)_KERNEL_TSK_GET_DATA(tcb);
+		}
+		else
+		{
+			/* %jp{送信待ちが無ければキューのデータ個数を減ずる} */
 			sdtqcnt--;
 			_KERNEL_DTQ_SET_SDTQCNT(dtqcb, sdtqcnt);
+		}
+		
+		/* %jp{先頭位置をずらす} */
+		if ( head + 1 < dtqcnt )
+		{
+			head++;
+		}
+		else
+		{
+			head = 0;
+		}
+		_KERNEL_DTQ_SET_HEAD(dtqcb, head);
+
+		if ( tskhdl != _KERNEL_TSKHDL_NULL )
+		{
+			/* %jp{タスクディスパッチの実行} */
+			_KERNEL_DSP_TSK();
+		}
+		
+		ercd = E_OK;	/* %jp{正常終了}%en{Normal completion} */
+	}
+	else
+#endif
+	{
+#if _KERNEL_SPT_DTQ_DTQCNT_ZERO
+		if ( tskhdl != _KERNEL_TSKHDL_NULL )
+		{
+			/* %jp{送信データ取得} */
+			tcb     = _KERNEL_TSK_TSKHDL2TCB(tskhdl);		/* %jp{TCB取得} */
+			*p_data = (VP_INT)_KERNEL_TSK_GET_DATA(tcb);	/* %jp{送信データ格納} */
 
-			/* %jp{先頭位置をずらす} */
-			if ( head + 1 < dtqcnt )
-			{
-				head++;
-			}
-			else
-			{
-				head = 0;
-			}
-			_KERNEL_DTQ_SET_HEAD(dtqcb, head);
-
-			ercd = E_OK;	/* %jp{正常終了}%en{Normal completion} */
+			/* %jp{タスクディスパッチの実行} */
+			_KERNEL_DSP_TSK();
+
+			ercd = E_OK;		/* %jp{正常終了}%en{Normal completion} */
 		}
 		else
+#endif
 		{
-			ercd = E_TMOUT;	/* %jp{タイムアウト}%en{Normal completion} */
+			ercd = E_TMOUT;		/* %jp{タイムアウト} */
 		}		
 	}
-	
+		
 	_KERNEL_LEAVE_SVC();	/* %jp{サービスコールから出る}%en{leave service-call} */
 	
 	return ercd;

--- a/kernel/source/object/dtq/rcv_dtq.c
+++ b/kernel/source/object/dtq/rcv_dtq.c
@@ -21,11 +21,13 @@
 /** %jp{データキューからの受信} */
 ER rcv_dtq(ID dtqid, VP_INT *p_data)
 {
-	_KERNEL_T_DTQCB  *dtqcb;
-	_KERNEL_T_TSKHDL tskhdl;
-	_KERNEL_T_TCB    *tcb;
-	ER               ercd;
-
+	_KERNEL_T_DTQCB				*dtqcb;
+	const _KERNEL_T_DTQCB_RO	*dtqcb_ro;
+	_KERNEL_T_TSKHDL			tskhdl;
+	_KERNEL_T_TCB				*tcb;
+	_KERNEL_DTQ_T_DTQCNT		sdtqcnt;
+	ER							ercd;
+	
 	/* %jp{コンテキストチェック} */
 #if _KERNEL_SPT_RCV_DTQ_E_CTX
 	if ( _KERNEL_SYS_SNS_DPN() )
@@ -63,61 +65,86 @@ ER rcv_dtq(ID dtqid, VP_INT *p_data)
 		/* %jp{待ちタスクがあれば待ち解除} */
 		tcb = _KERNEL_TSK_TSKHDL2TCB(tskhdl);		/* %jp{TCB取得} */
 		
-		/* %jp{送信データ取得} */
-		*p_data = (VP_INT)_KERNEL_TSK_GET_DATA(tcb);
-		
 		/* %jp{タスクを起す} */
 		_KERNEL_TSK_SET_ERCD(tcb, E_OK);	/* %jp{エラーコード設定} */
 		_KERNEL_DSP_WUP_TSK(tskhdl);		/* %jp{タスクの待ち解除} */
 		_KERNEL_DTQ_RMV_STOQ(tskhdl);		/* %jp{タイムアウトキューからはずす} */
-		
-		/* %jp{タスクディスパッチの実行} */
-		_KERNEL_DSP_TSK();
-
-		ercd = E_OK;	/* %jp{正常終了}%en{Normal completion} */
 	}
-	else
+	
+	
+#if _KERNEL_SPT_DTQ_DTQCNT_NONZERO		/* %jp{データキュー情報取得} */
+	sdtqcnt = _KERNEL_DTQ_GET_SDTQCNT(dtqcb);
+	if ( sdtqcnt > 0 )		/* %jp{キューにデータはあるか？} */
 	{
-		const _KERNEL_T_DTQCB_RO *dtqcb_ro;
-		_KERNEL_DTQ_T_DTQCNT     sdtqcnt;
-		VP_INT		             *dtq;
+		_KERNEL_DTQ_T_DTQCNT		dtqcnt;
+		VP_INT						*dtq;
+		_KERNEL_DTQ_T_DTQCNT		head;
 		
 		/* %jp{RO部取得} */
 		dtqcb_ro = _KERNEL_DTQ_GET_DTQCB_RO(dtqid, dtqcb);
-
-		/* %jp{データキュー情報取得} */
-		sdtqcnt = _KERNEL_DTQ_GET_SDTQCNT(dtqcb);
-		dtq     = _KERNEL_DTQ_GET_DTQ(dtqcb_ro);
-
-		if ( sdtqcnt > 0 )		/* %jp{キューにデータはあるか？} */
+		
+		/* %jp{データキュー取得} */
+		dtq = _KERNEL_DTQ_GET_DTQ(dtqcb_ro);
+		
+		/* %jp{キューからデータを取り出し} */
+		head   = _KERNEL_DTQ_GET_HEAD(dtqcb);
+		dtqcnt = _KERNEL_DTQ_GET_DTQCNT(dtqcb_ro);
+		*p_data = dtq[head];
+		
+		/* %jp{送信待ちタスクがあればデータを追加} */
+		if ( tskhdl != _KERNEL_TSKHDL_NULL )
 		{
-			_KERNEL_DTQ_T_DTQCNT head;
-			_KERNEL_DTQ_T_DTQCNT dtqcnt;
-
-			/* %jp{キューからデータを取り出し} */
-			head   = _KERNEL_DTQ_GET_HEAD(dtqcb);
-			dtqcnt = _KERNEL_DTQ_GET_DTQCNT(dtqcb_ro);
-			*p_data = dtq[head];
-			
-			/* %jp{データ個数を減ずる} */
+			/* %jp{送信データ格納} */
+			tcb = _KERNEL_TSK_TSKHDL2TCB(tskhdl);		/* %jp{TCB取得} */
+			dtq[head] = (VP_INT)_KERNEL_TSK_GET_DATA(tcb);
+		}
+		else
+		{
+			/* %jp{送信待ちが無ければキューのデータ個数を減ずる} */
 			sdtqcnt--;
 			_KERNEL_DTQ_SET_SDTQCNT(dtqcb, sdtqcnt);
+		}
+		
+		/* %jp{先頭位置をずらす} */
+		if ( head + 1 < dtqcnt )
+		{
+			head++;
+		}
+		else
+		{
+			head = 0;
+		}
+		_KERNEL_DTQ_SET_HEAD(dtqcb, head);
 
-			/* %jp{先頭位置をずらす} */
-			if ( head + 1 < dtqcnt )
-			{
-				head++;
-			}
-			else
-			{
-				head = 0;
-			}
-			_KERNEL_DTQ_SET_HEAD(dtqcb, head);
+		if ( tskhdl != _KERNEL_TSKHDL_NULL )
+		{
+			/* %jp{タスクディスパッチの実行} */
+			_KERNEL_DSP_TSK();
+		}
+		
+		ercd = E_OK;	/* %jp{正常終了}%en{Normal completion} */
+	}
+	else
+#endif
+	{
+#if _KERNEL_SPT_DTQ_DTQCNT_ZERO
+		if ( tskhdl != _KERNEL_TSKHDL_NULL )
+		{
+			/* %jp{送信データ取得} */
+			tcb     = _KERNEL_TSK_TSKHDL2TCB(tskhdl);		/* %jp{TCB取得} */
+			*p_data = (VP_INT)_KERNEL_TSK_GET_DATA(tcb);	/* %jp{送信データ格納} */
+
+			/* %jp{タスクディスパッチの実行} */
+			_KERNEL_DSP_TSK();
 
 			ercd = E_OK;	/* %jp{正常終了}%en{Normal completion} */
 		}
 		else
+#endif
 		{
+			/* %jp{RO部取得} */
+			dtqcb_ro = _KERNEL_DTQ_GET_DTQCB_RO(dtqid, dtqcb);
+			
 			/* %jp{実行中タスクを取得} */
 			tskhdl = _KERNEL_SYS_GET_RUNTSK();			/* %jp{タスクハンドル取得} */
 			tcb    = _KERNEL_TSK_TSKHDL2TCB(tskhdl);	/* %jp{TCB取得} */
@@ -130,10 +157,10 @@ ER rcv_dtq(ID dtqid, VP_INT *p_data)
 			_KERNEL_TSK_SET_WOBJID(tcb, dtqid);					/* %jp{待ちオブジェクトID設定} */
 			_KERNEL_DSP_WAI_TSK(tskhdl);						/* %jp{待ち状態に設定} */
 			_KERNEL_DTQ_ADD_RQUE(dtqcb, dtqcb_ro, tskhdl);		/* %jp{待ち行列に追加} */
-		
+			
 			/* %jp{タスクディスパッチの実行} */
 			_KERNEL_DSP_TSK();
-
+			
 			/* %jp{エラーコードの取得} */
 			ercd = _KERNEL_TSK_GET_ERCD(tcb);
 		}		

--- a/kernel/source/object/dtq/snd_dtq.c
+++ b/kernel/source/object/dtq/snd_dtq.c
@@ -129,11 +129,10 @@ ER snd_dtq(ID dtqid, VP_INT data)
 			_KERNEL_TSK_SET_DATA(tcb, data);
 			_KERNEL_DSP_WAI_TSK(tskhdl);
 			_KERNEL_DTQ_ADD_SQUE(dtqcb, dtqcb_ro, tskhdl);		/* %jp{待ち行列に追加} */
-
-		
+			
 			/* %jp{タスクディスパッチの実行} */
 			_KERNEL_DSP_TSK();
-
+			
 			/* %jp{エラーコードの取得} */
 			ercd = _KERNEL_TSK_GET_ERCD(tcb);
 		}		

--- a/kernel/source/object/dtq/trcv_dtq.c
+++ b/kernel/source/object/dtq/trcv_dtq.c
@@ -72,12 +72,13 @@ ER trcv_dtq(ID dtqid, VP_INT *p_data, TMO tmout)
  */
 ER _kernel_rcv_dtq(ID dtqid, VP_INT *p_data, TMO tmout)
 {
-	_KERNEL_T_DTQCB_PTR  dtqcb;
-	_KERNEL_T_TSKHDL     tskhdl;
-	_KERNEL_T_TCB        *tcb;
-	_KERNEL_DTQ_T_DTQCNT dtqcnt;
-	ER                   ercd;
-
+	_KERNEL_T_DTQCB				*dtqcb;
+	const _KERNEL_T_DTQCB_RO	*dtqcb_ro;
+	_KERNEL_T_TSKHDL			tskhdl;
+	_KERNEL_T_TCB				*tcb;
+	_KERNEL_DTQ_T_DTQCNT		sdtqcnt;
+	ER							ercd;
+	
 	/* %jp{コンテキストチェック} */
 #if _KERNEL_SPT_KRCV_DTQ_E_CTX
 	if ( tmout != TMO_POL && _KERNEL_SYS_SNS_DPN() )
@@ -104,8 +105,8 @@ ER _kernel_rcv_dtq(ID dtqid, VP_INT *p_data, TMO tmout)
 		return E_NOEXS;			/* %jp{オブジェクト未生成}%en{Non-existant object} */
 	}
 #endif
-
-	/* %jp{コントロールブロック取得} */
+	
+	/* %jp{データキューコントロールブロック取得} */
 	dtqcb = _KERNEL_DTQ_ID2DTQCB(dtqid);
 	
 	/* %jp{送信待ち行列先頭からタスク取り出し} */
@@ -115,60 +116,82 @@ ER _kernel_rcv_dtq(ID dtqid, VP_INT *p_data, TMO tmout)
 		/* %jp{待ちタスクがあれば待ち解除} */
 		tcb = _KERNEL_TSK_TSKHDL2TCB(tskhdl);		/* %jp{TCB取得} */
 		
-		/* %jp{送信データ取得} */
-		*p_data = (VP_INT)_KERNEL_TSK_GET_DATA(tcb);
-		
 		/* %jp{タスクを起す} */
 		_KERNEL_TSK_SET_ERCD(tcb, E_OK);	/* %jp{エラーコード設定} */
 		_KERNEL_DSP_WUP_TSK(tskhdl);		/* %jp{タスクの待ち解除} */
 		_KERNEL_DTQ_RMV_STOQ(tskhdl);		/* %jp{タイムアウトキューからはずす} */
-		
-		/* %jp{タスクディスパッチの実行} */
-		_KERNEL_DSP_TSK();
-
-		ercd = E_OK;	/* %jp{正常終了}%en{Normal completion} */
 	}
-	else
+	
+	
+#if _KERNEL_SPT_DTQ_DTQCNT_NONZERO		/* %jp{データキュー情報取得} */
+	sdtqcnt = _KERNEL_DTQ_GET_SDTQCNT(dtqcb);
+	if ( sdtqcnt > 0 )		/* %jp{キューにデータはあるか？} */
 	{
-		const _KERNEL_T_DTQCB_RO *dtqcb_ro;
-		_KERNEL_DTQ_T_DTQCNT     sdtqcnt;
-		VP_INT		             *dtq;
+		_KERNEL_DTQ_T_DTQCNT		dtqcnt;
+		VP_INT						*dtq;
+		_KERNEL_DTQ_T_DTQCNT		head;
 		
 		/* %jp{RO部取得} */
 		dtqcb_ro = _KERNEL_DTQ_GET_DTQCB_RO(dtqid, dtqcb);
-
-		/* %jp{データキュー情報取得} */
-		sdtqcnt = _KERNEL_DTQ_GET_SDTQCNT(dtqcb);
-		dtq     = _KERNEL_DTQ_GET_DTQ(dtqcb_ro);
-
-		if ( sdtqcnt > 0 )		/* %jp{キューにデータはあるか？} */
+		
+		/* %jp{データキュー取得} */
+		dtq = _KERNEL_DTQ_GET_DTQ(dtqcb_ro);
+		
+		/* %jp{キューからデータを取り出し} */
+		head   = _KERNEL_DTQ_GET_HEAD(dtqcb);
+		dtqcnt = _KERNEL_DTQ_GET_DTQCNT(dtqcb_ro);
+		*p_data = dtq[head];
+		
+		/* %jp{送信待ちタスクがあればデータを追加} */
+		if ( tskhdl != _KERNEL_TSKHDL_NULL )
+		{
+			/* %jp{送信データ格納} */
+			tcb = _KERNEL_TSK_TSKHDL2TCB(tskhdl);		/* %jp{TCB取得} */
+			dtq[head] = (VP_INT)_KERNEL_TSK_GET_DATA(tcb);
+		}
+		else
 		{
-			_KERNEL_DTQ_T_DTQCNT head;
-			_KERNEL_DTQ_T_DTQCNT dtqcnt;
-
-			/* %jp{キューからデータを取り出し} */
-			head   = _KERNEL_DTQ_GET_HEAD(dtqcb);
-			dtqcnt = _KERNEL_DTQ_GET_DTQCNT(dtqcb_ro);
-			*p_data = dtq[head];
-			
-			/* %jp{データ個数を減ずる} */
+			/* %jp{送信待ちが無ければキューのデータ個数を減ずる} */
 			sdtqcnt--;
 			_KERNEL_DTQ_SET_SDTQCNT(dtqcb, sdtqcnt);
+		}
+		
+		/* %jp{先頭位置をずらす} */
+		if ( head + 1 < dtqcnt )
+		{
+			head++;
+		}
+		else
+		{
+			head = 0;
+		}
+		_KERNEL_DTQ_SET_HEAD(dtqcb, head);
 
-			/* %jp{先頭位置をずらす} */
-			if ( head + 1 < dtqcnt )
-			{
-				head++;
-			}
-			else
-			{
-				head = 0;
-			}
-			_KERNEL_DTQ_SET_HEAD(dtqcb, head);
+		if ( tskhdl != _KERNEL_TSKHDL_NULL )
+		{
+			/* %jp{タスクディスパッチの実行} */
+			_KERNEL_DSP_TSK();
+		}
+		
+		ercd = E_OK;	/* %jp{正常終了}%en{Normal completion} */
+	}
+	else
+#endif
+	{
+#if _KERNEL_SPT_DTQ_DTQCNT_ZERO
+		if ( tskhdl != _KERNEL_TSKHDL_NULL )
+		{
+			/* %jp{送信データ取得} */
+			tcb     = _KERNEL_TSK_TSKHDL2TCB(tskhdl);		/* %jp{TCB取得} */
+			*p_data = (VP_INT)_KERNEL_TSK_GET_DATA(tcb);	/* %jp{送信データ格納} */
+
+			/* %jp{タスクディスパッチの実行} */
+			_KERNEL_DSP_TSK();
 
 			ercd = E_OK;	/* %jp{正常終了}%en{Normal completion} */
 		}
 		else
+#endif
 		{
 			if ( tmout == TMO_POL )
 			{
@@ -176,6 +199,9 @@ ER _kernel_rcv_dtq(ID dtqid, VP_INT *p_data, TMO tmout)
 			}
 			else
 			{
+				/* %jp{RO部取得} */
+				dtqcb_ro = _KERNEL_DTQ_GET_DTQCB_RO(dtqid, dtqcb);
+				
 				/* %jp{実行中タスクを取得} */
 				tskhdl = _KERNEL_SYS_GET_RUNTSK();			/* %jp{タスクハンドル取得} */
 				tcb    = _KERNEL_TSK_TSKHDL2TCB(tskhdl);	/* %jp{TCB取得} */
@@ -192,17 +218,17 @@ ER _kernel_rcv_dtq(ID dtqid, VP_INT *p_data, TMO tmout)
 #if _KERNEL_SPT_TRCV_DTQ
 				if ( tmout != TMO_FEVR )
 				{
-					_KERNEL_DTQ_ADD_TOQ(tskhdl, tmout);				/* %jp{タイムアウトキューに追加} */
+					_KERNEL_DTQ_ADD_RTOQ(tskhdl, tmout);				/* %jp{タイムアウトキューに追加} */
 				}
 #endif
-			
+				
 				/* %jp{タスクディスパッチの実行} */
 				_KERNEL_DSP_TSK();
-
+				
 				/* %jp{エラーコードの取得} */
 				ercd = _KERNEL_TSK_GET_ERCD(tcb);
 			}
-		}
+		}		
 	}
 	
 	_KERNEL_LEAVE_SVC();	/* %jp{サービスコールから出る}%en{leave service-call} */
@@ -211,9 +237,7 @@ ER _kernel_rcv_dtq(ID dtqid, VP_INT *p_data, TMO tmout)
 }
 
 
-
 #endif	/* _KERNEL_SPT_KRCV_DTQ */
 
 
-
 /* end of file */