source: atk2-sc3_fl850f1l/kernel/counter.c@ 165

Last change on this file since 165 was 117, checked in by ertl-ishikawa, 9 years ago

ATK2-SC3 1.3.2 FL850F1L(RH850F1L)依存部(GCC/GHS/CCRH)を追加
File size: 12.8 KB
Line 
1/*
2 * TOPPERS ATK2
3 * Toyohashi Open Platform for Embedded Real-Time Systems
4 * Automotive Kernel Version 2
5 *
6 * Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
7 * Toyohashi Univ. of Technology, JAPAN
8 * Copyright (C) 2004-2015 by Center for Embedded Computing Systems
9 * Graduate School of Information Science, Nagoya Univ., JAPAN
10 * Copyright (C) 2011-2015 by FUJI SOFT INCORPORATED, JAPAN
11 * Copyright (C) 2011-2013 by Spansion LLC, USA
12 * Copyright (C) 2011-2015 by NEC Communication Systems, Ltd., JAPAN
13 * Copyright (C) 2011-2015 by Panasonic Advanced Technology Development Co., Ltd., JAPAN
14 * Copyright (C) 2011-2014 by Renesas Electronics Corporation, JAPAN
15 * Copyright (C) 2011-2015 by Sunny Giken Inc., JAPAN
16 * Copyright (C) 2011-2015 by TOSHIBA CORPORATION, JAPAN
17 * Copyright (C) 2004-2015 by Witz Corporation
18 * Copyright (C) 2014-2015 by AISIN COMCRUISE Co., Ltd., JAPAN
19 * Copyright (C) 2014-2015 by eSOL Co.,Ltd., JAPAN
20 * Copyright (C) 2014-2015 by SCSK Corporation, JAPAN
21 *
22 * 上記著作権者は，以下の(1)〜(4)の条件を満たす場合に限り，本ソフトウェ
23 * ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
24 * 変・再配布（以下，利用と呼ぶ）することを無償で許諾する．
25 * (1) 本ソフトウェアをソースコードの形で利用する場合には，上記の著作
26 * 権表示，この利用条件および下記の無保証規定が，そのままの形でソー
27 * スコード中に含まれていること．
28 * (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
29 * 用できる形で再配布する場合には，再配布に伴うドキュメント（利用
30 * 者マニュアルなど）に，上記の著作権表示，この利用条件および下記
31 * の無保証規定を掲載すること．
32 * (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
33 * 用できない形で再配布する場合には，次のいずれかの条件を満たすこ
34 * と．
35 * (a) 再配布に伴うドキュメント（利用者マニュアルなど）に，上記の著
36 * 作権表示，この利用条件および下記の無保証規定を掲載すること．
37 * (b) 再配布の形態を，別に定める方法によって，TOPPERSプロジェクトに
38 * 報告すること．
39 * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
40 * 害からも，上記著作権者およびTOPPERSプロジェクトを免責すること．
41 * また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
42 * 由に基づく請求からも，上記著作権者およびTOPPERSプロジェクトを
43 * 免責すること．
44 *
45 * 本ソフトウェアは，AUTOSAR（AUTomotive Open System ARchitecture）仕
46 * 様に基づいている．上記の許諾は，AUTOSARの知的財産権を許諾するもので
47 * はない．AUTOSARは，AUTOSAR仕様に基づいたソフトウェアを商用目的で利
48 * 用する者に対して，AUTOSARパートナーになることを求めている．
49 *
50 * 本ソフトウェアは，無保証で提供されているものである．上記著作権者お
51 * よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
52 * に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
53 * アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
54 * の責任を負わない．
55 *
56 * $Id: counter.c 187 2015-06-25 03:39:04Z t_ishikawa $
57 */
58
59/*
60 * カウンタ制御モジュール
61 */
62
63#include "kernel_impl.h"
64#include "task.h"
65#include "counter.h"
66
67/*
68 * トレースログマクロのデフォルト定義
69 */
70#ifndef LOG_INCCNT_ENTER
71#define LOG_INCCNT_ENTER(cntid)
72#endif /* LOG_INCCNT_ENTER */
73
74#ifndef LOG_INCCNT_LEAVE
75#define LOG_INCCNT_LEAVE(ercd)
76#endif /* LOG_INCCNT_LEAVE */
77
78#ifndef LOG_GETCNT_ENTER
79#define LOG_GETCNT_ENTER(cntid, p_val)
80#endif /* LOG_GETCNT_ENTER */
81
82#ifndef LOG_GETCNT_LEAVE
83#define LOG_GETCNT_LEAVE(ercd, val)
84#endif /* LOG_GETCNT_LEAVE */
85
86#ifndef LOG_GETECT_ENTER
87#define LOG_GETECT_ENTER(cntid, val, p_eval)
88#endif /* LOG_GETECT_ENTER */
89
90#ifndef LOG_GETECT_LEAVE
91#define LOG_GETECT_LEAVE(ercd, val, eval)
92#endif /* LOG_GETECT_LEAVE */
93
94/*
95 * カウンタ満了キューへの挿入
96 */
97#ifdef TOPPERS_insert_cnt_expr_que
98
99void
100insert_cnt_expr_que(CNTEXPINFO *p_cntexpinfo, CNTCB *p_cntcb)
101{
102 TickType enqval, curval;
103 QUEUE *next;
104 CounterType cntid;
105
106 enqval = p_cntexpinfo->expiretick;
107
108 /*
109 * カウンタ満了キューへの挿入位置を決定するための基準点
110 *
111 * ハードウェアカウンタの場合，カウンタ満了キューへの挿入位置を決める基準点は
112 * 満了処理時に更新している値を使用し，ハードウェアから現在値を取得はしない
113 * (ハードウェアカウンタ上のティック値は満了しているが，まだ満了処理を実行して
114 * いない場合に，挿入場所の基準がずれてしまうため)
115 */
116 curval = p_cntcb->curval;
117
118 /* 挿入場所のサーチ */
119 next = p_cntcb->cntexpque.p_next;
120
121 if (curval < enqval) {
122 /* カウンタのオーバーフローが起こらない場合 */
123 while ((next != &(p_cntcb->cntexpque)) &&
124 (curval <= ((CNTEXPINFO *) next)->expiretick) &&
125 (((CNTEXPINFO *) next)->expiretick <= enqval)) {
126 next = next->p_next;
127 }
128 }
129 else {
130 /* カウンタのオーバーフローが起こる場合 */
131 while ((next != &(p_cntcb->cntexpque)) &&
132 ((curval <= ((CNTEXPINFO *) next)->expiretick)
133 || (((CNTEXPINFO *) next)->expiretick <= enqval))) {
134 next = next->p_next;
135 }
136 }
137
138 queue_insert_prev(next, &(p_cntexpinfo->cntexpque));
139
140 /*
141 * ハードウェアカウンタかつ先頭に挿入した場合,再度ハードウェアカウンタに
142 * 満了時間を設定し直す必要がある
143 */
144 cntid = CNTID(p_cntcb);
145 if (is_hwcnt(cntid) && (p_cntcb->cntexpque.p_next == &(p_cntexpinfo->cntexpque))) {
146
147 /* 現在設定されている時刻をキャンセル */
148 (hwcntinib_table[cntid].cancel)();
149
150 /* 先頭に挿入した時刻に再設定 */
151 (hwcntinib_table[cntid].set)(enqval);
152 p_cntcb->hwset = TRUE;
153
154 /*
155 * 再設定中に次の満了時間を過ぎてしまったかチェック
156 *
157 * 過ぎてしまった場合, 強制割込みにより満了処理を実行する
158 * またsetした時間とgetした時間が同じであった場合,
159 * ハードウェアで取りこぼしていると想定し, 強制割込みを発生させる
160 * ハードウェアで取りこぼしていない場合に強制割込みを起こしても問題ない
161 */
162 if (diff_tick((hwcntinib_table[cntid].get)(), enqval,
163 p_cntcb->p_cntinib->maxval2) <= p_cntcb->p_cntinib->maxval) {
164 /* 現在設定されている時刻をキャンセル */
165 (hwcntinib_table[cntid].cancel)();
166 /* 強制割込みを発生させる */
167 (hwcntinib_table[cntid].trigger)();
168 }
169 }
170}
171
172#endif /* TOPPERS_insert_cnt_expr_que */
173
174/*
175 * カウンタ満了キューから削除
176 */
177#ifdef TOPPERS_delete_cnt_expr_que
178
179void
180delete_cnt_expr_que(CNTEXPINFO *p_cntexpinfo, CNTCB *p_cntcb)
181{
182 CounterType cntid;
183 QUEUE *p_cntexpque;
184
185 /* カウンタキューから満了処理を削除する前の先頭キュー保持 */
186 p_cntexpque = p_cntcb->cntexpque.p_next;
187
188 queue_delete(&(p_cntexpinfo->cntexpque));
189 queue_initialize(&(p_cntexpinfo->cntexpque));
190
191 /*
192 * ハードウェアカウンタかつ削除する満了処理はカウンタ満了の
193 * 先頭の場合，タイマをキャンセルする
194 */
195 cntid = CNTID(p_cntcb);
196 if (is_hwcnt(cntid) && (p_cntcb->cntexpque.p_next != p_cntexpque)) {
197
198 /* 現在設定されている時刻をキャンセル */
199 (hwcntinib_table[cntid].cancel)();
200
201 /* ペンディング中の割込み要求をキャンセル */
202 (hwcntinib_table[cntid].intcancel)();
203
204 /*
205 * p_cntexpinfoで指定された満了処理削除後，カウンタ満了次の
206 * 満了処理の満了点を設定する
207 */
208 if (queue_empty(&(p_cntcb->cntexpque)) == FALSE) {
209
210 /* 先頭に挿入した時刻に再設定 */
211 (hwcntinib_table[cntid].set)(((CNTEXPINFO *) p_cntcb->cntexpque.p_next)->expiretick);
212 p_cntcb->hwset = TRUE;
213
214 /*
215 * 再設定中に次の満了時間を過ぎてしまったかチェック
216 *
217 * 過ぎてしまった場合, 強制割込みにより満了処理を実行する
218 * またsetした時間とgetした時間が同じであった場合,
219 * ハードウェアで取りこぼしていると想定し, 強制割込みを発生させる
220 * ハードウェアで取りこぼしていない場合に強制割込みを起こしても問題ない
221 */
222 if (diff_tick((hwcntinib_table[cntid].get)(),
223 ((CNTEXPINFO *) p_cntcb->cntexpque.p_next)->expiretick,
224 p_cntcb->p_cntinib->maxval2) <= p_cntcb->p_cntinib->maxval) {
225 /* 現在設定されている時刻をキャンセル */
226 (hwcntinib_table[cntid].cancel)();
227 /* 強制割込みを発生させる */
228 (hwcntinib_table[cntid].trigger)();
229 }
230 }
231 }
232
233}
234
235#endif /* TOPPERS_delete_cnt_expr_que */
236
237/*
238 * カウンタ機能の初期化
239 */
240#ifdef TOPPERS_counter_initialize
241
242void
243counter_initialize(void)
244{
245 CounterType i;
246 CNTCB *p_cntcb;
247
248 for (i = 0U; i < tnum_counter; i++) {
249 p_cntcb = &(cntcb_table[i]);
250 p_cntcb->p_cntinib = &(cntinib_table[i]);
251 p_cntcb->curval = 0U;
252 p_cntcb->p_prevcntcb = NULL;
253 queue_initialize(&(p_cntcb->cntexpque));
254 p_cntcb->cstat = CS_NULL;
255 }
256
257 for (i = 0U; i < tnum_hardcounter; i++) {
258 (hwcntinib_table[i].init)(cntinib_table[i].maxval2,
259 hwcntinib_table[i].nspertick);
260 (hwcntinib_table[i].start)();
261 }
262
263}
264
265#endif /* TOPPERS_counter_initialize */
266
267/*
268 * カウンタ機能の終了処理
269 */
270#ifdef TOPPERS_counter_terminate
271
272void
273counter_terminate(void)
274{
275 CounterType i;
276
277 for (i = 0U; i < tnum_hardcounter; i++) {
278 (hwcntinib_table[i].stop)();
279 }
280}
281
282#endif /* TOPPERS_counter_terminate */
283
284/*
285 * 指定した相対時間からのカウンタ値取得(APIからの取得)
286 *
287 * 指定したカウンタの現在値と, 渡された相対値を足しこみ更新値を
288 * 戻り値として返す
289 */
290#ifdef TOPPERS_get_reltick
291
292TickType
293get_reltick(const CNTCB *p_cntcb, TickType relval)
294{
295 CounterType cntid;
296 TickType result;
297 TickType curval;
298
299 cntid = CNTID(p_cntcb);
300
301 curval = get_curval(p_cntcb, cntid);
302
303 /* 現在時間から指定されたオフセット分過ぎた時間を算出する */
304 result = add_tick(curval, relval, p_cntcb->p_cntinib->maxval2);
305
306 return(result);
307}
308
309#endif /* TOPPERS_get_reltick */
310
311/*
312 * 指定した絶対時間からのカウンタ値取得(APIからの取得)
313 *
314 * 引数で渡された絶対値を指定したカウンタの現在値に変換し
315 * 更新値を戻り値として返す
316 */
317#ifdef TOPPERS_get_abstick
318
319TickType
320get_abstick(const CNTCB *p_cntcb, TickType absval)
321{
322 CounterType cntid;
323 TickType result;
324 TickType curval;
325 TickType nextval;
326
327 cntid = CNTID(p_cntcb);
328
329 curval = get_curval(p_cntcb, cntid);
330
331 /* maxval2を考慮した絶対時間に変換 */
332 nextval = absval + p_cntcb->p_cntinib->maxval + 1U;
333
334 if (curval < (p_cntcb->p_cntinib->maxval + 1U)) {
335 /*
336 * カウンタの現在値が0〜maxvalの間の場合，
337 * 絶対時刻に未到達なので，絶対時刻を返す
338 */
339 if (absval > curval) {
340 result = absval;
341 }
342 else {
343 result = nextval;
344 }
345 }
346 else {
347 /*
348 * カウンタの現在値がmaxval〜maxval2の間の場合，
349 * maxval2考慮した絶対も超えたので，絶対時刻を返す
350 */
351 if (nextval <= curval) {
352 result = absval;
353 }
354 else {
355 result = nextval;
356 }
357 }
358
359 return(result);
360}
361
362#endif /* TOPPERS_get_abstick */
363
364/*
365 * カウンタの満了処理
366 */
367#ifdef TOPPERS_expire_process
368
369void
370expire_process(CNTCB *p_cntcb, CounterType cntid)
371{
372 CNTEXPINFO *p_cntexpinfo;
373 TickType nowval;
374
375 p_cntcb->hwset = FALSE;
376 nowval = get_curval(p_cntcb, cntid);
377
378 /*
379 * カウンタの満了処理
380 *
381 * キューが空でなく, リアルタイムな現在時間から見てキューの先頭の満了
382 * 時間が既に過ぎていれば, 満了処理を実行する
383 *
384 * リアルタイムな現在時間をその都度取得するため,キューの先頭満了処理
385 * の満了時間を再設定する時に目的の満了時間を超えてしまってもカバー
386 * できる
387 */
388 while ((queue_empty(&(p_cntcb->cntexpque)) == FALSE) &&
389 (diff_tick(nowval, ((CNTEXPINFO *) p_cntcb->cntexpque.p_next)->expiretick,
390 p_cntcb->p_cntinib->maxval2) <= p_cntcb->p_cntinib->maxval)) {
391
392 /* カウンタ満了キューの先頭の満了処理を，キューから外す */
393 p_cntexpinfo = (CNTEXPINFO *) p_cntcb->cntexpque.p_next;
394 queue_delete(&(p_cntexpinfo->cntexpque));
395 queue_initialize(&(p_cntexpinfo->cntexpque));
396
397 if (is_hwcnt(cntid)) {
398 /*
399 * カウンタ値を満了処理の満了点で更新し，満了処理キューに満了点を
400 * 挿入する時，満了処理キューの挿入位置比較に使用
401 */
402 p_cntcb->curval = p_cntexpinfo->expiretick;
403
404 /*
405 * 次の満了点の設定
406 * 次の満了点が実時間を経過していない場合設定する
407 */
408 if ((queue_empty(&(p_cntcb->cntexpque)) == FALSE) && ((diff_tick((hwcntinib_table[cntid].get)(),
409 ((CNTEXPINFO *) p_cntcb->cntexpque.p_next)->expiretick, p_cntcb->p_cntinib->maxval2)) >
410 p_cntcb->p_cntinib->maxval)) {
411 (hwcntinib_table[cntid].set)(((CNTEXPINFO *) p_cntcb->cntexpque.p_next)->expiretick);
412 p_cntcb->hwset = TRUE;
413 }
414 }
415
416 /* カウンタ満了処理呼出し */
417 (p_cntexpinfo->expirefunc)(p_cntexpinfo, p_cntcb);
418
419 /*
420 * タスクからの呼び出し時，高優先度タスクレディ状態になった場合あるので，
421 * チェックしてディスパッチする
422 */
423 if ((p_runtsk != p_schedtsk) && (callevel_stat == TCL_TASK)) {
424 dispatch();
425 }
426
427 /*
428 * 割込みレスポンス考慮し，1個の満了点処理後に
429 * 1回の割込許可/禁止を実施
430 */
431 x_nested_unlock_os_int();
432 x_nested_lock_os_int();
433
434 nowval = get_curval(p_cntcb, cntid);
435 }
436
437 if (is_hwcnt(cntid) && (queue_empty(&(p_cntcb->cntexpque)) == FALSE) && (p_cntcb->hwset == FALSE)) {
438 (hwcntinib_table[cntid].set)(((CNTEXPINFO *) p_cntcb->cntexpque.p_next)->expiretick);
439 }
440}
441#endif /* TOPPERS_expire_process */
442
443/*
444 * OSAP所属するカウンタの強制終了
445 */
446#ifdef TOPPERS_force_term_osap_counter
447
448void
449force_term_osap_counter(OSAPCB *p_osapcb)
450{
451 CounterType i;
452 CNTCB *p_cntcb;
453
454 /* 状態をクリアする */
455 /* 現在値を0に初期化する */
456 for (i = 0U; i < tnum_counter; i++) {
457 if (cntinib_table[i].p_osapcb == p_osapcb) {
458 p_cntcb = &cntcb_table[i];
459 p_cntcb->curval = 0U;
460 p_cntcb->cstat = CS_NULL;
461 }
462 }
463}
464
465#endif /* TOPPERS_force_term_osap_counter */
Note: See TracBrowser for help on using the repository browser.