source: asp3_wo_tecs/trunk/kernel/time_event.c@ 302

/*
 *  TOPPERS/ASP Kernel
 *      Toyohashi Open Platform for Embedded Real-Time Systems/
 *      Advanced Standard Profile Kernel
 * 
 *  Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
 *                              Toyohashi Univ. of Technology, JAPAN
 *  Copyright (C) 2005-2015 by Embedded and Real-Time Systems Laboratory
 *              Graduate School of Information Science, Nagoya Univ., JAPAN
 * 
 *  上記著作権者
は，以下の(1)〜(4)ã®æ¡ä»¶ã‚’æº€ãŸã™å ´åˆã«é™ã‚Šï¼Œæœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§
 *  ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
 *  変・再é…
å¸ƒï¼ˆä»¥ä¸‹ï¼Œåˆ©ç”¨ã¨å‘¼ã¶ï¼‰ã™ã‚‹ã“とを無償で許諾する．
 *  (1) æœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§ã‚¢ã‚’ã‚½ãƒ¼ã‚¹ã‚³ãƒ¼ãƒ‰ã®å½¢ã§åˆ©ç”¨ã™ã‚‹å ´åˆã«ã¯ï¼Œä¸Šè¨˜ã®è‘—ä½œ
 *      権表示，この利用条件および下記の無保証規定が，そのままの形でソー
 *      スコード中に含まれていること．
 *  (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
 *      用できる形で再é…
å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œå†é…
å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨
 *      者
マニュアルなど）に，上記の著作権表示，この利用条件および下記
 *      の無保証規定を掲載すること．
 *  (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
 *      用できない形で再é…
å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œæ¬¡ã®ã„ずれかの条件を満たすこ
 *      と．
 *    (a) 再é…
å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨è€…
マニュアルなど）に，上記の著
 *        作権表示，この利用条件および下記の無保証規定を掲載すること．
 *    (b) 再é…
å¸ƒã®å½¢æ…
‹ã‚’，別に定める方法によって，TOPPERSプロジェクトに
 *        å ±å‘Šã™ã‚‹ã“ã¨ï¼Ž
 *  (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
 *      害からも，上記著作権者
およびTOPPERSプロジェクトをå…
è²¬ã™ã‚‹ã“と．
 *      また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
 *      由に基づく請求からも，上記著作権者
およびTOPPERSプロジェクトを
 *      å…
è²¬ã™ã‚‹ã“と．
 * 
 *  本ソフトウェアは，無保証で提供されているものである．上記著作権者
お
 *  よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
 *  に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
 *  アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
 *  ã®è²¬ä»»ã‚’è² ã‚ãªã„ï¼Ž
 * 
 *  $Id: time_event.c 451 2015-08-14 15:29:07Z ertl-hiro $
 */

/*
 *              タイムイベント管理モジュール
 */

#include "kernel_impl.h"
#include "time_event.h"

/*
 *  TSTEP_HRTCNTの範囲チェック
 */
#if TSTEP_HRTCNT > 4000U
#error TSTEP_HRTCNT is too large.
#endif /* TSTEP_HRTCNT > 4000U */

/*
 *  HRTCNT_BOUNDの範囲チェック
 */
#if HRTCNT_BOUND >= 4294000000U
#error HRTCNT_BOUND is too large.
#endif /* HRTCNT_BOUND >= 4294000000U */

#ifdef TCYC_HRTCNT
#if HRTCNT_BOUND >= TCYC_HRTCNT
#error HRTCNT_BOUND is too large.
#endif /* HRTCNT_BOUND >= TCYC_HRTCNT */
#endif /* TCYC_HRTCNT */

/*
 *  タイムイベントヒープ操作マクロ
 *
 *  PARENTとCHILDã®ç´ ç›´ãªå®šç¾©ã¯æ¬¡ã®é€šã‚Šã§ã‚ã‚‹ãŒï¼Œã‚ˆã‚Šå®Ÿè¡ŒåŠ¹çŽ‡ã®è‰¯ã„ãƒžã‚¯
 *  ロ定義としている．
 *  #define PARENT(p_tmevtn) (tmevt_heap + (((p_tmevtn) - tmevt_heap) >> 1))
 *  #define LCHILD(p_tmevtn) (tmevt_heap + (((p_tmevtn) - tmevt_heap) << 1))
 *
 *  下のPARENTの定義は，TMEVTNのé…
åˆ—が，sizeof(TMEVTN)の単位でアライン
 *  ã•ã‚Œã¦ã„ã‚‹ã“ã¨ã‚’æƒ³å®šã—ã¦ã„ã‚‹ï¼Žã“ã®å‰æãŒæˆç«‹ã—ãªã„å ´åˆã¯ï¼Œä¸Šã®å®šç¾©
 *  を使用する必
要がある．
 */
#define PARENT(p_tmevtn)                                /* 親ノードを求める */          \
                ((TMEVTN *)(((((uintptr_t) tmevt_heap)                                          \
                                + ((uintptr_t)(p_tmevtn))) >> 1) & ~(sizeof(TMEVTN) - 1)))
#define LCHILD(p_tmevtn)                                /* 左の子ノードを求める */    \
                ((TMEVTN *)((((uintptr_t)(p_tmevtn)) << 1) - ((uintptr_t) tmevt_heap)))

/*
 *  タイムイベントヒープ中のå…
ˆé ­ã®ãƒŽãƒ¼ãƒ‰
 */
#define p_top_tmevtn    (&(tmevt_heap[1]))
#define top_evttim              (tmevt_heap[1].p_tmevtb->evttim)
                                                                                /* å…
ˆé ­ã®ã‚¿ã‚¤ãƒ イベントの発生時刻 */
/*
 *  タイムイベントヒープ中の最後のノード
 */
#define p_last_tmevtn   (tmevt_heap[0].p_last)

/*
 *  イベント時刻の前後関係の判定［ASPD1009］
 *
 *  イベント時刻は，boundary_evttimからの相対値で比較する．すなわち，
 *  boundary_evttimを最も早い時刻，boundary_evttim−1が最も遅
い時刻とみ
 *  なして比較する．
 */
#define EVTTIM_ADVANCE(t)       ((t) - boundary_evttim)
#define EVTTIM_LT(t1, t2)       (EVTTIM_ADVANCE(t1) < EVTTIM_ADVANCE(t2))
#define EVTTIM_LE(t1, t2)       (EVTTIM_ADVANCE(t1) <= EVTTIM_ADVANCE(t2))

#ifdef TOPPERS_tmeini

/*
 *  境界イベント時刻［ASPD1008］
 */
EVTTIM  boundary_evttim;

/*
 *  最後に現在時刻を算出した時点でのイベント時刻［ASPD1012］
 */
EVTTIM  current_evttim;

/*
 *  最後に現在時刻を算出した時点での高分解能タイマのカウント値［ASPD1012］
 */
HRTCNT  current_hrtcnt;

/*
 *  最も進んでいた時のイベント時刻［ASPD1041］
 */
EVTTIM  monotonic_evttim;

/*
 *  システム時刻のオフセット［ASPD1043］
 */
SYSTIM  systim_offset;

/*
 *  高分解能タイマ割込みの処理中であることを示すフラグ［ASPD1032］
 */
bool_t  in_signal_time;

/*
 *  タイムイベント管理モジュールの初期化［ASPD1061］
 */
void
initialize_tmevt(void)
{
        current_evttim = 0U;                                                    /*ï¼»ASPD1047ï¼½*/
        boundary_evttim = current_evttim - BOUNDARY_MARGIN;
                                                                                                        /*ï¼»ASPD1048ï¼½*/
        monotonic_evttim = 0U;                                                  /*ï¼»ASPD1046ï¼½*/
        systim_offset = 0U;                                                             /*ï¼»ASPD1044ï¼½*/
        in_signal_time = false;                                                 /*ï¼»ASPD1033ï¼½*/
        p_last_tmevtn = tmevt_heap;
}

#endif /* TOPPERS_tmeini */

/*
 *  タイムイベントの挿å…
¥ä½ç½®ã‚’上向きに探索
 *
 *  時刻evttimに発生するタイムイベントを挿å…
¥ã™ã‚‹ãƒŽãƒ¼ãƒ‰ã‚’空けるために，
 *  ヒープの上に向かって空ノードを移動させる．移動前の空ノードの位置を
 *  p_tmevtnに渡すと，移動後の空ノードの位置（すなわち挿å…
¥ä½ç½®ï¼‰ã‚’返す．
 */
#ifdef TOPPERS_tmeup

TMEVTN *
tmevt_up(TMEVTN *p_tmevtn, EVTTIM evttim)
{
        TMEVTN  *p_parent;

        while (p_tmevtn > p_top_tmevtn) {
                /*
                 *  親ノードのイベント発生時刻の方が早い（または同じ）ならば，
                 *  p_tmevtnが挿å…
¥ä½ç½®ãªã®ã§ãƒ«ãƒ¼ãƒ—を抜ける．
                 */
                p_parent = PARENT(p_tmevtn);
                if (EVTTIM_LE(p_parent->p_tmevtb->evttim, evttim)) {
                        break;
                }

                /*
                 *  親ノードをp_tmevtnの位置に移動させる．
                 */
                *p_tmevtn = *p_parent;
                p_tmevtn->p_tmevtb->p_tmevtn = p_tmevtn;

                /*
                 *  p_tmevtnを親ノードの位置に更新．
                 */
                p_tmevtn = p_parent;
        }
        return(p_tmevtn);
}

#endif /* TOPPERS_tmeup */

/*
 *  タイムイベントの挿å…
¥ä½ç½®ã‚’下向きに探索
 *
 *  時刻evttimに発生するタイムイベントを挿å…
¥ã™ã‚‹ãƒŽãƒ¼ãƒ‰ã‚’空けるために，
 *  ヒープの下に向かって空ノードを移動させる．移動前の空ノードの位置を
 *  p_tmevtnに渡すと，移動後の空ノードの位置（すなわち挿å…
¥ä½ç½®ï¼‰ã‚’返す．
 */
#ifdef TOPPERS_tmedown

TMEVTN *
tmevt_down(TMEVTN *p_tmevtn, EVTTIM evttim)
{
        TMEVTN  *p_child;

        while ((p_child = LCHILD(p_tmevtn)) <= p_last_tmevtn) {
                /*
                 *  左右の子ノードのイベント発生時刻を比較し，早い方の子ノード
                 *  の位置をp_childに設定する．以下の子ノードは，ここで選ばれた
                 *  方の子ノードのこと．
                 */
                if (p_child + 1 <= p_last_tmevtn
                                        && EVTTIM_LT((p_child + 1)->p_tmevtb->evttim,
                                                                                        p_child->p_tmevtb->evttim)) {
                        p_child = p_child + 1;
                }

                /*
                 *  子ノードのイベント発生時刻の方が遅
い（または同じ）ならば，
                 *  p_tmevtnが挿å…
¥ä½ç½®ãªã®ã§ãƒ«ãƒ¼ãƒ—を抜ける．
                 */
                if (EVTTIM_LE(evttim, p_child->p_tmevtb->evttim)) {
                        break;
                }

                /*
                 *  子ノードをp_tmevtnの位置に移動させる．
                 */
                *p_tmevtn = *p_child;
                p_tmevtn->p_tmevtb->p_tmevtn = p_tmevtn;

                /*
                 *  p_tmevtnを子ノードの位置に更新．
                 */
                p_tmevtn = p_child;
        }
        return(p_tmevtn);
}

#endif /* TOPPERS_tmedown */

/*
 *  ã‚¿ã‚¤ãƒ ã‚¤ãƒ™ãƒ³ãƒˆãƒ’ãƒ¼ãƒ—ã¸ã®è¿½åŠ 
 *
 *  p_tmevtbで指定したタイムイベントブロックを，タイムイベントヒープに
 *  è¿½åŠ ã™ã‚‹ï¼Ž
 */
Inline void
tmevtb_insert(TMEVTB *p_tmevtb)
{
        TMEVTN  *p_tmevtn;

        /*
         *  p_last_tmevtnをインクリメントし，そこから上に挿å…
¥ä½ç½®ã‚’探す．
         */
        p_tmevtn = tmevt_up(++p_last_tmevtn, p_tmevtb->evttim);

        /*
         *  タイムイベントをp_tmevtnの位置に挿å…
¥ã™ã‚‹ï¼Ž
         */ 
        p_tmevtn->p_tmevtb = p_tmevtb;
        p_tmevtb->p_tmevtn = p_tmevtn;
}

/*
 *  タイムイベントヒープからの削除
 */
Inline void
tmevtb_delete(TMEVTB *p_tmevtb)
{
        TMEVTN  *p_tmevtn = p_tmevtb->p_tmevtn;
        TMEVTN  *p_parent;
        EVTTIM  event_evttim;

        /*
         *  å‰Šé™¤ã«ã‚ˆã‚Šã‚¿ã‚¤ãƒ ã‚¤ãƒ™ãƒ³ãƒˆãƒ’ãƒ¼ãƒ—ãŒç©ºã«ãªã‚‹å ´åˆã¯ä½•ã‚‚ã—ãªã„ï¼Ž
         */
        if (--p_last_tmevtn < p_top_tmevtn) {
                return;
        }

        /*
         *  削除したノードの位置に最後のノード（p_last_tmevtn + 1 の位置の
         *  ノード）を挿å…
¥ã—，それを適切な位置へ移動させる．実際には，最後
         *  のノードを実際に挿å…
¥ã™ã‚‹ã®ã§ã¯ãªãï¼Œå‰Šé™¤ã—たノードの位置が空ノー
         *  ドになるので，最後のノードを挿å…
¥ã™ã¹ãä½ç½®ã¸å‘けて空ノードを移
         *  動させる．
         *
         *  最後のノードのイベント発生時刻が，削除したノードの親ノードのイ
         *  ãƒ™ãƒ³ãƒˆç™ºç”Ÿæ™‚åˆ»ã‚ˆã‚Šå‰ã®å ´åˆã«ã¯ï¼Œä¸Šã«å‘ã‹ã£ã¦æŒ¿å…
¥ä½ç½®ã‚’探す．そ
         *  ã†ã§ãªã„å ´åˆã«ã¯ï¼Œä¸‹ã«å‘ã‹ã£ã¦æŽ¢ã™ï¼Ž
         */
        event_evttim = (p_last_tmevtn + 1)->p_tmevtb->evttim;
        if (p_tmevtn > p_top_tmevtn
                        && EVTTIM_LT(event_evttim,
                                                (p_parent = PARENT(p_tmevtn))->p_tmevtb->evttim)) {
                /*
                 *  親ノードをp_tmevtnの位置に移動させる．
                 */
                *p_tmevtn = *p_parent;
                p_tmevtn->p_tmevtb->p_tmevtn = p_tmevtn;

                /*
                 *  削除したノードの親ノードから上に向かって挿å…
¥ä½ç½®ã‚’探す．
                 */
                p_tmevtn = tmevt_up(p_parent, event_evttim);
        }
        else {
                /*
                 *  削除したノードから下に向かって挿å…
¥ä½ç½®ã‚’探す．
                 */
                p_tmevtn = tmevt_down(p_tmevtn, event_evttim);
        }

        /*
         *  最後のノードをp_tmevtnの位置に挿å…
¥ã™ã‚‹ï¼Ž
         */ 
        *p_tmevtn = *(p_last_tmevtn + 1);
        p_tmevtn->p_tmevtb->p_tmevtn = p_tmevtn;
}

/*
 *  タイムイベントヒープのå…
ˆé ­ã®ãƒŽãƒ¼ãƒ‰ã®å‰Šé™¤
 */
Inline TMEVTB *
tmevtb_delete_top(void)
{
        TMEVTN  *p_tmevtn;
        TMEVTB  *p_top_tmevtb = p_top_tmevtn->p_tmevtb;
        EVTTIM  event_evttim;

        /*
         *  å‰Šé™¤ã«ã‚ˆã‚Šã‚¿ã‚¤ãƒ ã‚¤ãƒ™ãƒ³ãƒˆãƒ’ãƒ¼ãƒ—ãŒç©ºã«ãªã‚‹å ´åˆã¯ä½•ã‚‚ã—ãªã„ï¼Ž
         */
        if (--p_last_tmevtn >= p_top_tmevtn) {
                /*
                 *  ルートノードに最後のノード（p_last_tmevtn + 1 の位置のノー
                 *  ド）を挿å…
¥ã—，それを適切な位置へ移動させる．実際には，最後
                 *  のノードを実際に挿å…
¥ã™ã‚‹ã®ã§ã¯ãªãï¼Œãƒ«ãƒ¼ãƒˆãƒŽãƒ¼ãƒ‰ãŒç©ºãƒŽãƒ¼ãƒ‰
                 *  になるので，最後のノードを挿å…
¥ã™ã¹ãä½ç½®ã¸å‘けて空ノードを
                 *  移動させる．
                 */
                event_evttim = (p_last_tmevtn + 1)->p_tmevtb->evttim;
                p_tmevtn = tmevt_down(p_top_tmevtn, event_evttim);

                /*
                 *  最後のノードをp_tmevtnの位置に挿å…
¥ã™ã‚‹ï¼Ž
                 */ 
                *p_tmevtn = *(p_last_tmevtn + 1);
                p_tmevtn->p_tmevtb->p_tmevtn = p_tmevtn;
        }
        return(p_top_tmevtb);
}

/*
 *  現在のイベント時刻の更新
 */
#ifdef TOPPERS_tmecur

void
update_current_evttim(void)
{
        HRTCNT  new_hrtcnt, hrtcnt_advance;
        EVTTIM  previous_evttim;

        new_hrtcnt = target_hrt_get_current();                  /*ï¼»ASPD1013ï¼½*/
        hrtcnt_advance = new_hrtcnt - current_hrtcnt;   /*ï¼»ASPD1014ï¼½*/
#ifdef TCYC_HRTCNT
        if (new_hrtcnt < current_hrtcnt) {
                hrtcnt_advance += TCYC_HRTCNT;
        }
#endif /* TCYC_HRTCNT */

        previous_evttim = current_evttim;
        current_evttim += (EVTTIM) hrtcnt_advance;              /*ï¼»ASPD1015ï¼½*/
        current_hrtcnt = new_hrtcnt;                                    /*ï¼»ASPD1016ï¼½*/
        boundary_evttim = current_evttim - BOUNDARY_MARGIN;     /*ï¼»ASPD1011ï¼½*/

        if (monotonic_evttim - previous_evttim < (EVTTIM) hrtcnt_advance) {
#ifdef UINT64_MAX
                if (current_evttim < monotonic_evttim) {
                        systim_offset += 1LLU << 32;                    /*ï¼»ASPD1045ï¼½*/
                }
#endif /* UINT64_MAX */
                monotonic_evttim = current_evttim;                      /*ï¼»ASPD1042ï¼½*/
        }
}

#endif /* TOPPERS_tmecur */

/*
 *  現在のイベント時刻を遅
い方に丸めたイベント時刻の算出［ASPD1027］
 *
 *  現在のイベント時刻を更新した後に呼ぶことを想定している．
 */
Inline EVTTIM
calc_current_evttim_ub(void)
{
        return(current_evttim + ((EVTTIM) TSTEP_HRTCNT));
}

/*
 *  高分解能タイマ割込みの発生タイミングの設定
 */
#ifdef TOPPERS_tmeset

void
set_hrt_event(void)
{
        HRTCNT  hrtcnt;

        if (p_last_tmevtn < p_top_tmevtn) {
                target_hrt_set_event(HRTCNT_BOUND);                     /*ï¼»ASPD1007ï¼½*/
        }
        else if (EVTTIM_LE(top_evttim, current_evttim)) {
                target_hrt_raise_event();                                       /*ï¼»ASPD1017ï¼½*/
        }
        else {
                hrtcnt = (HRTCNT)(top_evttim - current_evttim);
                if (hrtcnt > HRTCNT_BOUND) {
                        target_hrt_set_event(HRTCNT_BOUND);             /*ï¼»ASPD1006ï¼½*/
                }
                else {
                        target_hrt_set_event(hrtcnt);                   /*ï¼»ASPD1002ï¼½*/
                }
        }
}

#endif /* TOPPERS_tmeset */

/*
 *  タイムイベントブロックのヒープへの挿å…
¥
 */
#ifdef TOPPERS_tmereg

void
tmevtb_register(TMEVTB *p_tmevtb)
{
        tmevtb_insert(p_tmevtb);
}

#endif /* TOPPERS_tmereg */

/*
 *  相対時間指定によるタイムイベントの登録
 *  
 */
#ifdef TOPPERS_tmeenq

void
tmevtb_enqueue(TMEVTB *p_tmevtb, RELTIM time)
{
        /*
         *  現在のイベント時刻とタイムイベントの発生時刻を求める［ASPD1026］．
         */
        update_current_evttim();
        p_tmevtb->evttim = calc_current_evttim_ub() + time;

        /*
         *  タイムイベントブロックをヒープに挿å…
¥ã™ã‚‹ï¼»ASPD1030］．
         */
        tmevtb_insert(p_tmevtb);

        /*
         *  高分解能タイマ割込みの発生タイミングを設定する［ASPD1031］
         *  ［ASPD1034］．
         */
        if (!in_signal_time && p_tmevtb->p_tmevtn == p_top_tmevtn) {
                set_hrt_event();
        }
}

#endif /* TOPPERS_tmeenq */

/*
 *  タイムイベントの登録解除
 */
#ifdef TOPPERS_tmedeq

void
tmevtb_dequeue(TMEVTB *p_tmevtb)
{
        TMEVTN  *p_tmevtn;

        /*
         *  タイムイベントブロックをヒープから削除する［ASPD1039］．
         */
        p_tmevtn = p_tmevtb->p_tmevtn;
        tmevtb_delete(p_tmevtb);

        /*
         *  高分解能タイマ割込みの発生タイミングを設定する［ASPD1040］．
         */
        if (!in_signal_time && p_tmevtn == p_top_tmevtn) {
                update_current_evttim();
                set_hrt_event();
        }
}

#endif /* TOPPERS_tmedeq */

/*
 *  システム時刻の調整時のエラーチェック
 */
#ifdef TOPPERS_tmechk

bool_t
check_adjtim(int_t adjtim)
{
        if (adjtim > 0) {
                return(p_last_tmevtn >= p_top_tmevtn    /*ï¼»NGKI3588ï¼½*/
                                        && EVTTIM_LE(top_evttim, current_evttim - TMAX_ADJTIM));
        }
        else if (adjtim < 0) {                                          /*ï¼»NGKI3589ï¼½*/
                return(monotonic_evttim - current_evttim >= -TMIN_ADJTIM);
        }
        return(false);
}

#endif /* TOPPERS_tmechk */

/*
 *  タイムイベントが発生するまでの時間の計算
 */
#ifdef TOPPERS_tmeltim

RELTIM
tmevt_lefttim(TMEVTB *p_tmevtb)
{
        EVTTIM  evttim, current_evttim_ub;

        /*
         *  現在のイベント時刻を遅
い方に丸めた時刻を求める［ASPD1050］．
         */
        update_current_evttim();
        current_evttim_ub = calc_current_evttim_ub();

        /*
         *  タイムイベント発生までの相対時間を求める［ASPD1049］．
         */
        evttim = p_tmevtb->evttim;
        if (EVTTIM_LE(evttim, current_evttim_ub)) {
                /*
                 *  ã‚¿ã‚¤ãƒ ã‚¤ãƒ™ãƒ³ãƒˆã®ç™ºç”Ÿæ™‚åˆ»ã‚’éŽãŽã¦ã„ã‚‹å ´åˆã«ã¯0を返す［NGKI0552］．
                 */
                return(0U);
        }
        else {
                return((RELTIM)(evttim - current_evttim_ub));
        }
}

#endif /* TOPPERS_tmeltim */

/*
 *  高分解能タイマ割込みの処理
 */
#ifdef TOPPERS_sigtim

void
signal_time(void)
{
        TMEVTB  *p_tmevtb;
        bool_t  callflag;

        assert(sense_context());
        assert(!sense_lock());

        lock_cpu();
        in_signal_time = true;                                                  /*ï¼»ASPD1033ï¼½*/

        do {
                /*
                 *  コールバック関数を呼び出さなければループを抜ける［ASPD1020］．
                 */
                callflag = false;

                /*
                 *  現在のイベント時刻を求める［ASPD1022］．
                 */
                update_current_evttim();

                /*
                 *  発生時刻がcurrent_evttim以前のタイムイベントがあれば，タイ
                 *  ムイベントヒープから削除し，コールバック関数を呼び出す
                 *  ［ASPD1018］［ASPD1019］．
                 */
                while (p_last_tmevtn >= p_top_tmevtn
                                                        && EVTTIM_LE(top_evttim, current_evttim)) {
                        p_tmevtb = tmevtb_delete_top();
                        (*(p_tmevtb->callback))(p_tmevtb->arg);
                        callflag = true;
                }
        } while (callflag);                                                             /*ï¼»ASPD1020ï¼½*/

        /*
         *  高分解能タイマ割込みの発生タイミングを設定する［ASPD1025］．
         */
        set_hrt_event();

        in_signal_time = false;                                                 /*ï¼»ASPD1033ï¼½*/
        unlock_cpu();
}

#endif /* TOPPERS_sigtim */