kcre_mpl.c

iTRON4.0最新操作系统

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


#include "knl_mpl.h"
#include "knl_mem.h"


/* 材恃墓メモリプ〖ル コントロ〖ルブロック(瓢弄栏喇脱) */
typedef struct t_kernel_mplcb
{
	T_KERNEL_MPLCB_RAM mplcb_ram;	/* 材恃墓メモリプ〖ル コントロ〖ルブロック(RAM婶) */
	T_KERNEL_MPLCB_ROM mplcb_rom;	/* 材恃墓メモリプ〖ル コントロ〖ルブロック(ROM婶) */
} T_KERNEL_MPLCB;

/* 材恃墓メモリプ〖ル コントロ〖ルブロック(瓢弄栏喇、カ〖ネルメモリ脱) */
typedef struct t_kernel_mplcb_with_blk
{
	T_KERNEL_MPLCB_RAM mplcb_ram;	/* 材恃墓メモリプ〖ル コントロ〖ルブロック(RAM婶) */
	T_KERNEL_MPLCB_ROM mplcb_rom;	/* 材恃墓メモリプ〖ル コントロ〖ルブロック(ROM婶) */
	VP	blk[1];			/* メモリブロックダミ〖 */
} T_KERNEL_MPLCB_WBLK;



/* 材恃墓メモリプ〖ルの栏喇(カ〖ネル柒婶簇眶) */
ER kernel_cre_mpl(
		ID           mplid,		/* 栏喇滦据の材恃墓メモリプ〖ルのID戎规 */
		const T_CMPL *pk_cmpl)	/* 材恃墓メモリプ〖ル栏喇攫鼠を掐れたパケットへのポインタ */
{
	T_KERNEL_MPLCB     *mplcb;
	T_KERNEL_MPLCB_RAM *mplcb_ram;
	T_KERNEL_MPLCB_ROM *mplcb_rom;
	VP   mpl;

	/* パラメ〖タ〖チェック */
#ifdef HOS_ERCHK_E_RSATR
	if ( pk_cmpl->mplatr & ~(TA_TFIFO | TA_TPRI) )
	{
		return E_RSATR;
	}
#endif

	/* パラメ〖タチェック */
#ifdef HOS_ERCHK_E_PAR
	if ( pk_cmpl->mplsz == 0 )
	{
		return E_PAR;   /* パラメ〖タ稍赖 */
	}
#endif

	/* 材恃墓メモリプ〖ル脱メモリの澄瘦 */
	mplcb = (T_KERNEL_MPLCB *)kernel_alc_mem(
		pk_cmpl->mpl != NULL ? 	sizeof(T_KERNEL_MPLCB) :
		sizeof(T_KERNEL_MPLCB_WBLK) - sizeof(VP)
		+ pk_cmpl->mplsz 
		);
	if ( mplcb == NULL )
	{
		return E_NOMEM;		/* メモリ稍颅 */
	}
	
	/* メモリプ〖ル黎片戎孟セット */
	if ( pk_cmpl->mpl == NULL )
	{
		mpl = ((T_KERNEL_MPLCB_WBLK *)mplcb)->blk;
	}
	else
	{
		mpl = pk_cmpl->mpl;
	}

	/* 材恃墓メモリプ〖ルの肋年 */
	mplcb_ram = &mplcb->mplcb_ram;
	mplcb_rom = &mplcb->mplcb_rom;
	mknl_ini_que(&mplcb_ram->que);
	mplcb_ram->mplcb_rom = mplcb_rom;
	mplcb_rom->mplatr    = pk_cmpl->mplatr;
	mplcb_rom->mplsz     = pk_cmpl->mplsz;
	mplcb_rom->mpl       = pk_cmpl->mpl;

	/* ヒ〖プ栏喇 */
	kernel_cre_hep(&mplcb_ram->hep, mplcb_rom->mpl, mplcb_rom->mplsz);

	/* 瓷妄テ〖ブルへ纳裁 */
	KERNEL_MPLID_TO_MPLCB_RAM(mplid) = mplcb_ram;

	return E_OK;
}


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