ref_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"
#include "knl_sys.h"



/* セマフォの觉轮徊救 */
ER ref_sem(
		ID     semid,		/* 觉轮徊救滦据のセマフォのID戎规 */
		T_RSEM *pk_rsem)	/* セマフォ觉轮を手すパケットへのポインタ */
{
	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

	/* パラメ〖タのチェック */
#ifdef HOS_ERCHK_E_PAR
	if ( pk_rsem == NULL )
	{
		return E_PAR;	/* パラメ〖タエラ〖 */
	}
#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

	/* セマフォの略ち乖误の黎片のタスクのID戎规艰评 */
	mtcb = mknl_ref_qhd(&semcb_ram->que);	/* 略ち乖误黎片からタスク艰り叫し */
	if ( mtcb == NULL )
	{
		pk_rsem->wtskid = TSK_NONE;		/* 略ちタスクなし */
	}
	else
	{
		/* タスクIDを浮瑚 */
		pk_rsem->wtskid = kernel_get_tid(KERNEL_STATIC_CAST(T_KERNEL_TCB_RAM, mtcb, mtcb));
	}
	
	/* セマフォの附哼の获富眶艰评 */
	pk_rsem->semcnt = semcb_ram->semcnt;

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

	return E_OK;	/* 喇根 */
}


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