get_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 get_mpf(
		ID mpfid,		/* メモリブロック惩评滦据の盖年墓メモリプ〖ルのID戎规 */
		VP *p_blk)		/* 惩评したメモリブロックの黎片戎孟 */
{
	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

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

	/* コンテキストチェック */
#ifdef HOS_ERCHK_E_CTX
	if ( 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
	{
		/* 鄂きブロックが痰ければ略ちに掐る */
		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);	/* 略ち乖误に纳裁 */
		
		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                                  */
/* ------------------------------------------------------------------------ */