[117] | 1 | /*
|
---|
| 2 | * TOPPERS ATK2
|
---|
| 3 | * Toyohashi Open Platform for Embedded Real-Time Systems
|
---|
| 4 | * Automotive Kernel Version 2
|
---|
| 5 | *
|
---|
| 6 | * Copyright (C) 2012-2014 by Center for Embedded Computing Systems
|
---|
| 7 | * Graduate School of Information Science, Nagoya Univ., JAPAN
|
---|
| 8 | *
|
---|
| 9 | * 上記著作権者は,以下の(1)〜(4)の条件を満たす場合に限り,本ソフトウェ
|
---|
| 10 | * ア(本ソフトウェアを改変したものを含む.以下同じ)を使用・複製・改
|
---|
| 11 | * 変・再配布(以下,利用と呼ぶ)することを無償で許諾する.
|
---|
| 12 | * (1) 本ソフトウェアをソースコードの形で利用する場合には,上記の著作
|
---|
| 13 | * 権表示,この利用条件および下記の無保証規定が,そのままの形でソー
|
---|
| 14 | * スコード中に含まれていること.
|
---|
| 15 | * (2) 本ソフトウェアを,ライブラリ形式など,他のソフトウェア開発に使
|
---|
| 16 | * 用できる形で再配布する場合には,再配布に伴うドキュメント(利用
|
---|
| 17 | * 者マニュアルなど)に,上記の著作権表示,この利用条件および下記
|
---|
| 18 | * の無保証規定を掲載すること.
|
---|
| 19 | * (3) 本ソフトウェアを,機器に組み込むなど,他のソフトウェア開発に使
|
---|
| 20 | * 用できない形で再配布する場合には,次のいずれかの条件を満たすこ
|
---|
| 21 | * と.
|
---|
| 22 | * (a) 再配布に伴うドキュメント(利用者マニュアルなど)に,上記の著
|
---|
| 23 | * 作権表示,この利用条件および下記の無保証規定を掲載すること.
|
---|
| 24 | * (b) 再配布の形態を,別に定める方法によって,TOPPERSプロジェクトに
|
---|
| 25 | * 報告すること.
|
---|
| 26 | * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
|
---|
| 27 | * 害からも,上記著作権者およびTOPPERSプロジェクトを免責すること.
|
---|
| 28 | * また,本ソフトウェアのユーザまたはエンドユーザからのいかなる理
|
---|
| 29 | * 由に基づく請求からも,上記著作権者およびTOPPERSプロジェクトを
|
---|
| 30 | * 免責すること.
|
---|
| 31 | *
|
---|
| 32 | * 本ソフトウェアは,AUTOSAR(AUTomotive Open System ARchitecture)仕
|
---|
| 33 | * 様に基づいている.上記の許諾は,AUTOSARの知的財産権を許諾するもので
|
---|
| 34 | * はない.AUTOSARは,AUTOSAR仕様に基づいたソフトウェアを商用目的で利
|
---|
| 35 | * 用する者に対して,AUTOSARパートナーになることを求めている.
|
---|
| 36 | *
|
---|
| 37 | * 本ソフトウェアは,無保証で提供されているものである.上記著作権者お
|
---|
| 38 | * よびTOPPERSプロジェクトは,本ソフトウェアに関して,特定の使用目的
|
---|
| 39 | * に対する適合性も含めて,いかなる保証も行わない.また,本ソフトウェ
|
---|
| 40 | * アの利用により直接的または間接的に生じたいかなる損害に関しても,そ
|
---|
| 41 | * の責任を負わない.
|
---|
| 42 | *
|
---|
| 43 | * @(#) $Id: ostm.c 164 2015-06-03 01:22:29Z t_ishikawa $
|
---|
| 44 | */
|
---|
| 45 |
|
---|
| 46 | #include "kernel_impl.h"
|
---|
| 47 | #include "target_timer.h"
|
---|
| 48 | #include "ostm.h"
|
---|
| 49 | #include "Os_Lcfg.h"
|
---|
| 50 |
|
---|
| 51 | /*
|
---|
| 52 | * 現在のシステム時刻(単位: ミリ秒)
|
---|
| 53 | *
|
---|
| 54 | * 厳密には,前のタイムティックのシステム時刻
|
---|
| 55 | */
|
---|
| 56 | SystemTimeMsType current_time;
|
---|
| 57 |
|
---|
| 58 | /*
|
---|
| 59 | * 内部関数プロトタイプ宣言
|
---|
| 60 | */
|
---|
| 61 | ISR(target_timer_hdr);
|
---|
| 62 |
|
---|
| 63 | /*
|
---|
| 64 | * マイクロ秒単位での時刻を取得
|
---|
| 65 | */
|
---|
| 66 | SystemTimeUsType
|
---|
| 67 | get_tim_utime(void)
|
---|
| 68 | {
|
---|
| 69 | SystemTimeUsType utime;
|
---|
| 70 | SystemTimeMsType mtime;
|
---|
| 71 | TickType clock1, clock2;
|
---|
| 72 | boolean ireq;
|
---|
| 73 | SIL_PRE_LOC;
|
---|
| 74 |
|
---|
| 75 | SIL_LOC_INT();
|
---|
| 76 | mtime = current_time;
|
---|
| 77 | clock1 = target_timer_get_current();
|
---|
| 78 | ireq = target_timer_probe_int();
|
---|
| 79 | clock2 = target_timer_get_current();
|
---|
| 80 | SIL_UNL_INT();
|
---|
| 81 | utime = ((SystemTimeUsType) mtime) * 1000U;
|
---|
| 82 |
|
---|
| 83 | if ((ireq != FALSE) && (clock2 >= clock1)) {
|
---|
| 84 | /*
|
---|
| 85 | * 割込みが入っており,clock2の方がclock1の方が大きいまたは等しい場合は,
|
---|
| 86 | * current_time が割込みにより更新されていないかつ,clock1はオーバフロー後
|
---|
| 87 | * の値であるため,utimeに1m追加する.clock1の読み込み,割込みのチェック,
|
---|
| 88 | * clock2の読み込みが1μs以下で実行可能なプロセッサも存在するため,等号付き
|
---|
| 89 | * で比較している.
|
---|
| 90 | */
|
---|
| 91 | utime += 1000U;
|
---|
| 92 | }
|
---|
| 93 | utime += TO_USEC(clock1);
|
---|
| 94 |
|
---|
| 95 | return(utime);
|
---|
| 96 | }
|
---|
| 97 |
|
---|
| 98 | /*
|
---|
| 99 | * OSTMの初期化
|
---|
| 100 | */
|
---|
| 101 | void
|
---|
| 102 | target_timer_initialize(void)
|
---|
| 103 | {
|
---|
| 104 | /* 停止 */
|
---|
| 105 | sil_wrb_mem((void *) (OSTM_TT_B), 0x01);
|
---|
| 106 |
|
---|
| 107 | /* インターバル・タイマ・モード */
|
---|
| 108 | sil_wrb_mem((void *) (OSTM_CTL_B), 0x00);
|
---|
| 109 |
|
---|
| 110 | /* コンペアレジスタの設定 */
|
---|
| 111 | sil_wrw_mem((void *) (OSTM_CMP_W), TIMER_CLOCK);
|
---|
| 112 |
|
---|
| 113 | /* スタート */
|
---|
| 114 | sil_wrb_mem((void *) (OSTM_TS_B), 0x01);
|
---|
| 115 | }
|
---|
| 116 |
|
---|
| 117 | /*
|
---|
| 118 | * OSTMの停止
|
---|
| 119 | */
|
---|
| 120 | void
|
---|
| 121 | target_timer_terminate(void)
|
---|
| 122 | {
|
---|
| 123 | /* 停止 */
|
---|
| 124 | sil_wrb_mem((void *) (OSTM_TT_B), 0x01);
|
---|
| 125 |
|
---|
| 126 | /* 割込みの禁止とクリア */
|
---|
| 127 | x_disable_int(OSTM_IRQ);
|
---|
| 128 | x_clear_int(OSTM_IRQ);
|
---|
| 129 | }
|
---|
| 130 |
|
---|
| 131 | /*
|
---|
| 132 | * target_timer.arxmlを使用しない場合の対処
|
---|
| 133 | */
|
---|
| 134 | #ifndef SysTimerCnt
|
---|
| 135 | #define SysTimerCnt UINT_C(0)
|
---|
| 136 | #endif /* SysTimerCnt */
|
---|
| 137 |
|
---|
| 138 | /*
|
---|
| 139 | * タイマ割込みハンドラ
|
---|
| 140 | */
|
---|
| 141 | ISR(target_timer_hdr)
|
---|
| 142 | {
|
---|
| 143 | StatusType ercd;
|
---|
| 144 |
|
---|
| 145 | /* current_timeを更新する */
|
---|
| 146 | current_time++;
|
---|
| 147 |
|
---|
| 148 | /*
|
---|
| 149 | * カウンタ加算通知処理実行
|
---|
| 150 | */
|
---|
| 151 | ercd = IncrementCounter(SysTimerCnt);
|
---|
| 152 | /* エラーリターンの場合はシャットダウン */
|
---|
| 153 | if (ercd != E_OK) {
|
---|
| 154 | ShutdownOS(ercd);
|
---|
| 155 | }
|
---|
| 156 | }
|
---|