cyclic.c

嵌入式系统开发 TOPPERS and JSP Kernel Release 1.3 TOPPERS = Toyohashi Open Platform for Embedded Real-Tim

/*
 *  TOPPERS/JSP Kernel
 *      Toyohashi Open Platform for Embedded Real-Time Systems/
 *      Just Standard Profile Kernel
 * 
 *  Copyright (C) 2000,2001 by Embedded and Real-Time Systems Laboratory
 *                              Toyohashi Univ. of Technology, JAPAN
 * 
 *  惧淡螟侯涪荚は·Free Software Foundation によって给山されている 
 *  GNU General Public License の Version 2 に淡揭されている掘凤か·笆
 *  布の(1)×(4)の掘凤を塔たす眷圭に嘎り·塑ソフトウェア∈塑ソフトウェ
 *  アを猖恃したものを崔むˉ笆布票じ∷を蝗脱ˇ剩澜ˇ猖恃ˇ浩芹邵∈笆布·
 *  网脱と钙ぶ∷することを痰浸で钓满するˉ
 *  (1) 塑ソフトウェアをソ〖スコ〖ドの妨で网脱する眷圭には·惧淡の螟侯
 *      涪山绩·この网脱掘凤および布淡の痰瘦沮惮年が·そのままの妨でソ〖
 *      スコ〖ド面に崔まれていることˉ
 *  (2) 塑ソフトウェアを浩网脱材墙なバイナリコ〖ド∈リロケ〖タブルオブ
 *      ジェクトファイルやライブラリなど∷の妨で网脱する眷圭には·网脱
 *      に燃うドキュメント∈网脱荚マニュアルなど∷に·惧淡の螟侯涪山绩·
 *      この网脱掘凤および布淡の痰瘦沮惮年を非很することˉ
 *  (3) 塑ソフトウェアを浩网脱稍材墙なバイナリコ〖ドの妨または怠达に寥
 *      み哈んだ妨で网脱する眷圭には·肌のいずれかの掘凤を塔たすことˉ
 *    (a) 网脱に燃うドキュメント∈网脱荚マニュアルなど∷に·惧淡の螟侯
 *        涪山绩·この网脱掘凤および布淡の痰瘦沮惮年を非很することˉ
 *    (b) 网脱の妨轮を·侍に年める数恕によって·惧淡螟侯涪荚に鼠桂する
 *        ことˉ
 *  (4) 塑ソフトウェアの网脱により木儡弄または粗儡弄に栏じるいかなる禄
 *      巢からも·惧淡螟侯涪荚を倘勒することˉ
 * 
 *  塑ソフトウェアは·痰瘦沮で捏丁されているものであるˉ惧淡螟侯涪荚は·
 *  塑ソフトウェアに簇して·その努脱材墙拉も崔めて·いかなる瘦沮も乖わ
 *  ないˉまた·塑ソフトウェアの网脱により木儡弄または粗儡弄に栏じたい
 *  かなる禄巢に簇しても·その勒扦を砷わないˉ
 * 
 *  @(#) $Id: cyclic.c,v 1.7 2002/03/26 08:19:38 hiro Exp $
 */

/*
 *	件袋ハンドラ怠墙
 */

#include "jsp_kernel.h"
#include "check.h"
#include "cyclic.h"

/*
 *  件袋ハンドラIDの呵络猛∈kernel_cfg.c∷
 */
extern const ID	tmax_cycid;

/*
 *  件袋ハンドラ介袋步ブロックのエリア∈kernel_cfg.c∷
 */
extern const CYCINIB	cycinib_table[];

/*
 *  件袋ハンドラ瓷妄ブロックのエリア∈kernel_cfg.c∷
 */
extern CYCCB	cyccb_table[];

/*
 *  件袋ハンドラIDから件袋ハンドラ瓷妄ブロックを艰り叫すためのマクロ
 */
#define INDEX_CYC(cycid)	((cycid) - TMIN_CYCID)
#define get_cyccb(cycid)	(&(cyccb_table[INDEX_CYC(cycid)]))

/*
 *  件袋ハンドラ弹瓢ル〖チン∈涟数徊救のための年盗∷
 */
static void	call_cychdr(CYCCB *cyccb);

/*
 *  件袋ハンドラ弹瓢のためのタイムイベントブロックの判峡
 */
static void
tmevtb_enqueue_cyc(CYCCB *cyccb, EVTTIM evttim)
{
	tmevtb_enqueue_evttim(&(cyccb->tmevtb), evttim,
				(CBACK) call_cychdr, (VP) cyccb);
	cyccb->evttim = evttim;
}

/*
 *  件袋ハンドラ怠墙の介袋步
 */
void
cyclic_initialize()
{
	INT	i;
	CYCCB	*cyccb;

	for (cyccb = cyccb_table, i = 0; i < tmax_cycid; cyccb++, i++) {
		cyccb->cycinib = &(cycinib_table[i]);
		if ((cyccb->cycinib->cycatr & TA_STA) != 0) {
			cyccb->cycsta = TRUE;
			tmevtb_enqueue_cyc(cyccb, cyccb->cycinib->cycphs);
		}
		else {
			cyccb->cycsta = FALSE;
		}
	}
}

/*
 *  件袋ハンドラの瓢侯倡幌
 */
SYSCALL ER
sta_cyc(ID cycid)
{
	CYCCB	*cyccb;

	CHECK_TSKCTX_UNL();
	CHECK_CYCID(cycid);
	cyccb = get_cyccb(cycid);

	t_lock_cpu();
	if (cyccb->cycsta) {
		tmevtb_dequeue(&(cyccb->tmevtb));
	}
	else {
		cyccb->cycsta = TRUE;
	}
	tmevtb_enqueue_cyc(cyccb, base_time + cyccb->cycinib->cyctim);
	t_unlock_cpu();
	return(E_OK);
}

/*
 *  件袋ハンドラの瓢侯匿贿
 */
SYSCALL ER
stp_cyc(ID cycid)
{
	CYCCB	*cyccb;

	CHECK_TSKCTX_UNL();
	CHECK_CYCID(cycid);
	cyccb = get_cyccb(cycid);

	t_lock_cpu();
	if (cyccb->cycsta) {
		cyccb->cycsta = FALSE;
		tmevtb_dequeue(&(cyccb->tmevtb));
	}
	t_unlock_cpu();
	return(E_OK);
}

/*
 *  件袋ハンドラ弹瓢ル〖チン
 */
static void
call_cychdr(CYCCB *cyccb)
{
	/*
	 *  肌搀の弹瓢のためのタイムイベントブロックを判峡するˉ
	 *
	 *  票じタイムティックで件袋ハンドラを浩刨弹瓢すべき眷圭には·
	 *  この簇眶から isig_tim に提った稿に·浩刨この簇眶が钙ばれる
	 *  ことになるˉ
	 */
	tmevtb_enqueue_cyc(cyccb, cyccb->evttim + cyccb->cycinib->cyctim);

	/*
	 *  件袋ハンドラを·CPUロック豺近觉轮で钙び叫すˉ
	 */
	i_unlock_cpu();
	(*cyccb->cycinib->cychdr)(cyccb->cycinib->exinf);
	i_lock_cpu();
}