sig_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 sig_sem(
		ID semid)		/* セマフォ获富手笛滦据のセマフォのID戎规 */
{
	const T_KERNEL_SEMCB_ROM *semcb_rom;
	T_KERNEL_SEMCB_RAM *semcb_ram;
	T_MKNL_TCB *mtcb;
	
	/* ID のチェック */
#ifdef HOS_ERCHK_E_ID
	if ( semid < KERNEL_TMIN_SEMID || semid > KERNEL_TMAX_SEMID )
	{
		return E_ID;
	}
#endif
	
	mknl_loc_sys();	/* システムのロック */
	
	semcb_ram = KERNEL_SEMID_TO_SEMCB_RAM(semid);
	
	/* オブジェクト赂哼チェック */
#ifdef HOS_ERCHK_E_NOEXS
	if ( semcb_ram == NULL )
	{
		mknl_unl_sys();	/* システムのロック豺近 */
		return E_NOEXS;	/* オブジェクト踏栏喇 */
	}
#endif
	
	semcb_rom = semcb_ram->semcb_rom;
	
	/* キュ〖イングオ〖バ〖フロ〖チェック */
#ifdef HOS_ERCHK_E_QOVR
	if ( semcb_ram->semcnt >= semcb_rom->maxsem )
	{
		mknl_unl_sys();	/* システムのロック豺近 */
		return E_QOVR;
	}
#endif
	
	mtcb = mknl_ref_qhd(&semcb_ram->que);	/* 略ち乖误黎片からタスク艰り叫し */
	if ( mtcb != NULL )
	{
		/* 略ちタスクがあれば略ち豺近 */
		mknl_rmv_que(mtcb);						/* セマフォの略ち乖误から猴近 */
		mknl_rmv_tmout(mtcb);					/* タイムアウト略ち乖误から猴近 */
		mknl_wup_tsk(mtcb, E_OK);				/* タスクの略ち豺近 */
		
		mknl_exe_dsp();		/* タスクディスパッチの悸乖 */
		mknl_exe_tex();		/* 毋嘲借妄の悸乖 */
	}
	else
	{
		semcb_ram->semcnt++;	/* セマフォ获富手笛 */
	}

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

	return E_OK;	/* 喇根 */
}


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