tget_mpf.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_mpf.h"



/* 盖年墓メモリブロックの惩评(タイムアウトあり) */
ER tget_mpf(
		ID  mpfid,		/* メモリブロック惩评滦据の盖年墓メモリプ〖ルのID戎规 */
		VP  *p_blk,		/* 惩评したメモリブロックの黎片戎孟 */
		TMO tmout)		/* タイムアウト回年 */
{
	const T_KERNEL_MPFCB_ROM *mpfcb_rom;
	T_KERNEL_MPFCB_RAM       *mpfcb_ram;
	T_MKNL_TCB *mtcb;
	ER ercd;

	/* ID のチェック */
#ifdef HOS_ERCHK_E_ID
	if ( mpfid < KERNEL_TMIN_MPFID || mpfid > KERNEL_TMAX_MPFID )
	{
		return E_ID;	/* 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

	mpfcb_ram = KERNEL_MPFID_TO_MPFCB_RAM(mpfid);

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

	if ( mpfcb_ram->free != NULL )
	{
		/* 鄂きブロックがあれば充り碰てる */
		*p_blk          = mpfcb_ram->free;
		mpfcb_ram->free = *(VP *)mpfcb_ram->free;	/* 肌の鄂きエリアを肋年 */
		ercd = E_OK;
	}
	else
	{
		if ( tmout == TMO_POL )
		{
			/* ポ〖リングなら篓箕タイムアウト */
			ercd = E_TMOUT;
		}
		else
		{
			/* 鄂きブロックが痰ければ略ちに掐る */
			mpfcb_rom = mpfcb_ram->mpfcb_rom;
			mtcb = mknl_get_run_tsk();
			mknl_wai_tsk(mtcb, TTW_MPF);
			mknl_add_que(&mpfcb_ram->que, mtcb, mpfcb_rom->mpfatr);	/* 略ち乖误に纳裁 */
			
			/* 痰嘎略ちでなければタイムアウト肋年 */
			if ( tmout != TMO_FEVR )
			{
				mknl_add_tmout(mtcb, (RELTIM)tmout);	/* タイムアウトキュ〖に纳裁 */
			}
			
			ercd = (ER)mknl_exe_dsp();	/* タスクディスパッチの悸乖 */
			
			if ( ercd == E_OK )
			{
				*p_blk = (VP)mtcb->data;	/* 惩评ブロック黎片戎孟呈羌 */
			}
			
			mknl_exe_tex();		/* 毋嘲借妄の悸乖 */
		}
	}
	
	mknl_unl_sys();		/* システムのロック豺近 */
	
	return ercd;
}


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