kcre_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"
#include "knl_mem.h"


/* 盖年墓メモリプ〖ル コントロ〖ルブロック(瓢弄栏喇脱) */
typedef struct t_kernel_mpfcb
{
	T_KERNEL_MPFCB_RAM mpfcb_ram;	/* 盖年墓メモリプ〖ル コントロ〖ルブロック(RAM婶) */
	T_KERNEL_MPFCB_ROM mpfcb_rom;	/* 盖年墓メモリプ〖ル コントロ〖ルブロック(ROM婶) */
} T_KERNEL_MPFCB;



/* 盖年墓メモリプ〖ルの栏喇(カ〖ネル柒婶簇眶) */
ER kernel_cre_mpf(
		ID           mpfid,		/* 栏喇滦据の盖年墓メモリプ〖ルのID戎规 */
		const T_CMPF *pk_cmpf)	/* 盖年墓メモリプ〖ル栏喇攫鼠を掐れたパケットへのポインタ */
{
	T_KERNEL_MPFCB     *mpfcb;
	T_KERNEL_MPFCB_RAM *mpfcb_ram;
	T_KERNEL_MPFCB_ROM *mpfcb_rom;
	VP   mpf;
	UB   *ptr;
	UINT i;

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

	/* 盖年墓メモリプ〖ル脱メモリの澄瘦 */
	mpfcb = (T_KERNEL_MPFCB *)kernel_alc_mem(sizeof(T_KERNEL_MPFCB));
	if ( mpfcb == NULL )
	{
		return E_NOMEM;		/* メモリ稍颅 */
	}
	
	/* メモリプ〖ル脱メモリ澄瘦 */
	if ( pk_cmpf->mpf == NULL )
	{
		mpf = kernel_alc_mem((SIZE)(pk_cmpf->blksz * pk_cmpf->blkcnt));
		if ( mpf == NULL )
		{
			kernel_fre_mem(mpfcb);
			return E_NOMEM;		/* メモリ稍颅 */
		}
	}
	else
	{
		mpf = pk_cmpf->mpf;
	}

	/* 盖年墓メモリプ〖ルの肋年 */
	mpfcb_ram = &mpfcb->mpfcb_ram;
	mpfcb_rom = &mpfcb->mpfcb_rom;
	mknl_ini_que(&mpfcb_ram->que);
	mpfcb_ram->free      = mpf;
	mpfcb_ram->mpfcb_rom = mpfcb_rom;
	mpfcb_rom->mpfatr    = pk_cmpf->mpfatr;
	mpfcb_rom->blkcnt    = pk_cmpf->blkcnt;
	mpfcb_rom->blksz     = pk_cmpf->blksz;
	mpfcb_rom->mpf       = pk_cmpf->mpf;

	/* ブロックの介袋步 */
	ptr = (UB *)mpfcb_rom->mpf;
	for ( i = 0; i < mpfcb_rom->blkcnt - 1; i++ )
	{
		*(VP *)ptr = (VP)(ptr + mpfcb_rom->blksz);
		ptr += mpfcb_rom->blksz;
	}
	*(VP *)ptr = NULL;	/* 呵姜ブロック */

	/* 瓷妄テ〖ブルへ纳裁 */
	KERNEL_MPFID_TO_MPFCB_RAM(mpfid) = mpfcb_ram;

	return E_OK;
}


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