source: asp3_wo_tecs/trunk/arch/arm_gcc/rza1/chip_timer.c@ 307

/*
 *  TOPPERS/ASP Kernel
 *      Toyohashi Open Platform for Embedded Real-Time Systems/
 *      Advanced Standard Profile Kernel
 * 
 *  Copyright (C) 2006-2016 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: chip_timer.c 731 2016-04-03 03:07:35Z ertl-hiro $
 */

/*
 *              タイマドライバ（RZ/A1 OSタイマ用）
 *
 *  RZ/A1は2チャンネルのOSタイマを持つが，その内
の1つを用いて高分解能タ
 *  イマを，もう1つを用いてオーバランタイマを実現する．
 */

#include "kernel_impl.h"
#include "time_event.h"
#ifdef TOPPERS_SUPPORT_OVRHDR
#include "overrun.h"
#endif /* TOPPERS_SUPPORT_OVRHDR */
#include "target_timer.h"
#include <sil.h>
#include "rza1.h"

/*
 *  タイマ割込み要求のクリア
 */
Inline void
target_hrt_int_clear()
{
        gicd_clear_pending(INTNO_OSTM0);
}

/*
 *  タイマの起動処理
 */
void
target_hrt_initialize(intptr_t exinf)
{
        /*
         *  OSタイマをフリーランニングコンペアモードに設定する．
         */
        sil_wrb_mem(OSTM_CTL(OSTM0_BASE), OSTM_CTL_FRCMP);

        /*
         *  OSタイマの設定値を最大値にしておく．
         */
        sil_wrw_mem(OSTM_CMP(OSTM0_BASE), 0xffffffff);

        /*
         *  OSタイマを動作開始する．
         */
        sil_wrb_mem(OSTM_TS(OSTM0_BASE), OSTM_TS_START);

        /*
         *  タイマ割込み要求をクリアする．
         */
        target_hrt_int_clear();
}

/*
 *  タイマの停止処理
 */
void
target_hrt_terminate(intptr_t exinf)
{
        /*
         *  OSタイマを停止する．
         */
        sil_wrb_mem(OSTM_TT(OSTM0_BASE), OSTM_TT_STOP);

        /*
         *  タイマ割込み要求をクリアする．
         */
        target_hrt_int_clear();
}

/*
 *  高分解能タイマへの割込みタイミングの設定
 */
void
target_hrt_set_event(HRTCNT hrtcnt)
{
        uint32_t        cnt = hrtcnt * 33 + hrtcnt / 3 + 1;
        uint32_t        current;

        /*
         *  現在のカウント値を読み，hrtcnt後に割込みが発生するように設定する．
         */
        current = sil_rew_mem(OSTM_CNT(OSTM0_BASE));
        sil_wrw_mem(OSTM_CMP(OSTM0_BASE), current + cnt);

        /*
         *  上で現在のカウント値を読んで以降に，cnt以上カウントアップしてい
         *  ãŸå ´åˆã«ã¯ï¼Œå‰²è¾¼ã¿ã‚’ç™ºç”Ÿã•ã›ã‚‹ï¼Ž
         */
        if (sil_rew_mem(OSTM_CNT(OSTM0_BASE)) - current >= cnt) {
                gicd_set_pending(INTNO_OSTM0);
        }
}

/*
 *  高分解能タイマ割込みの要求
 */
void
target_hrt_raise_event(void)
{
        gicd_set_pending(INTNO_OSTM0);
}

/*
 *  タイマ割込みハンドラ
 */
void
target_hrt_handler(void)
{
        /*
         *  タイマ割込み要求をクリアする．
         */
        target_hrt_int_clear();

        /*
         *  高分解能タイマ割込みを処理する．
         */
        signal_time();
}
/*
 *  オーバランタイマドライバ
 */
#ifdef TOPPERS_SUPPORT_OVRHDR

/*
 *  オーバランタイマ割込み要求のクリア
 */
Inline void
target_ovrtimer_int_clear()
{
        gicd_clear_pending(INTNO_OSTM1);
}

/*
 *  オーバランタイマの初期化処理
 */
void
target_ovrtimer_initialize(intptr_t exinf)
{
        /*
         *  OSタイマをインターバルタイマモードに設定する．
         */
        sil_wrb_mem(OSTM_CTL(OSTM1_BASE), OSTM_CTL_INTERVAL);

        /*
         *  オーバランタイマ割込み要求をクリアする．
         */
        target_ovrtimer_int_clear();
}

/*
 *  オーバランタイマの停止処理
 */
void
target_ovrtimer_terminate(intptr_t exinf)
{
        /*
         *  OSタイマを停止する．
         */
        sil_wrb_mem(OSTM_TT(OSTM1_BASE), OSTM_TT_STOP);

        /*
         *  オーバランタイマ割込み要求をクリアする．
         */
        target_ovrtimer_int_clear();
}

/*
 *  オーバランタイマの停止
 */
PRCTIM
target_ovrtimer_stop(void)
{
        uint32_t        cnt;

        /*
         *  OSタイマを停止する．
         */
        sil_wrb_mem(OSTM_TT(OSTM1_BASE), OSTM_TT_STOP);

        if (gicd_probe_pending(INTNO_OSTM1)) {
                /*
                 *  å‰²è¾¼ã¿è¦æ±‚ãŒç™ºç”Ÿã—ã¦ã„ã‚‹å ´åˆ
                 */
                target_ovrtimer_int_clear();
                return(0U);
        }
        else {
                cnt = sil_rew_mem(OSTM_CNT(OSTM1_BASE));
                return((PRCTIM)((cnt + 34) / 5 * 3 / 20));
        }
}

/*
 *  オーバランタイマの現在値の読出し
 */
PRCTIM
target_ovrtimer_get_current(void)
{
        uint32_t        cnt;

        if (gicd_probe_pending(INTNO_OSTM1)) {
                /*
                 *  å‰²è¾¼ã¿è¦æ±‚ãŒç™ºç”Ÿã—ã¦ã„ã‚‹å ´åˆ
                 */
                return(0U);
        }
        else {
                cnt = sil_rew_mem(OSTM_CNT(OSTM1_BASE));
                return((PRCTIM)((cnt + 34) / 5 * 3 / 20));
        }
}

/*
 *  オーバランタイマ割込みハンドラ
 *
 *  このルーチンに来るまでに，target_ovrtimer_stopが呼ばれているため，
 *  OSタイマを停止する必
要はない．
 */
void
target_ovrtimer_handler(void)
{
        call_ovrhdr();                                  /* オーバランハンドラの起動処理 */
}

#endif /* TOPPERS_SUPPORT_OVRHDR */