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


/* セマフォコントロ〖ルブロック(瓢弄栏喇脱) */
typedef struct t_kernel_semcb
{
	T_KERNEL_SEMCB_RAM semcb_ram;	/* セマフォコントロ〖ルブロック(RAM婶) */
	T_KERNEL_SEMCB_ROM semcb_rom;	/* セマフォコントロ〖ルブロック(ROM婶) */
} T_KERNEL_SEMCB;



/* セマフォの栏喇(カ〖ネル柒婶簇眶) */
ER kernel_cre_sem(
		ID           semid,		/* 栏喇滦据のセマフォのID戎规 */
		const T_CSEM *pk_csem)	/* セマフォ栏喇攫鼠を掐れたパケットへのポインタ */
{
	T_KERNEL_SEMCB     *semcb;
	T_KERNEL_SEMCB_RAM *semcb_ram;
	T_KERNEL_SEMCB_ROM *semcb_rom;

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

	/* セマフォ脱メモリの澄瘦 */
	semcb = (T_KERNEL_SEMCB *)kernel_alc_mem(sizeof(T_KERNEL_SEMCB));
#ifdef HOS_ERCHK_E_NOMEM
	if ( semcb == NULL )
	{
		return E_NOMEM;		/* メモリ稍颅 */
	}
#endif

	/* セマフォの肋年 */
	semcb_ram = &semcb->semcb_ram;
	semcb_rom = &semcb->semcb_rom;
	mknl_ini_que(&semcb_ram->que);
	semcb_ram->semcnt    = pk_csem->isemcnt;
	semcb_ram->semcb_rom = semcb_rom;
	semcb_rom->sematr    = pk_csem->sematr;
	semcb_rom->isemcnt   = pk_csem->isemcnt;
	semcb_rom->maxsem    = pk_csem->maxsem;

	/* 瓷妄テ〖ブルへ纳裁 */
	KERNEL_SEMID_TO_SEMCB_RAM(semid) = semcb_ram;

	return E_OK;
}


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