snd_mbx.c

Hyper Operating System。基于ITRON接口的实时操作系统。主页： https://sourceforge.jp/projects/hos

/* ------------------------------------------------------------------------ */
/*  Hyper Operating System V4  μITRON4.0慌屯 Real-Time OS                  */
/*    ITRONカ〖ネル メ〖ルボックス                                          */
/*                                                                          */
/*                                  Copyright (C) 1998-2002 by Project HOS  */
/*                                  http://sourceforge.jp/projects/hos/     */
/* ------------------------------------------------------------------------ */


#include "knl_mbx.h"



/* メ〖ルボックスへの流慨 */
ER snd_mbx(
		ID    mbxid,		/* 流慨滦据のメ〖ルボックスのID戎规 */
		T_MSG *pk_msg)		/* メ〖ルボックスへ流慨するメッセ〖ジパケットの黎片戎孟 */
{
	const T_KERNEL_MBXCB_ROM *mbxcb_rom;
	T_KERNEL_MBXCB_RAM       *mbxcb_ram;
	T_MKNL_TCB *mtcb;
	T_MSG      *msg;
	PRI        msgpri;

	/* ID のチェック */
#ifdef HOS_ERCHK_E_ID
	if ( mbxid < KERNEL_TMIN_MBXID || mbxid > KERNEL_TMAX_MBXID )
	{
		return E_ID;
	}
#endif
	
	mknl_loc_sys();	/* システムのロック */

	mbxcb_ram = KERNEL_MBXID_TO_MBXCB_RAM(mbxid);

	/* オブジェクト赂哼チェック */
#ifdef HOS_ERCHK_E_NOEXS
	if ( mbxcb_ram == NULL )
	{
		mknl_unl_sys();		/* システムのロック豺近 */
		return E_NOEXS;
	}
#endif

	mbxcb_rom = mbxcb_ram->mbxcb_rom;

	/* メッセ〖ジ庭黎刨艰评 */
	if ( mbxcb_rom->mbxatr & TA_MPRI )	/* 庭黎刨界なら */
	{
		msgpri = (PRI)(((T_MSG_PRI*)pk_msg)->msgpri - TMIN_MPRI);

		/* 庭黎刨チェック */
#ifdef HOS_ERCHK_E_PAR
		if ( msgpri < 0	|| msgpri > mbxcb_rom->maxmpri - TMIN_MPRI )
		{
			mknl_unl_sys();		/* システムのロック豺近 */
			return E_PAR;
		}
#endif
	}
	else	/* 庭黎刨なし(FIFO界)なら */
	{
		msgpri = 0;
	}

	mtcb = mknl_ref_qhd(&mbxcb_ram->que);		/* 略ち乖误黎片タスクを艰评 */
	if ( mtcb != NULL )
	{
		/* 略ちタスクがあれば倡庶 */
		mtcb->data = (VP_INT)pk_msg;			/* メッセ〖ジを畔す */
		mknl_rmv_que(mtcb);						/* メ〖ルボックスの略ち乖误から猴近 */
		mknl_rmv_tmout(mtcb);					/* タイムアウト略ち乖误から猴近 */
		mknl_wup_tsk(mtcb, E_OK);				/* タスクの略ち豺近 */
		
		mknl_exe_dsp();		/* タスクディスパッチの悸乖 */
		mknl_exe_tex();		/* 毋嘲借妄の悸乖 */
	}
	else
	{
		/* 略ちタスクがなければメ〖ルボックスに儡鲁 */
		if ( mbxcb_rom->mprihd[msgpri] == NULL )
		{
			/* 呵介の１改の判峡 */
			mbxcb_rom->mprihd[msgpri] = pk_msg;
			pk_msg->next              = pk_msg;
		}
		else
		{
			/* 琐萨に纳裁 */
			msg                       = mbxcb_rom->mprihd[msgpri];
			pk_msg->next              = msg->next;
			msg->next                 = pk_msg;
			mbxcb_rom->mprihd[msgpri] = pk_msg;
		}
	}

	mknl_unl_sys();	/* システムのロック豺近 */

	return E_OK;	/* 喇根 */
}


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