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

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

#include "kernel_impl.h"
#include "target_timer.h"
#include "ostm.h"
#include "Os_Lcfg.h"

/*
 *  現在のシステム時刻（単位: ミリ秒）
 *
 *  厳密には，前のタイムティックのシステム時刻
 */
SystemTimeMsType current_time;

/*
 *      内
部関数プロトタイプ宣言
 */
ISR(target_timer_hdr);

/*
 *  マイクロ秒単位での時刻を取得
 */
SystemTimeUsType
get_tim_utime(void)
{
        SystemTimeUsType        utime;
        SystemTimeMsType        mtime;
        TickType                        clock1, clock2;
        boolean                         ireq;
        SIL_PRE_LOC;

        SIL_LOC_INT();
        mtime = current_time;
        clock1 = target_timer_get_current();
        ireq = target_timer_probe_int();
        clock2 = target_timer_get_current();
        SIL_UNL_INT();
        utime = ((SystemTimeUsType) mtime) * 1000U;

        if ((ireq != FALSE) && (clock2 >= clock1)) {
                /*
                 *  割込みがå…
¥ã£ã¦ãŠã‚Šï¼Œclock2の方がclock1ã®æ–¹ãŒå¤§ãã„ã¾ãŸã¯ç­‰ã—ã„å ´åˆã¯ï¼Œ
                 *  current_time が割込みにより更新されていないかつ，clock1はオーバフロー後
                 *  の値であるため，utimeに1mè¿½åŠ ã™ã‚‹ï¼Žclock1の読み込み，割込みのチェック，
                 *  clock2の読み込みが1μs以下で実行可能なプロセッサも存在するため，等号付き
                 *  で比較している．
                 */
                utime += 1000U;
        }
        utime += TO_USEC(clock1);

        return(utime);
}

/*
 *  OSTMの初期化
 */
void
target_timer_initialize(void)
{
        /* 停止 */
        sil_wrb_mem((void *) (OSTM_TT_B), 0x01);

        /* インターバル・タイマ・モード */
        sil_wrb_mem((void *) (OSTM_CTL_B), 0x00);

        /* コンペアレジスタの設定 */
        sil_wrw_mem((void *) (OSTM_CMP_W), TIMER_CLOCK);

        /* スタート */
        sil_wrb_mem((void *) (OSTM_TS_B), 0x01);
}

/*
 *  OSTMの停止
 */
void
target_timer_terminate(void)
{
        /* 停止 */
        sil_wrb_mem((void *) (OSTM_TT_B), 0x01);

        /* 割込みの禁止とクリア */
        x_disable_int(OSTM_IRQ);
        x_clear_int(OSTM_IRQ);
}

/*
 *  target_timer.arxmlã‚’ä½¿ç”¨ã—ãªã„å ´åˆã®å¯¾å‡¦
 */
#ifndef SysTimerCnt
#define SysTimerCnt             UINT_C(0)
#endif /* SysTimerCnt */

/*
 *  タイマ割込みハンドラ
 */
ISR(target_timer_hdr)
{
        StatusType ercd;

        /* current_timeを更新する */
        current_time++;

        /*
         *  ã‚«ã‚¦ãƒ³ã‚¿åŠ ç®—é€šçŸ¥å‡¦ç†å®Ÿè¡Œ
         */
        ercd = IncrementCounter(SysTimerCnt);
        /* ã‚¨ãƒ©ãƒ¼ãƒªã‚¿ãƒ¼ãƒ³ã®å ´åˆã¯ã‚·ãƒ£ãƒƒãƒˆãƒ€ã‚¦ãƒ³ */
        if (ercd != E_OK) {
                ShutdownOS(ercd);
        }
}