source: atk2-sc3-1.4.0-ntisr/arch/v850_gcc/tauj_hw_counter.c@ 172

/*
 *  TOPPERS ATK2
 *      Toyohashi Open Platform for Embedded Real-Time Systems
 *      Automotive Kernel Version 2
 *
 *  Copyright (C) 2014 by Center for Embedded Computing Systems
 *              Graduate School of Information Science, Nagoya Univ., JAPAN
 *  Copyright (C) 2014 by FUJI SOFT INCORPORATED, JAPAN
 *  Copyright (C) 2014 by Spansion LLC, USA
 *  Copyright (C) 2014 by NEC Communication Systems, Ltd., JAPAN
 *  Copyright (C) 2014 by Panasonic Advanced Technology Development Co., Ltd., JAPAN
 *  Copyright (C) 2014 by Renesas Electronics Corporation, JAPAN
 *  Copyright (C) 2014 by Sunny Giken Inc., JAPAN
 *  Copyright (C) 2014 by TOSHIBA CORPORATION, JAPAN
 *  Copyright (C) 2014 by Witz Corporation, JAPAN
 *
 *  上記著作権者
は，以下の(1)〜(4)ã®æ¡ä»¶ã‚’æº€ãŸã™å ´åˆã«é™ã‚Šï¼Œæœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§
 *  ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
 *  変・再é…
å¸ƒï¼ˆä»¥ä¸‹ï¼Œåˆ©ç”¨ã¨å‘¼ã¶ï¼‰ã™ã‚‹ã“とを無償で許諾する．
 *  (1) æœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§ã‚¢ã‚’ã‚½ãƒ¼ã‚¹ã‚³ãƒ¼ãƒ‰ã®å½¢ã§åˆ©ç”¨ã™ã‚‹å ´åˆã«ã¯ï¼Œä¸Šè¨˜ã®è‘—ä½œ
 *      権表示，この利用条件および下記の無保証規定が，そのままの形でソー
 *      スコード中に含まれていること．
 *  (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
 *      用できる形で再é…
å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œå†é…
å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨
 *      者
マニュアルなど）に，上記の著作権表示，この利用条件および下記
 *      の無保証規定を掲載すること．
 *  (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
 *      用できない形で再é…
å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œæ¬¡ã®ã„ずれかの条件を満たすこ
 *      と．
 *    (a) 再é…
å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨è€…
マニュアルなど）に，上記の著
 *        作権表示，この利用条件および下記の無保証規定を掲載すること．
 *    (b) 再é…
å¸ƒã®å½¢æ…
‹ã‚’，別に定める方法によって，TOPPERSプロジェクトに
 *        å ±å‘Šã™ã‚‹ã“ã¨ï¼Ž
 *  (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
 *      害からも，上記著作権者
およびTOPPERSプロジェクトをå…
è²¬ã™ã‚‹ã“と．
 *      また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
 *      由に基づく請求からも，上記著作権者
およびTOPPERSプロジェクトを
 *      å…
è²¬ã™ã‚‹ã“と．
 *
 *  本ソフトウェアは，AUTOSAR（AUTomotive Open System ARchitecture）仕
 *  様に基づいている．上記の許諾は，AUTOSARの知的財産権を許諾するもので
 *  はない．AUTOSARは，AUTOSAR仕様に基づいたソフトウェアを商用目的で利
 *  用する者
に対して，AUTOSARパートナーになることを求めている．
 *
 *  本ソフトウェアは，無保証で提供されているものである．上記著作権者
お
 *  よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
 *  に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
 *  アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
 *  ã®è²¬ä»»ã‚’è² ã‚ãªã„ï¼Ž
 *
 *  $Id: tauj_hw_counter.c 154 2015-01-28 11:33:39Z t_ishikawa $
 */

/*
 *              以下ハードウェアカウンタプログラムのターゲット依存定義（fl850fx4用）
 *
 *  使用するタイマ：
 *    差分タイマ：目的の時間を設定する時の現在時間(現在値タイマ)
 *              と次の満了時間との相対時間をカウントすることで
 *              目的の絶対時間に満了したこととする
 *              count mode:count down once
 *
 *    現在値タイマ：カウンタ周期分のベースタイマを実現
 *              (絶対時間をカウント)
 *              count mode:continuous count down
 *
 *    また上記のタイマは32bitのダウンカウンタタイマである
 *
 *  制御方針：
 *
 *   現在値タイマはユーザ定義カウンタ最大値2倍+1までカウントし，
 *   周期タイマとして連続カウントダウンして，常に現在時刻を
 *   取得する．割込み発生する必
要がないため，割込みなしモード
 *
 *   差分タイマは，満了処理を行うため，割込みありモードで動く
 *   アラームなどの満了点とタイマー1で示した現在時刻の差を
 *   現在値タイマに設定する
 *
 *  ポイント：
 *   満了処理は，現在時刻を影響しないため，現在値タイマを設けている
 *
 */

#include "Os.h"
#include "prc_sil.h"
#include "target_hw_counter.h"

/*
 *  =begin ハードウェアカウンタのTAUJn依存部
 */
/*
 *  ハードウェアカウンタの初期化
 *   n_d  : 差分タイマのユニット番号
 *   ch_d : 差分タイマのチャネル
 *   n_c  : 現在値タイマのユニット番号
 *   ch_c : 現在値タイマのチャネル
 */
static void
init_hwcounter_tauj(uint8 n_d, uint8 ch_d, uint8 n_c, uint8 ch_c, TickType maxval, TimeType nspertick, TickRefType cycle)
{
        uint16  wk;
        *cycle = maxval;

        /* assert((tauj_id + 1) < TAUJ_MAX); */

        /* 差分タイマ停止処理 */
        SetTimerStopTAUJ(n_d, ch_d);
        /* 割込み禁止 */
        HwcounterDisableInterrupt(TAUJ_INTNO(n_d, ch_d));
        /* 割込み要求クリア */
        HwcounterClearInterrupt(TAUJ_INTNO(n_d, ch_d));

        /* 差分タイマのプリスケーラを設定 PCLK/2^0 */
        wk = sil_reh_mem((void *) TAUJTPS(n_d));
        wk &= MCU_TAUJ_MASK_CK0;
        wk |= MCU_TAUJ_CK0_0;
        sil_wrh_mem((void *) TAUJTPS(n_d), wk);

        /* 現在値タイマのプリスケーラを設定 PCLK/2^0 */
        wk = sil_reh_mem((void *) TAUJTPS(n_c));
        wk &= MCU_TAUJ_MASK_CK0;
        wk |= MCU_TAUJ_CK0_0;
        sil_wrh_mem((void *) TAUJTPS(n_c), wk);

        /* 差分タイマをインターバルタイマとして設定 */
        sil_wrh_mem((void *) TAUJCMOR(n_d, ch_d), MCU_TAUJ00_CMOR);
        sil_wrb_mem((void *) TAUJCMUR(n_d, ch_d), MCU_TAUJ00_CMUR);

        /* 現在値タイマ停止処理 */
        SetTimerStopTAUJ(n_c, ch_c);
        /* 割込み禁止 */
        HwcounterDisableInterrupt(TAUJ_INTNO(n_c, ch_c));
        /* 割込み要求クリア */
        HwcounterClearInterrupt(TAUJ_INTNO(n_c, ch_c));

        /* 現在値タイマをインターバルタイマとして設定 */
        sil_wrh_mem((void *) TAUJCMOR(n_c, ch_c), MCU_TAUJ00_CMOR);
        sil_wrb_mem((void *) TAUJCMUR(n_c, ch_c), MCU_TAUJ00_CMUR);

        /* タイマカウント周期設定 */
        sil_wrw_mem((void *) TAUJCDR(n_c, ch_c), maxval);
}
/*
 *  ハードウェアカウンタの開始
 */
static void
start_hwcounter_tauj(uint8 n_c, uint8 ch_c)
{
        /* 現在値タイマ開始 */
        SetTimerStartTAUJ(n_c, ch_c);
}

/*
 *  ハードウェアカウンタの停止
 *   n_d  : 差分タイマのユニット番号
 *   ch_d : 差分タイマのチャネル
 *   n_c  : 現在値タイマのユニット番号
 *   ch_c : 現在値タイマのチャネル  
 */
static void
stop_hwcounter_tauj(uint8 n_d, uint8 ch_d, uint8 n_c, uint8 ch_c)
{
        /* 差分タイマの停止 */
        SetTimerStopTAUJ(n_d, ch_d);

        /* 差分タイマの割込み禁止 */
        HwcounterDisableInterrupt(TAUJ_INTNO(n_d, ch_d));
        /* 差分タイマの割込み要求のクリア */
        HwcounterClearInterrupt(TAUJ_INTNO(n_d, ch_d));

        /* 現在値タイマの停止 */
        SetTimerStopTAUJ(n_c, ch_c);

        /* 現在値タイマの割込み禁止 */
        /* HwcounterDisableInterrupt(TAUJ_INTNO(tauj_id + 1)); */
        /* 現在値タイマの割込み要求のクリア */
        HwcounterClearInterrupt(TAUJ_INTNO(n_c, ch_c));
}

/*
 *  ハードウェアカウンタへの満了時間の設定
 *   n_d  : 差分タイマのユニット番号
 *   ch_d : 差分タイマのチャネル
 *   n_c  : 現在値タイマのユニット番号
 *   ch_c : 現在値タイマのチャネル    
 */
static void
set_hwcounter_tauj(uint8 n_d, uint8 ch_d, uint8 n_c, uint8 ch_c, TickType exprtick, TickType maxval)
{
        TickType        curr_time;
        TickType        value;

        /* 差分タイマの割込み要求のクリア */
        HwcounterClearInterrupt(TAUJ_INTNO(n_d, ch_d));
        /* 差分タイマの割込み許可 */
        HwcounterEnableInterrupt(TAUJ_INTNO(n_d, ch_d));

        /* 現在時刻の取得 */
        curr_time = GetCurrentTimeTAUJ(n_c, ch_c, maxval);

        /* タイマに設定する値を算出 */
        if (exprtick >= curr_time) {
                value = exprtick - curr_time;
        }
        else {
                value = (exprtick - curr_time) + (maxval + 1U);
        }

        /*
         *  タイマに0x00を設定し，割込み発生後，再度0ã‚’è¨­å®šã—ãŸå ´åˆï¼Œ2回目の
         *  0x00設定後の割込みは発生しないので，0x00設定値を0x01に直して設定
         */
        if (value == 0x00U) {
                value = 0x01U;
        }

        /* 差分タイマのタイマ値設定 */
        sil_wrw_mem((void *) TAUJCDR(n_d, ch_d), (value));

        /*
         * カウント開始
         */
        SetTimerStartTAUJ(n_d, ch_d);
}

/*
 *  ハードウェアカウンタの現在時間の取得
 */
static TickType
get_hwcounter_tauj(uint8 n_c, uint8 ch_c, TickType maxval)
{
        return(GetCurrentTimeTAUJ(n_c, ch_c, maxval));
}

/*
 *  ハードウェアカウンタの設定された満了時間の取消
 */
static void
cancel_hwcounter_tauj(uint8 n_d, uint8 ch_d)
{
        /* 差分タイマの停止 */
        SetTimerStopTAUJ(n_d, ch_d);
}

/*
 *  ハードウェアカウンタの強制割込み要求
 */
static void
trigger_hwcounter_tauj(uint8 n_d, uint8 ch_d)
{
        /* 差分タイマ停止 */
        SetTimerStopTAUJ(n_d, ch_d);

        /* 差分タイマの割込み要求のクリア */
        HwcounterClearInterrupt(TAUJ_INTNO(n_d, ch_d));
        /* 差分タイマの割込み許可 */
        HwcounterEnableInterrupt(TAUJ_INTNO(n_d, ch_d));

        /* 差分タイマカウンターに0x01をセットすることで，すぐ満了 */
        sil_wrw_mem((void *) TAUJCDR(n_d, ch_d), (1));

        /*  差分タイマ開始 */
        SetTimerStartTAUJ(n_d, ch_d);
}

/*
 *  割込み要求のクリア
 */
static void
int_clear_hwcounter_tauj(uint8 n_d, uint8 ch_d)
{
        /* 割込み要求クリア */
        HwcounterClearInterrupt(TAUJ_INTNO(n_d, ch_d));
}

/*
 *  割込み要求のキャンセル
 *  ペンディングされている割込み要求をキャンセル
 */
static void
int_cancel_hwcounter_tauj(uint8 n_d, uint8 ch_d)
{
        /* 割込み要求クリア */
        HwcounterClearInterrupt(TAUJ_INTNO(n_d, ch_d));
}

/*
 *  ハードウェアカウンタのインクリメント
 */
static void
increment_hwcounter_tauj(uint8 n_d, uint8 ch_d)
{
        /* 未サポート */
        return;
}
/*
 *  =end ハードウェアカウンタのTAUJn依存部
 */


/*
 *  =begin MAIN_HW_COUNTERの定義
 */
/* カウンタの最大値の2倍+1 */
static TickType MAIN_HW_COUNTER_maxval;

/*
 *  ハードウェアカウンタの初期化
 */
void
init_hwcounter_MAIN_HW_COUNTER(TickType maxval, TimeType nspertick)
{
        init_hwcounter_tauj(HWC_DTIM_UNIT, HWC_DTIM_ID,
                                                HWC_CTIM_UNIT, HWC_CTIM_ID,
                                                maxval, nspertick, &MAIN_HW_COUNTER_maxval);
}

/*
 *  ハードウェアカウンタの開始
 */
void
start_hwcounter_MAIN_HW_COUNTER(void)
{
        start_hwcounter_tauj(HWC_CTIM_UNIT, HWC_CTIM_ID);
}

/*
 *  ハードウェアカウンタの停止
 */
void
stop_hwcounter_MAIN_HW_COUNTER(void)
{
        stop_hwcounter_tauj(HWC_DTIM_UNIT, HWC_DTIM_ID,
                                                HWC_CTIM_UNIT, HWC_CTIM_ID);
}

/*
 *  ハードウェアカウンタへの満了時間の設定
 */
void
set_hwcounter_MAIN_HW_COUNTER(TickType exprtick)
{
        set_hwcounter_tauj(HWC_DTIM_UNIT, HWC_DTIM_ID,
                                           HWC_CTIM_UNIT, HWC_CTIM_ID,
                                           exprtick, MAIN_HW_COUNTER_maxval);
}

/*
 *  ハードウェアカウンタの現在時間の取得
 */
TickType
get_hwcounter_MAIN_HW_COUNTER(void)
{
        return(get_hwcounter_tauj(HWC_CTIM_UNIT, HWC_CTIM_ID,
                                                          MAIN_HW_COUNTER_maxval));
}

/*
 *  ハードウェアカウンタの設定された満了時間の取消
 */
void
cancel_hwcounter_MAIN_HW_COUNTER(void)
{
        cancel_hwcounter_tauj(HWC_DTIM_UNIT, HWC_DTIM_ID);
}

/*
 *  ハードウェアカウンタの強制割込み要求
 */
void
trigger_hwcounter_MAIN_HW_COUNTER(void)
{
        trigger_hwcounter_tauj(HWC_DTIM_UNIT, HWC_DTIM_ID);
}

/*
 *  ハードウェアカウンタの設定された満了時間の取消
 */
void
int_clear_hwcounter_MAIN_HW_COUNTER(void)
{
        int_clear_hwcounter_tauj(HWC_DTIM_UNIT, HWC_DTIM_ID);
}

/*
 *  ハードウェアカウンタの設定された満了時間の取消
 */
void
int_cancel_hwcounter_MAIN_HW_COUNTER(void)
{
        int_cancel_hwcounter_tauj(HWC_DTIM_UNIT, HWC_DTIM_ID);
}

/*
 *  ハードウェアカウンタのインクリメント
 */
void
increment_hwcounter_MAIN_HW_COUNTER(void)
{
        increment_hwcounter_tauj(HWC_DTIM_UNIT, HWC_DTIM_ID);
}

/*
 *  =end MAIN_HW_COUNTERの定義
 */