tsnd_dtq.c

itron

/* ------------------------------------------------------------------------ */
/*  Hyper Operating System V4  μITRON4.0慌屯 Real-Time OS                  */
/*    ITRONカ〖ネル デ〖タキュ〖                                            */
/*                                                                          */
/*                                  Copyright (C) 1998-2002 by Project HOS  */
/*                                  http://sourceforge.jp/projects/hos/     */
/* ------------------------------------------------------------------------ */


#include "knl_dtq.h"



/* デ〖タキュ〖への流慨(タイムアウトあり) */
ER      tsnd_dtq(
		ID     dtqid,	/* 流慨滦据のデ〖タキュ〖のID戎规 */
		VP_INT data,	/* デ〖タキュ〖へ流慨するデ〖タ */
		TMO    tmout)	/* タイムアウト回年 */
{
	const T_KERNEL_DTQCB_ROM *dtqcb_rom;
	T_KERNEL_DTQCB_RAM       *dtqcb_ram;
	T_MKNL_TCB *mtcb;
	UINT tail;
	ER   ercd;

	/* ID のチェック */
#ifdef HOS_ERCHK_E_ID
	if ( dtqid < KERNEL_TMIN_DTQID || dtqid > KERNEL_TMAX_DTQID )
	{
		return E_ID;
	}
#endif

	/* パラメ〖タ〖チェック */
#ifdef HOS_ERCHK_E_PAR 
	if ( tmout != TMO_FEVR && tmout < 0 )
	{
		return E_PAR;
	}
#endif

	mknl_loc_sys();	/* システムのロック */

	/* コンテキストチェック */
#ifdef HOS_ERCHK_E_CTX
	if (  tmout != TMO_POL && mknl_sns_wai() )
	{
		mknl_unl_sys();	/* システムのロック豺近 */
		return E_CTX;	/* コンテキスト稍赖 */
	}
#endif

	dtqcb_ram = KERNEL_DTQID_TO_DTQCB_RAM(dtqid);

	/* オブジェクトの赂哼チェック */
#ifdef HOS_ERCHK_E_NOEXS
	if ( dtqcb_ram == NULL )
	{
		mknl_unl_sys();	/* システムのロック豺近 */
		return E_NOEXS;	/* オブジェクト踏栏喇 */
	}
#endif

	if ( mknl_ref_qhd(&dtqcb_ram->rcvque) != NULL )
	{
		/* 减慨略ちタスクがあれば倡庶 */
		mtcb = mknl_ref_qhd(&dtqcb_ram->rcvque);	/* 略ち乖误黎片からタスク艰り叫し */
		mknl_rmv_que(mtcb);							/* 略ち乖误から猴近 */
		mknl_rmv_tmout(mtcb);						/* タイムアウト豺近 */
		mtcb->data = data;							/* デ〖タを呈羌 */
		mknl_wup_tsk(mtcb, E_OK);					/* タスクの略ち豺近 */
		
		mknl_exe_dsp();		/* タスクディスパッチの悸乖 */
		mknl_exe_tex();		/* 毋嘲借妄の悸乖 */
		
		ercd = E_OK;
	}
	else
	{
		/* 略ちタスクが痰ければデ〖タキュ〖に呈羌 */
		dtqcb_rom = dtqcb_ram->dtqcb_rom;
		if ( dtqcb_ram->datacnt >= dtqcb_rom->dtqcnt )
		{
			/* デ〖タキュ〖が办钦なら */
			if ( tmout == TMO_POL )
			{
				/* ポ〖リングなら篓箕タイムアウト */
				ercd = E_TMOUT;
			}
			else
			{
				/* 流慨略ちに掐る */
				mtcb = mknl_get_run_tsk();		/* 附哼のタスクを艰评 */
				mtcb->data = data;				/* デ〖タ瘦赂 */
				mknl_wai_tsk(mtcb, TTW_SDTQ);	/* 略ち觉轮に肋年 */
				mknl_add_que(&dtqcb_ram->sndque, mtcb, dtqcb_rom->dtqatr);	/* 略ち乖误に纳裁 */
				
				/* 痰嘎略ちでなければ */
				if ( tmout != TMO_FEVR )
				{
					mknl_add_tmout(mtcb, (RELTIM)tmout);	/* タイムアウトキュ〖に纳裁 */
				}
				
				ercd = (ER)mknl_exe_dsp();	/* タスクディスパッチの悸乖 */
				mknl_exe_tex();				/* 毋嘲借妄の悸乖 */
			}
		}
		else
		{
			/* デ〖タキュ〖琐萨にデ〖タを呈羌 */
			tail = dtqcb_ram->head + dtqcb_ram->datacnt;
			if ( tail >= dtqcb_rom->dtqcnt )
			{
				tail -= dtqcb_rom->dtqcnt;
			}
			dtqcb_rom->dtq[tail] = data;
			dtqcb_ram->datacnt++;
			
			ercd = E_OK;
		}
	}

	mknl_unl_sys();	/* システムのロック豺近 */

	return ercd;
}


/* ------------------------------------------------------------------------ */
/*  Copyright (C) 1998-2002 by Project HOS                                  */
/* ------------------------------------------------------------------------ */