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




/* デ〖タキュ〖コントロ〖ルブロック(瓢弄栏喇脱) */
typedef struct t_kernel_dtqcb
{
	T_KERNEL_DTQCB_RAM dtqcb_ram;	/* デ〖タキュ〖コントロ〖ルブロック(RAM婶) */
	T_KERNEL_DTQCB_ROM dtqcb_rom;	/* デ〖タキュ〖コントロ〖ルブロック(ROM婶) */
} T_KERNEL_DTQCB;



/* デ〖タキュ〖の栏喇(カ〖ネル柒婶簇眶) */
ER kernel_cre_dtq(
		ID           dtqid,		/* 栏喇滦据のデ〖タキュ〖のID戎规 */
		const T_CDTQ *pk_cdtq)	/* デ〖タキュ〖栏喇攫鼠を掐れたパケットへのポインタ */
{
	T_KERNEL_DTQCB     *dtqcb;
	T_KERNEL_DTQCB_RAM *dtqcb_ram;
	T_KERNEL_DTQCB_ROM *dtqcb_rom;
	VP_INT *dtq;

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

	/* デ〖タキュ〖脱メモリの澄瘦 */
	dtqcb = (T_KERNEL_DTQCB *)kernel_alc_mem(sizeof(T_KERNEL_DTQCB));
	if ( dtqcb == NULL )
	{
		return E_NOMEM;		/* メモリ稍颅 */
	}
	
	/* キュ〖メモリ澄瘦 */
	if ( pk_cdtq->dtq == NULL )
	{
		dtq = (VP_INT *)kernel_alc_mem((SIZE)(sizeof(VP_INT *) * pk_cdtq->dtqcnt));
		if ( dtq == NULL )
		{
			kernel_fre_mem(dtqcb);
			return E_NOMEM;			/* メモリ稍颅 */
		}
	}
	else
	{
		dtq = (VP_INT *)pk_cdtq->dtq;
	}

	/* デ〖タキュ〖の肋年 */
	dtqcb_ram = &dtqcb->dtqcb_ram;
	dtqcb_rom = &dtqcb->dtqcb_rom;
	dtqcb_rom->dtqatr = pk_cdtq->dtqatr;
	dtqcb_rom->dtqcnt = pk_cdtq->dtqcnt;
	dtqcb_rom->dtq    = dtq;
	mknl_ini_que(&dtqcb_ram->sndque);
	mknl_ini_que(&dtqcb_ram->rcvque);
	dtqcb_ram->head      = 0;
	dtqcb_ram->datacnt   = 0;
	dtqcb_ram->dtqcb_rom = dtqcb_rom;

	/* 瓷妄テ〖ブルへ纳裁 */
	KERNEL_DTQID_TO_DTQCB_RAM(dtqid) = dtqcb_ram;

	return E_OK;
}


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