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

/* デ〖タキュ〖コントロ〖ルブロック(瓢弄栏喇、カ〖ネルメモリ脱) */
typedef struct t_kernel_dtqcb_with_blk
{
	T_KERNEL_DTQCB_RAM dtqcb_ram;	/* デ〖タキュ〖コントロ〖ルブロック(RAM婶) */
	T_KERNEL_DTQCB_ROM dtqcb_rom;	/* デ〖タキュ〖コントロ〖ルブロック(ROM婶) */
	VP_INT	blk[1];			/* ダミ〖デ〖タブロック */
} T_KERNEL_DTQCB_WBLK;



/* デ〖タキュ〖の栏喇(カ〖ネル柒婶簇眶) */
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;

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

	/* デ〖タキュ〖脱メモリの澄瘦 */
	dtqcb = (T_KERNEL_DTQCB *)kernel_alc_mem(
		pk_cdtq->dtq != NULL ?
			sizeof(T_KERNEL_DTQCB) :
			sizeof(T_KERNEL_DTQCB_WBLK) - sizeof(VP_INT)
			+ ( sizeof(VP_INT *) * pk_cdtq->dtqcnt )
		);
	if ( dtqcb == NULL )
	{
		return E_NOMEM;		/* メモリ稍颅 */
	}
	
	/* デ〖タキュ〖の肋年 */
	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 =  pk_cdtq->dtq != NULL ?
	    (VP_INT *)pk_cdtq->dtq : ((T_KERNEL_DTQCB_WBLK *)dtqcb)->blk;
	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-2003 by Project HOS                                  */
/* ------------------------------------------------------------------------ */