twai_sem.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_sem.h"



/* セマフォ获富の惩评(タイムアウトあり) */
ER twai_sem(
		ID  semid,	/* 获富惩评滦据のセマフォID戎规 */
		TMO tmout)	/* タイムアウト回年 */
{
	const T_KERNEL_SEMCB_ROM *semcb_rom;
	T_KERNEL_SEMCB_RAM       *semcb_ram;
	T_MKNL_TCB *mtcb;
	ER ercd;

	/* ID のチェック */
#ifdef HOS_ERCHK_E_ID
	if ( semid < KERNEL_TMIN_SEMID || semid > KERNEL_TMAX_SEMID )
	{
		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

	semcb_ram = KERNEL_SEMID_TO_SEMCB_RAM(semid);

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

	if ( semcb_ram->semcnt > 0 )
	{
		/* セマフォ获富が惩评できれば喇根 */
		semcb_ram->semcnt--;	/* セマフォ获富の惩评 */
		ercd = E_OK;
	}
	else
	{
		/* 惩评できなかったなら */
		if ( tmout == TMO_POL )
		{
			/* ポ〖リングなら篓箕タイムアウト */
			ercd = E_TMOUT;
		}
		else
		{
			/* タイムアウト烧きで略ちに掐る */
			semcb_rom = semcb_ram->semcb_rom;
			mtcb = mknl_get_run_tsk();
			mknl_wai_tsk(mtcb, TTW_SEM);
			mknl_add_que(&semcb_ram->que, mtcb, semcb_rom->sematr);	/* 略ち乖误に纳裁 */

			/* 痰嘎略ちでなければタイムアウト肋年 */
			if ( tmout != TMO_FEVR )
			{
				mknl_add_tmout(mtcb, (RELTIM)tmout);	/* タイムアウトキュ〖に纳裁 */
			}
			
			ercd = (ER)mknl_exe_dsp();	/* タスクディスパッチの悸乖 */
			mknl_exe_tex();				/* 毋嘲借妄の悸乖 */
		}
	}

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

	return ercd;
}


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