1 | /*
|
---|
2 | * TOPPERS/ASP Kernel
|
---|
3 | * Toyohashi Open Platform for Embedded Real-Time Systems/
|
---|
4 | * Advanced Standard Profile Kernel
|
---|
5 | *
|
---|
6 | * Copyright (C) 2006-2017 by Embedded and Real-Time Systems Laboratory
|
---|
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 | * 本ソフトウェアは,無保証で提供されているものである.上記著作権者お
|
---|
33 | * よびTOPPERSプロジェクトは,本ソフトウェアに関して,特定の使用目的
|
---|
34 | * に対する適合性も含めて,いかなる保証も行わない.また,本ソフトウェ
|
---|
35 | * アの利用により直接的または間接的に生じたいかなる損害に関しても,そ
|
---|
36 | * の責任を負わない.
|
---|
37 | *
|
---|
38 | * $Id$
|
---|
39 | */
|
---|
40 |
|
---|
41 | /*
|
---|
42 | * タイマドライバ(RZ/A1 OSタイマ用)
|
---|
43 | *
|
---|
44 | * RZ/A1は2チャンネルのOSタイマを持つが,その内の1つを用いて高分解能タ
|
---|
45 | * イマを,もう1つを用いてオーバランタイマを実現する.
|
---|
46 | */
|
---|
47 |
|
---|
48 | #include "kernel_impl.h"
|
---|
49 | #include "time_event.h"
|
---|
50 | #ifdef TOPPERS_SUPPORT_OVRHDR
|
---|
51 | #include "overrun.h"
|
---|
52 | #endif /* TOPPERS_SUPPORT_OVRHDR */
|
---|
53 | #include "target_timer.h"
|
---|
54 | #include <sil.h>
|
---|
55 | #include "rza1.h"
|
---|
56 |
|
---|
57 | /*
|
---|
58 | * タイマの起動処理
|
---|
59 | */
|
---|
60 | void
|
---|
61 | target_hrt_initialize(intptr_t exinf)
|
---|
62 | {
|
---|
63 | /*
|
---|
64 | * OSタイマをフリーランニングコンペアモードに設定する.
|
---|
65 | */
|
---|
66 | sil_wrb_mem(OSTM_CTL(OSTM0_BASE), OSTM_CTL_FRCMP);
|
---|
67 |
|
---|
68 | /*
|
---|
69 | * OSタイマの設定値を最大値にしておく.
|
---|
70 | */
|
---|
71 | sil_wrw_mem(OSTM_CMP(OSTM0_BASE), 0xffffffff);
|
---|
72 |
|
---|
73 | /*
|
---|
74 | * OSタイマを動作開始する.
|
---|
75 | */
|
---|
76 | sil_wrb_mem(OSTM_TS(OSTM0_BASE), OSTM_TS_START);
|
---|
77 |
|
---|
78 | /*
|
---|
79 | * タイマ割込み要求をクリアする.
|
---|
80 | */
|
---|
81 | clear_int(INTNO_OSTM0);
|
---|
82 | }
|
---|
83 |
|
---|
84 | /*
|
---|
85 | * タイマの停止処理
|
---|
86 | */
|
---|
87 | void
|
---|
88 | target_hrt_terminate(intptr_t exinf)
|
---|
89 | {
|
---|
90 | /*
|
---|
91 | * OSタイマを停止する.
|
---|
92 | */
|
---|
93 | sil_wrb_mem(OSTM_TT(OSTM0_BASE), OSTM_TT_STOP);
|
---|
94 |
|
---|
95 | /*
|
---|
96 | * タイマ割込み要求をクリアする.
|
---|
97 | */
|
---|
98 | clear_int(INTNO_OSTM0);
|
---|
99 | }
|
---|
100 |
|
---|
101 | /*
|
---|
102 | * 高分解能タイマへの割込みタイミングの設定
|
---|
103 | */
|
---|
104 | void
|
---|
105 | target_hrt_set_event(HRTCNT hrtcnt)
|
---|
106 | {
|
---|
107 | uint32_t cnt = hrtcnt * 33 + hrtcnt / 3 + 1;
|
---|
108 | uint32_t current;
|
---|
109 |
|
---|
110 | /*
|
---|
111 | * 現在のカウント値を読み,hrtcnt後に割込みが発生するように設定する.
|
---|
112 | */
|
---|
113 | current = sil_rew_mem(OSTM_CNT(OSTM0_BASE));
|
---|
114 | sil_wrw_mem(OSTM_CMP(OSTM0_BASE), current + cnt);
|
---|
115 |
|
---|
116 | /*
|
---|
117 | * 上で現在のカウント値を読んで以降に,cnt以上カウントアップしてい
|
---|
118 | * た場合には,割込みを発生させる.
|
---|
119 | */
|
---|
120 | if (sil_rew_mem(OSTM_CNT(OSTM0_BASE)) - current >= cnt) {
|
---|
121 | raise_int(INTNO_OSTM0);
|
---|
122 | }
|
---|
123 | }
|
---|
124 |
|
---|
125 | /*
|
---|
126 | * 高分解能タイマ割込みの要求
|
---|
127 | */
|
---|
128 | void
|
---|
129 | target_hrt_raise_event(void)
|
---|
130 | {
|
---|
131 | raise_int(INTNO_OSTM0);
|
---|
132 | }
|
---|
133 |
|
---|
134 | /*
|
---|
135 | * タイマ割込みハンドラ
|
---|
136 | */
|
---|
137 | void
|
---|
138 | target_hrt_handler(void)
|
---|
139 | {
|
---|
140 | /*
|
---|
141 | * 高分解能タイマ割込みを処理する.
|
---|
142 | */
|
---|
143 | signal_time();
|
---|
144 | }
|
---|
145 | /*
|
---|
146 | * オーバランタイマドライバ
|
---|
147 | */
|
---|
148 | #ifdef TOPPERS_SUPPORT_OVRHDR
|
---|
149 |
|
---|
150 | /*
|
---|
151 | * オーバランタイマの初期化処理
|
---|
152 | */
|
---|
153 | void
|
---|
154 | target_ovrtimer_initialize(intptr_t exinf)
|
---|
155 | {
|
---|
156 | /*
|
---|
157 | * OSタイマをインターバルタイマモードに設定する.
|
---|
158 | */
|
---|
159 | sil_wrb_mem(OSTM_CTL(OSTM1_BASE), OSTM_CTL_INTERVAL);
|
---|
160 |
|
---|
161 | /*
|
---|
162 | * オーバランタイマ割込み要求をクリアする.
|
---|
163 | */
|
---|
164 | clear_int(INTNO_OSTM1);
|
---|
165 | }
|
---|
166 |
|
---|
167 | /*
|
---|
168 | * オーバランタイマの停止処理
|
---|
169 | */
|
---|
170 | void
|
---|
171 | target_ovrtimer_terminate(intptr_t exinf)
|
---|
172 | {
|
---|
173 | /*
|
---|
174 | * OSタイマを停止する.
|
---|
175 | */
|
---|
176 | sil_wrb_mem(OSTM_TT(OSTM1_BASE), OSTM_TT_STOP);
|
---|
177 |
|
---|
178 | /*
|
---|
179 | * オーバランタイマ割込み要求をクリアする.
|
---|
180 | */
|
---|
181 | clear_int(INTNO_OSTM1);
|
---|
182 | }
|
---|
183 |
|
---|
184 | /*
|
---|
185 | * オーバランタイマの停止
|
---|
186 | */
|
---|
187 | PRCTIM
|
---|
188 | target_ovrtimer_stop(void)
|
---|
189 | {
|
---|
190 | uint32_t cnt;
|
---|
191 |
|
---|
192 | /*
|
---|
193 | * OSタイマを停止する.
|
---|
194 | */
|
---|
195 | sil_wrb_mem(OSTM_TT(OSTM1_BASE), OSTM_TT_STOP);
|
---|
196 |
|
---|
197 | if (probe_int(INTNO_OSTM1)) {
|
---|
198 | /*
|
---|
199 | * 割込み要求が発生している場合
|
---|
200 | */
|
---|
201 | clear_int(INTNO_OSTM1);
|
---|
202 | return(0U);
|
---|
203 | }
|
---|
204 | else {
|
---|
205 | cnt = sil_rew_mem(OSTM_CNT(OSTM1_BASE));
|
---|
206 | return((PRCTIM)((cnt + 34) / 5 * 3 / 20));
|
---|
207 | }
|
---|
208 | }
|
---|
209 |
|
---|
210 | /*
|
---|
211 | * オーバランタイマの現在値の読出し
|
---|
212 | */
|
---|
213 | PRCTIM
|
---|
214 | target_ovrtimer_get_current(void)
|
---|
215 | {
|
---|
216 | uint32_t cnt;
|
---|
217 |
|
---|
218 | if (probe_int(INTNO_OSTM1)) {
|
---|
219 | /*
|
---|
220 | * 割込み要求が発生している場合
|
---|
221 | */
|
---|
222 | return(0U);
|
---|
223 | }
|
---|
224 | else {
|
---|
225 | cnt = sil_rew_mem(OSTM_CNT(OSTM1_BASE));
|
---|
226 | return((PRCTIM)((cnt + 34) / 5 * 3 / 20));
|
---|
227 | }
|
---|
228 | }
|
---|
229 |
|
---|
230 | /*
|
---|
231 | * オーバランタイマ割込みハンドラ
|
---|
232 | *
|
---|
233 | * このルーチンに来るまでに,target_ovrtimer_stopが呼ばれているため,
|
---|
234 | * OSタイマを停止する必要はない.
|
---|
235 | */
|
---|
236 | void
|
---|
237 | target_ovrtimer_handler(void)
|
---|
238 | {
|
---|
239 | call_ovrhdr(); /* オーバランハンドラの起動処理 */
|
---|
240 | }
|
---|
241 |
|
---|
242 | #endif /* TOPPERS_SUPPORT_OVRHDR */
|
---|