get_mpl.c

iTRON4.0最新操作系统

/* ------------------------------------------------------------------------ */
/*  Hyper Operating System V4  μITRON4.0慌屯 Real-Time OS                  */
/*    ITRONカ〖ネル 材恃墓メモリプ〖ル                                      */
/*                                                                          */
/*                                  Copyright (C) 1998-2006 by Project HOS  */
/*                                  http://sourceforge.jp/projects/hos/     */
/* ------------------------------------------------------------------------ */


#include "knl_mpl.h"



/* 材恃墓メモリブロックの惩评 */
ER get_mpl(
		ID   mplid,		/* メモリブロック惩评滦据の材恃墓メモリプ〖ルのID戎规 */
		UINT blksz,		/* 惩评するメモリブロックのサイズ(バイト眶) */
		VP   *p_blk)	/* 惩评したメモリブロックの黎片戎孟 */
{
	const T_KERNEL_MPLCB_ROM *mplcb_rom;
	T_KERNEL_MPLCB_RAM       *mplcb_ram;
	T_MKNL_TCB               *mtcb;
	T_KERNEL_MPLINF          mplinf;
	VP mem;
	ER ercd;

	/* ID のチェック */
#ifdef HOS_ERCHK_E_ID
	if ( mplid < KERNEL_TMIN_MPLID || mplid > KERNEL_TMAX_MPLID )
	{
		return E_ID;	/* ID稍赖 */
	}
#endif

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

	/* コンテキストチェック */
#ifdef HOS_ERCHK_E_CTX
	if ( mknl_sns_wai() )
	{
		mknl_unl_sys();	/* システムのロック豺近 */
		return E_CTX;	/* コンテキスト稍赖 */
	}
#endif

	mplcb_ram = KERNEL_MPLID_TO_MPLCB_RAM(mplid);

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

	/* メモリ澄瘦にトライ */
	mem = kernel_alc_hep(&mplcb_ram->hep, blksz);

	if ( mem != NULL )
	{
		/* 充り碰て喇根 */
		*p_blk          = mem;
		ercd = E_OK;
	}
	else
	{
		/* 鄂きが痰ければ略ちに掐る */
		mplcb_rom = mplcb_ram->mplcb_rom;
		mtcb = mknl_get_run_tsk();
		mplinf.blksz = blksz;
		mplinf.p_blk = p_blk;
		mtcb->data = (VP_INT)&mplinf;
		mknl_wai_tsk(mtcb, TTW_MPL);
		mknl_add_que(&mplcb_ram->que, mtcb, mplcb_rom->mplatr);	/* 略ち乖误に纳裁 */
		
		ercd = (ER)mknl_exe_dsp();		/* タスクディスパッチの悸乖 */
				
		mknl_exe_tex();		/* 毋嘲借妄の悸乖 */
	}
	
	mknl_unl_sys();		/* システムのロック豺近 */
	
	return ercd;
}


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