time_event.c

基于ADI BLACKFIN的jbig压缩和解压缩程序

/*
 *  TOPPERS/JSP Kernel
 *      Toyohashi Open Platform for Embedded Real-Time Systems/
 *      Just Standard Profile Kernel
 * 
 *  Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
 *                              Toyohashi Univ. of Technology, JAPAN
 * 
 *  忋婰挊嶌尃幰偼丆埲壓偺 (1)乣(4) 偺忦審偐丆Free Software Foundation 
 *  偵傛偭偰岞昞偝傟偰偄傞 GNU General Public License 偺 Version 2 偵婰
 *  弎偝傟偰偄傞忦審傪枮偨偡応崌偵尷傝丆杮僜僼僩僂僃傾乮杮僜僼僩僂僃傾
 *  傪夵曄偟偨傕偺傪娷傓丏埲壓摨偠乯傪巊梡丒暋惢丒夵曄丒嵞攝晍乮埲壓丆
 *  棙梡偲屇傇乯偡傞偙偲傪柍彏偱嫋戻偡傞丏
 *  (1) 杮僜僼僩僂僃傾傪僜乕僗僐乕僪偺宍偱棙梡偡傞応崌偵偼丆忋婰偺挊嶌
 *      尃昞帵丆偙偺棙梡忦審偍傛傃壓婰偺柍曐徹婯掕偑丆偦偺傑傑偺宍偱僜乕
 *      僗僐乕僪拞偵娷傑傟偰偄傞偙偲丏
 *  (2) 杮僜僼僩僂僃傾傪丆儔僀僽儔儕宍幃側偳丆懠偺僜僼僩僂僃傾奐敪偵巊
 *      梡偱偒傞宍偱嵞攝晍偡傞応崌偵偼丆嵞攝晍偵敽偆僪僉儏儊儞僩乮棙梡
 *      幰儅僯儏傾儖側偳乯偵丆忋婰偺挊嶌尃昞帵丆偙偺棙梡忦審偍傛傃壓婰
 *      偺柍曐徹婯掕傪宖嵹偡傞偙偲丏
 *  (3) 杮僜僼僩僂僃傾傪丆婡婍偵慻傒崬傓側偳丆懠偺僜僼僩僂僃傾奐敪偵巊
 *      梡偱偒側偄宍偱嵞攝晍偡傞応崌偵偼丆師偺偄偢傟偐偺忦審傪枮偨偡偙
 *      偲丏
 *    (a) 嵞攝晍偵敽偆僪僉儏儊儞僩乮棙梡幰儅僯儏傾儖側偳乯偵丆忋婰偺挊
 *        嶌尃昞帵丆偙偺棙梡忦審偍傛傃壓婰偺柍曐徹婯掕傪宖嵹偡傞偙偲丏
 *    (b) 嵞攝晍偺宍懺傪丆暿偵掕傔傞曽朄偵傛偭偰丆TOPPERS僾儘僕僃僋僩偵
 *        曬崘偡傞偙偲丏
 *  (4) 杮僜僼僩僂僃傾偺棙梡偵傛傝捈愙揑傑偨偼娫愙揑偵惗偠傞偄偐側傞懝
 *      奞偐傜傕丆忋婰挊嶌尃幰偍傛傃TOPPERS僾儘僕僃僋僩傪柶愑偡傞偙偲丏
 * 
 *  杮僜僼僩僂僃傾偼丆柍曐徹偱採嫙偝傟偰偄傞傕偺偱偁傞丏忋婰挊嶌尃幰偍
 *  傛傃TOPPERS僾儘僕僃僋僩偼丆杮僜僼僩僂僃傾偵娭偟偰丆偦偺揔梡壜擻惈傕
 *  娷傔偰丆偄偐側傞曐徹傕峴傢側偄丏傑偨丆杮僜僼僩僂僃傾偺棙梡偵傛傝捈
 *  愙揑傑偨偼娫愙揑偵惗偠偨偄偐側傞懝奞偵娭偟偰傕丆偦偺愑擟傪晧傢側偄丏
 * 
 *  @(#) $Id: time_event.c,v 1.7 2003/06/04 01:46:16 hiro Exp $
 */

/*
 *	僞僀儉僀儀儞僩娗棟儌僕儏乕儖
 */

#include "jsp_kernel.h"
#include "check.h"
#include "time_event.h"

/*
 *  僞僀儉僀儀儞僩僸乕僾憖嶌儅僋儘
 */
#define	PARENT(index)	((index) >> 1)		/* 恊僲乕僪傪媮傔傞 */
#define	LCHILD(index)	((index) << 1)		/* 塃偺巕僲乕僪傪媮傔傞 */
#define	TMEVT_NODE(index)	(tmevt_heap[(index) - 1])

/*
 *  僀儀儞僩敪惗帪崗斾妑儅僋儘
 *
 *  僀儀儞僩敪惗帪崗偼丆current_time 偐傜偺憡懳抣偱斾妑偡傞丏偡側傢偪丆
 *  current_time 傪嵟彫抣乮嵟傕嬤偄帪崗乯丆current_time - 1 偑嵟戝抣
 *  乮嵟傕墦偄帪崗乯偲傒側偟偰斾妑偡傞丏
 */
#define	EVTTIM_LT(t1, t2) (((t1) - current_time) < ((t2) - current_time))
#define	EVTTIM_LE(t1, t2) (((t1) - current_time) <= ((t2) - current_time))

#ifdef __tmeini

/*
 *  僔僗僥儉帪崗偺僆僼僙僢僩
 */
SYSTIM	systim_offset;

/*
 *  尰嵼偺僔僗僥儉帪崗乮扨埵: 儈儕昩乯
 *
 *  尩枾偵偼丆慜偺僞僀儉僥傿僢僋偺僔僗僥儉帪崗丏
 */
SYSTIM	current_time;

/*
 *  師偺僞僀儉僥傿僢僋偺僔僗僥儉帪崗乮扨埵: 1儈儕昩乯
 */
SYSTIM	next_time;

/*
 *  僔僗僥儉帪崗愊嶼梡曄悢乮扨埵: 1/TIM_DENO儈儕昩乯
 */
#if TIC_DENO != 1
UINT	next_subtime;
#endif /* TIC_DENO != 1 */

/*
 *  僞僀儉僀儀儞僩僸乕僾偺嵟屻偺巊梡椞堟偺僀儞僨僢僋僗
 */
UINT	last_index;

/*
 *  僞僀儅儌僕儏乕儖偺弶婜壔
 */
void
tmevt_initialize()
{
	systim_offset = 0;
	current_time = 0;
#if TIC_DENO == 1
	next_time = current_time + TIC_NUME;
#else /* TIC_DENO == 1 */
	next_subtime += TIC_NUME;
	next_time = current_time + next_subtime / TIC_DENO;
	next_subtime %= TIC_DENO;
#endif /* TIC_DENO == 1 */
	last_index = 0;
}

#endif /* __tmeini */

/*
 *  僞僀儉僀儀儞僩偺憓擖埵抲傪忋岦偒偵扵嶕
 *
 *  帪崗 time 偵敪惗偡傞僞僀儉僀儀儞僩傪憓擖偡傞僲乕僪傪嬻偗傞偨傔偵丆
 *  僸乕僾偺忋偵岦偐偭偰嬻僲乕僪傪堏摦偝偣傞丏堏摦慜偺嬻僲乕僪偺埵抲傪 
 *  index 偵搉偡偲丆堏摦屻偺嬻僲乕僪偺埵抲乮偡側傢偪憓擖埵抲乯傪曉偡丏
 */
#ifdef __tmeup

UINT
tmevt_up(UINT index, EVTTIM time)
{
	UINT	parent;

	while (index > 1) {
		/*
		 *  恊僲乕僪偺僀儀儞僩敪惗帪崗偺曽偑憗偄乮傑偨偼摨偠乯
		 *  側傜偽丆index 偑憓擖埵抲側偺偱儖乕僾傪敳偗傞丏
		 */
		parent = PARENT(index);
		if (EVTTIM_LE(TMEVT_NODE(parent).time, time)) {
			break;
		}

		/*
		 *  恊僲乕僪傪 index 偺埵抲偵堏摦偝偣傞丏
		 */
		TMEVT_NODE(index) = TMEVT_NODE(parent);
		TMEVT_NODE(index).tmevtb->index = index;

		/*
		 *  index 傪恊僲乕僪偺埵抲偵峏怴丏
		 */
		index = parent;
	}
	return(index);
}

#endif /* __tmeup */

/*
 *  僞僀儉僀儀儞僩偺憓擖埵抲傪壓岦偒偵扵嶕
 *
 *  帪崗 time 偵敪惗偡傞僞僀儉僀儀儞僩傪憓擖偡傞僲乕僪傪嬻偗傞偨傔偵丆
 *  僸乕僾偺壓偵岦偐偭偰嬻僲乕僪傪堏摦偝偣傞丏堏摦慜偺嬻僲乕僪偺埵抲傪 
 *  index 偵搉偡偲丆堏摦屻偺嬻僲乕僪偺埵抲乮偡側傢偪憓擖埵抲乯傪曉偡丏
 */
#ifdef __tmedown

UINT
tmevt_down(UINT index, EVTTIM time)
{
	UINT	child;

	while ((child = LCHILD(index)) <= last_index) {
		/*
		 *  嵍塃偺巕僲乕僪偺僀儀儞僩敪惗帪崗傪斾妑偟丆憗偄曽偺
		 *  巕僲乕僪偺埵抲傪 child 偵愝掕偡傞丏埲壓偺巕僲乕僪
		 *  偼丆偙偙偱慖偽傟偨曽偺巕僲乕僪偺偙偲丏
		 */
		if (child + 1 <= last_index
			&& EVTTIM_LT(TMEVT_NODE(child + 1).time,
				  TMEVT_NODE(child).time)) {
			child = child + 1;
		}

		/*
		 *  巕僲乕僪偺僀儀儞僩敪惗帪崗偺曽偑抶偄乮傑偨偼摨偠乯
		 *  側傜偽丆index 偑憓擖埵抲側偺偱儖乕僾傪敳偗傞丏
		 */
		if (EVTTIM_LE(time, TMEVT_NODE(child).time)) {
			break;
		}

		/*
		 *  巕僲乕僪傪 index 偺埵抲偵堏摦偝偣傞丏
		 */
		TMEVT_NODE(index) = TMEVT_NODE(child);
		TMEVT_NODE(index).tmevtb->index = index;

		/*
		 *  index 傪巕僲乕僪偺埵抲偵峏怴丏
		 */
		index = child;
	}
	return(index);
}

#endif /* __tmedown */

/*
 * 僞僀儉僀儀儞僩僸乕僾傊偺搊榐
 *
 *  僞僀儉僀儀儞僩僽儘僢僋 tmevtb 傪丆time 偱巜掕偟偨帪娫偑宱夁屻偵僀
 *  儀儞僩偑敪惗偡傞傛偆偵丆僞僀儉僀儀儞僩僸乕僾偵搊榐偡傞丏
 */
#ifdef __tmeins

void
tmevtb_insert(TMEVTB *tmevtb, EVTTIM time)
{
	UINT	index;

	/*
	 *  last_index 傪僀儞僋儕儊儞僩偟丆偦偙偐傜忋偵憓擖埵抲傪扵偡丏
	 */
	index = tmevt_up(++last_index, time);

	/*
	 *  僞僀儉僀儀儞僩傪 index 偺埵抲偵憓擖偡傞丏
	 */ 
	TMEVT_NODE(index).time = time;
	TMEVT_NODE(index).tmevtb = tmevtb;
	tmevtb->index = index;
}

#endif /* __tmeins */

/*
 *  僞僀儉僀儀儞僩僸乕僾偐傜偺嶍彍
 */
#ifdef __tmedel

void
tmevtb_delete(TMEVTB *tmevtb)
{
	UINT	index = tmevtb->index;
	UINT	parent;
	EVTTIM	event_time = TMEVT_NODE(last_index).time;

	/*
	 *  嶍彍偵傛傝僞僀儉僀儀儞僩僸乕僾偑嬻偵側傞応崌偼壗傕偟側偄丏
	 */
	if (--last_index == 0) {
		return;
	}

	/*
	 *  嶍彍偟偨僲乕僪偺埵抲偵嵟屻偺僲乕僪乮last_index + 1 偺埵抲
	 *  偺僲乕僪乯傪憓擖偟丆偦傟傪揔愗側埵抲傊堏摦偝偣傞丏幚嵺偵偼丆
	 *  嵟屻偺僲乕僪傪幚嵺偵憓擖偡傞偺偱偼側偔丆嶍彍偟偨僲乕僪偺埵
	 *  抲偑嬻僲乕僪偵側傞偺偱丆嵟屻偺僲乕僪傪憓擖偡傋偒埵抲傊岦偗
	 *  偰嬻僲乕僪傪堏摦偝偣傞丏
	 *  嵟屻偺僲乕僪偺僀儀儞僩敪惗帪崗偑丆嶍彍偟偨僲乕僪偺恊僲乕僪
	 *  偺僀儀儞僩敪惗帪崗傛傝慜偺応崌偵偼丆忋偵岦偐偭偰憓擖埵抲傪
	 *  扵偡丏偦偆偱側偄応崌偵偼丆壓偵岦偐偭偰扵偡丏
	 */
	if (index > 1 && EVTTIM_LT(event_time,
				TMEVT_NODE(parent = PARENT(index)).time)) {
		/*
		 *  恊僲乕僪傪 index 偺埵抲偵堏摦偝偣傞丏
		 */
		TMEVT_NODE(index) = TMEVT_NODE(parent);
		TMEVT_NODE(index).tmevtb->index = index;

		/*
		 *  嶍彍偟偨僲乕僪偺恊僲乕僪偐傜忋偵岦偐偭偰憓擖埵抲傪
		 *  扵偡丏
		 */
		index = tmevt_up(parent, event_time);
	}
	else {
		/*
		 *  嶍彍偟偨僲乕僪偐傜壓偵岦偐偭偰憓擖埵抲傪扵偡丏
		 */
		index = tmevt_down(index, event_time);
	}

	/*
	 *  嵟屻偺僲乕僪傪 index 偺埵抲偵憓擖偡傞丏
	 */ 
	TMEVT_NODE(index) = TMEVT_NODE(last_index + 1);
	TMEVT_NODE(index).tmevtb->index = index;
}

#endif /* __tmedel */

/*
 *  僞僀儉僀儀儞僩僸乕僾偺愭摢偺僲乕僪偺嶍彍
 */
Inline void
tmevtb_delete_top()
{
	UINT	index;
	EVTTIM	event_time = TMEVT_NODE(last_index).time;

	/*
	 *  嶍彍偵傛傝僞僀儉僀儀儞僩僸乕僾偑嬻偵側傞応崌偼壗傕偟側偄丏
	 */
	if (--last_index == 0) {
		return;
	}

	/*
	 *  儖乕僩僲乕僪偵嵟屻偺僲乕僪乮last_index + 1 偺埵抲偺僲乕僪乯
	 *  傪憓擖偟丆偦傟傪揔愗側埵抲傊堏摦偝偣傞丏幚嵺偵偼丆嵟屻偺僲乕
	 *  僪傪幚嵺偵憓擖偡傞偺偱偼側偔丆儖乕僩僲乕僪偑嬻僲乕僪偵側傞
	 *  偺偱丆嵟屻偺僲乕僪傪憓擖偡傋偒埵抲傊岦偗偰嬻僲乕僪傪堏摦偝
	 *  偣傞丏
	 */
	index = tmevt_down(1, event_time);

	/*
	 *  嵟屻偺僲乕僪傪 index 偺埵抲偵憓擖偡傞丏
	 */ 
	TMEVT_NODE(index) = TMEVT_NODE(last_index + 1);
	TMEVT_NODE(index).tmevtb->index = index;
}

/*
 *  僞僀儉僥傿僢僋偺嫙媼
 *
 *  TIC_NUME < TIC_DENO 偺帪偼丆彍嶼傪巊傢偢偵帪崗偺峏怴偑偱偒傞偑丆僜乕
 *  僗僐乕僪傪撉傒傗偡偔偵偡傞偨傔偵 #if 偺懡梡傪旔偗偰偄傞丏
 */
#ifdef __isig_tim

SYSCALL ER
isig_tim()
{
	TMEVTB	*tmevtb;
	ER	ercd;

	LOG_ISIG_TIM_ENTER();
	CHECK_INTCTX_UNL();
	i_lock_cpu();

	/*
	 *  next_time 傛傝僀儀儞僩敪惗帪崗偺憗偄乮傑偨偼摨偠乯僞僀儉僀
	 *  儀儞僩傪丆僞僀儉僀儀儞僩僸乕僾偐傜嶍彍偟丆僐乕儖僶僢僋娭悢
	 *  傪屇傃弌偡丏
	 */
	while (last_index > 0 && EVTTIM_LE(TMEVT_NODE(1).time, next_time)) {
		tmevtb = TMEVT_NODE(1).tmevtb;
		tmevtb_delete_top();
		(*(tmevtb->callback))(tmevtb->arg);

		/*
		 *  偙偙偱桪愭搙偺崅偄妱崬傒傪庴偗晅偗傞丏
		 */
		i_unlock_cpu();
		i_lock_cpu();
	}

	/*
	 *  current_time 傪峏怴偡傞丏
	 */
	current_time = next_time;

	/*
	 *  next_time丆next_subtime 傪峏怴偡傞丏
	 */
#if TIC_DENO == 1
	next_time = current_time + TIC_NUME;
#else /* TIC_DENO == 1 */
	next_subtime += TIC_NUME;
	next_time = current_time + next_subtime / TIC_DENO;
	next_subtime %= TIC_DENO;
#endif /* TIC_DENO == 1 */

	ercd = E_OK;
	i_unlock_cpu();

    exit:
	LOG_ISIG_TIM_LEAVE(ercd);
	return(ercd);
}

#endif /* __isig_tim */