source: atk2-sc3_fl850f1l/kernel/counter_manage.c@ 117

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

ATK2-SC3 1.3.2 FL850F1L(RH850F1L)依存部(GCC/GHS/CCRH)を追加
File size: 11.0 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_manage.c 187 2015-06-25 03:39:04Z t_ishikawa $
57 */
58
59/*
60 * カウンタ管理モジュール
61 */
62
63#include "kernel_impl.h"
64#include "check.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)
80#endif /* LOG_GETCNT_ENTER */
81
82#ifndef LOG_GETCNT_LEAVE
83#define LOG_GETCNT_LEAVE(ercd, p_val)
84#endif /* LOG_GETCNT_LEAVE */
85
86#ifndef LOG_GETEPS_ENTER
87#define LOG_GETEPS_ENTER(cntid, p_val)
88#endif /* LOG_GETEPS_ENTER */
89
90#ifndef LOG_GETEPS_LEAVE
91#define LOG_GETEPS_LEAVE(ercd, p_val, p_eval)
92#endif /* LOG_GETEPS_LEAVE */
93
94/*
95 * カウンタのインクリメント
96 */
97#ifdef TOPPERS_IncrementCounter
98
99StatusType
100IncrementCounter(CounterType CounterID)
101{
102 StatusType ercd = E_OK;
103 CNTCB *p_cntcb;
104 OSAPCB *p_osapcb;
105
106 CHECK_DISABLEDINT();
107 CHECK_CALLEVEL(CALLEVEL_INCREMENTCOUNTER);
108 CHECK_ID(CounterID < tnum_counter);
109 CHECK_ID(CounterID >= tnum_hardcounter);
110
111 p_cntcb = get_cntcb(CounterID);
112 CHECK_RIGHT(p_cntcb->p_cntinib->acsbtmp);
113
114 p_osapcb = p_cntcb->p_cntinib->p_osapcb;
115 x_nested_lock_os_int();
116
117 /* カウンタ所属のOSAPの状態をチェック */
118 D_CHECK_ACCESS((p_osapcb->osap_stat == APPLICATION_ACCESSIBLE) ||
119 ((p_osapcb->osap_stat == APPLICATION_RESTARTING) &&
120 (p_osapcb == p_runosap)));
121
122 /*
123 * カウンタのインクリメント
124 * エラーの場合はincr_counter_processでエラーフック呼び出しているので，
125 * ここでは，エラーフックを呼び出さない
126 */
127 ercd = incr_counter_process(p_cntcb, CounterID);
128
129 d_exit_no_errorhook:
130 x_nested_unlock_os_int();
131 exit_no_errorhook:
132 return(ercd);
133
134#ifdef CFG_USE_ERRORHOOK
135 exit_errorhook:
136 x_nested_lock_os_int();
137 d_exit_errorhook:
138#ifdef CFG_USE_PARAMETERACCESS
139 _errorhook_par1.cntid = CounterID;
140#endif /* CFG_USE_PARAMETERACCESS */
141 call_errorhook(ercd, OSServiceId_IncrementCounter);
142 goto d_exit_no_errorhook;
143#endif /* CFG_USE_ERRORHOOK */
144}
145
146#endif /* TOPPERS_IncrementCounter */
147
148/*
149 * カウンタ値の参照
150 */
151#ifdef TOPPERS_GetCounterValue
152
153StatusType
154GetCounterValue(CounterType CounterID, TickRefType Value)
155{
156 StatusType ercd = E_OK;
157 CNTCB *p_cntcb;
158 TickType curval;
159 OSAPCB *p_osapcb;
160
161 LOG_GETCNT_ENTER(CounterID);
162 CHECK_DISABLEDINT();
163 CHECK_CALLEVEL(CALLEVEL_GETCOUNTERVALUE);
164 CHECK_ID(CounterID < tnum_counter);
165 CHECK_PARAM_POINTER(Value);
166 CHECK_MEM_WRITE(Value, TickType);
167 p_cntcb = get_cntcb(CounterID);
168 CHECK_RIGHT(p_cntcb->p_cntinib->acsbtmp);
169
170 /*
171 * 内部処理のため，コンフィギュレーション設定値の２倍＋１までカウント
172 * アップするのでカウンタ値が設定値よりも大きい場合は設定値を減算する
173 *
174 * *Value を直接操作してもよいが,局所変数がレジスタに割当てられること
175 * による速度を期待している
176 */
177 p_osapcb = p_cntcb->p_cntinib->p_osapcb;
178 x_nested_lock_os_int();
179
180 /* カウンタ所属のOSAPの状態をチェック */
181 D_CHECK_ACCESS((p_osapcb->osap_stat == APPLICATION_ACCESSIBLE) ||
182 ((p_osapcb->osap_stat == APPLICATION_RESTARTING) &&
183 (p_osapcb == p_runosap)));
184
185 curval = get_curval(p_cntcb, CounterID);
186 x_nested_unlock_os_int();
187
188 if (curval > p_cntcb->p_cntinib->maxval) {
189 curval -= (p_cntcb->p_cntinib->maxval + 1U);
190 }
191 *Value = curval;
192
193 exit_no_errorhook:
194 LOG_GETCNT_LEAVE(ercd, Value);
195 return(ercd);
196
197#ifdef CFG_USE_ERRORHOOK
198 exit_errorhook:
199 x_nested_lock_os_int();
200 d_exit_errorhook:
201#ifdef CFG_USE_PARAMETERACCESS
202 _errorhook_par1.cntid = CounterID;
203 _errorhook_par2.p_val = Value;
204#endif /* CFG_USE_PARAMETERACCESS */
205 call_errorhook(ercd, OSServiceId_GetCounterValue);
206#endif /* CFG_USE_ERRORHOOK */
207 d_exit_no_errorhook:
208 x_nested_unlock_os_int();
209 goto exit_no_errorhook;
210}
211
212#endif /* TOPPERS_GetCounterValue */
213
214/*
215 * 経過カウンタ値の参照
216 */
217#ifdef TOPPERS_GetElapsedValue
218
219StatusType
220GetElapsedValue(CounterType CounterID, TickRefType Value, TickRefType ElapsedValue)
221{
222 StatusType ercd = E_OK;
223 CNTCB *p_cntcb;
224 TickType curval;
225 OSAPCB *p_osapcb;
226
227 LOG_GETEPS_ENTER(CounterID, Value);
228 CHECK_DISABLEDINT();
229 CHECK_CALLEVEL(CALLEVEL_GETELAPSEDVALUE);
230 CHECK_ID(CounterID < tnum_counter);
231 CHECK_PARAM_POINTER(Value);
232 CHECK_PARAM_POINTER(ElapsedValue);
233 CHECK_MEM_RW(Value, TickType);
234 CHECK_MEM_WRITE(ElapsedValue, TickType);
235 p_cntcb = get_cntcb(CounterID);
236 CHECK_RIGHT(p_cntcb->p_cntinib->acsbtmp);
237
238 CHECK_VALUE(*Value <= p_cntcb->p_cntinib->maxval);
239
240 /*
241 * 内部処理のため，コンフィギュレーション設定値の２倍＋１までカウント
242 * アップするのでカウンタ値が設定値よりも大きい場合は設定値を減算する
243 */
244 p_osapcb = p_cntcb->p_cntinib->p_osapcb;
245 x_nested_lock_os_int();
246
247 /* カウンタ所属のOSAPの状態をチェック */
248 D_CHECK_ACCESS((p_osapcb->osap_stat == APPLICATION_ACCESSIBLE) ||
249 ((p_osapcb->osap_stat == APPLICATION_RESTARTING) &&
250 (p_osapcb == p_runosap)));
251
252 curval = get_curval(p_cntcb, CounterID);
253 x_nested_unlock_os_int();
254
255 if (curval > p_cntcb->p_cntinib->maxval) {
256 curval -= (p_cntcb->p_cntinib->maxval + 1U);
257 }
258 *ElapsedValue = diff_tick(curval, *Value, p_cntcb->p_cntinib->maxval);
259 *Value = curval;
260
261 exit_no_errorhook:
262 LOG_GETEPS_LEAVE(ercd, Value, ElapsedValue);
263 return(ercd);
264
265#ifdef CFG_USE_ERRORHOOK
266 exit_errorhook:
267 x_nested_lock_os_int();
268 d_exit_errorhook:
269#ifdef CFG_USE_PARAMETERACCESS
270 _errorhook_par1.cntid = CounterID;
271 _errorhook_par2.p_val = Value;
272 _errorhook_par3.p_eval = ElapsedValue;
273#endif /* CFG_USE_PARAMETERACCESS */
274 call_errorhook(ercd, OSServiceId_GetElapsedValue);
275#endif /* CFG_USE_ERRORHOOK */
276 d_exit_no_errorhook:
277 x_nested_unlock_os_int();
278 goto exit_no_errorhook;
279}
280
281#endif /* TOPPERS_GetElapsedValue */
282
283/*
284 * ハードウェアカウンタ満了処理
285 *
286 * 割込みルーチンより実行される
287 */
288#ifdef TOPPERS_notify_hardware_counter
289
290void
291notify_hardware_counter(CounterType cntid)
292{
293 CNTCB *p_cntcb;
294
295 p_cntcb = get_cntcb(cntid);
296
297 /* カウンタ満了処理中はOS割込みを禁止 */
298 x_nested_lock_os_int();
299
300 /*
301 * ハードウェアカウンタに対応するC2ISRが起動した際に，
302 * 割込み要求のクリア処理を実行する
303 */
304 (hwcntinib_table[cntid].intclear)();
305
306 expire_process(p_cntcb, cntid);
307
308 x_nested_unlock_os_int();
309}
310
311#endif /* TOPPERS_notify_hardware_counter */
312
313/*
314 * カウンタのインクリメント
315 *
316 * 条件：割込み禁止状態で呼ばれる
317 */
318#ifdef TOPPERS_incr_counter_process
319
320StatusType
321incr_counter_process(CNTCB *p_cntcb, CounterType CounterID)
322{
323 StatusType ercd = E_OK;
324 TickType newval;
325
326 LOG_INCCNT_ENTER(CounterID);
327
328 /*
329 * カウンタが操作中(IncrementCounterのネスト）の場合エラー
330 * ※独自仕様
331 */
332 D_CHECK_STATE(p_cntcb->cstat == CS_NULL);
333
334 p_cntcb->cstat = CS_DOING;
335
336 newval = add_tick(p_cntcb->curval, 1U, p_cntcb->p_cntinib->maxval2);
337
338 p_cntcb->curval = newval;
339
340 if (p_runisr == NULL) {
341 p_cntcb->p_prevcntcb = p_runtsk->p_lastcntcb;
342 p_runtsk->p_lastcntcb = p_cntcb;
343 }
344
345 expire_process(p_cntcb, CounterID);
346
347 if (p_runisr == NULL) {
348 p_runtsk->p_lastcntcb = p_cntcb->p_prevcntcb;
349 }
350
351 p_cntcb->cstat = CS_NULL;
352
353 d_exit_no_errorhook:
354 LOG_INCCNT_LEAVE(ercd);
355 return(ercd);
356
357#ifdef CFG_USE_ERRORHOOK
358 d_exit_errorhook:
359#ifdef CFG_USE_PARAMETERACCESS
360 _errorhook_par1.cntid = CounterID;
361#endif /* CFG_USE_PARAMETERACCESS */
362 call_errorhook(ercd, OSServiceId_IncrementCounter);
363 goto d_exit_no_errorhook;
364#endif /* CFG_USE_ERRORHOOK */
365}
366
367#endif /* TOPPERS_incr_counter_process */
368
369/*
370 * アラーム満了によるカウンタのインクリメント
371 *
372 * 条件：割込み禁止状態で呼ばれる
373 */
374#ifdef TOPPERS_incr_counter_action
375
376StatusType
377incr_counter_action(OSAPCB *p_expire_osapcb, CounterType CounterID)
378{
379 StatusType ercd = E_OK;
380 CNTCB *p_cntcb;
381 OSAPCB *p_osapcb;
382
383 p_cntcb = get_cntcb(CounterID);
384 p_osapcb = p_cntcb->p_cntinib->p_osapcb;
385 /* 満了点所属のOSAP及びインクリメントカウンタ所属のOSAPの状態をチェック */
386 D_CHECK_ACCESS((p_osapcb->osap_stat == APPLICATION_ACCESSIBLE) || (p_expire_osapcb == p_osapcb));
387
388 ercd = incr_counter_process(p_cntcb, CounterID);
389
390 d_exit_no_errorhook:
391 return(ercd);
392
393#ifdef CFG_USE_ERRORHOOK
394 d_exit_errorhook:
395#ifdef CFG_USE_PARAMETERACCESS
396 _errorhook_par1.cntid = CounterID;
397#endif /* CFG_USE_PARAMETERACCESS */
398 call_errorhook(ercd, OSServiceId_IncrementCounter);
399 goto d_exit_no_errorhook;
400#endif /* CFG_USE_ERRORHOOK */
401}
402
403#endif /* TOPPERS_incr_counter_action */
Note: See TracBrowser for help on using the repository browser.