kcre_mpf.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_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;

/* 盖年墓メモリプ〖ル コントロ〖ルブロック(瓢弄栏喇、カ〖ネルメモリ脱) */
typedef struct t_kernel_mpfcb_with_blk
{
	T_KERNEL_MPFCB_RAM mpfcb_ram;	/* 盖年墓メモリプ〖ル コントロ〖ルブロック(RAM婶) */
	T_KERNEL_MPFCB_ROM mpfcb_rom;	/* 盖年墓メモリプ〖ル コントロ〖ルブロック(ROM婶) */
	VP	blk[1];			/* メモリブロックダミ〖 */
} T_KERNEL_MPFCB_WBLK;



/* 盖年墓メモリプ〖ルの栏喇(カ〖ネル柒婶簇眶) */
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;
	UINT i;

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

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

	/* 盖年墓メモリプ〖ル脱メモリの澄瘦 */
	mpfcb = (T_KERNEL_MPFCB *)kernel_alc_mem(
		pk_cmpf->mpf != NULL ? 	sizeof(T_KERNEL_MPFCB) :
		sizeof(T_KERNEL_MPFCB_WBLK) - sizeof(VP)
		+ TSZ_MPF( pk_cmpf->blkcnt, pk_cmpf->blksz ) 
		);
	if ( mpfcb == NULL )
	{
		return E_NOMEM;		/* メモリ稍颅 */
	}
	
	/* メモリプ〖ル黎片戎孟セット */
	if ( pk_cmpf->mpf == NULL )
	{
		mpf = ((T_KERNEL_MPFCB_WBLK *)mpfcb)->blk;
	}
	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     = TSZ_ALIGNED(pk_cmpf->blksz);

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

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

	return E_OK;
}


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