source: EcnlProtoTool/trunk/asp3_dcre/kernel/alarm.c@ 270

Last change on this file since 270 was 270, checked in by coas-nagasima, 7 years ago

mruby版ECNLプロトタイピング・ツールを追加
  • Property svn:eol-style set to native
  • Property svn:keywords set to Id
  • Property svn:mime-type set to text/x-csrc
File size: 9.6 KB
Line 
1/*
2 * TOPPERS/ASP Kernel
3 * Toyohashi Open Platform for Embedded Real-Time Systems/
4 * Advanced Standard Profile Kernel
5 *
6 * Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
7 * Toyohashi Univ. of Technology, JAPAN
8 * Copyright (C) 2005-2016 by Embedded and Real-Time Systems Laboratory
9 * Graduate School of Information Science, Nagoya Univ., JAPAN
10 *
11 * 上記著作権者
12は，以下の(1)～(4)の条件を満たす場合に限り，本ソフトウェ
13 * ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
14 * 変・再é…
15å¸ƒï¼ˆä»¥ä¸‹ï¼Œåˆ©ç”¨ã¨å‘¼ã¶ï¼‰ã™ã‚‹ã“とを無償で許諾する．
16 * (1) 本ソフトウェアをソースコードの形で利用する場合には，上記の著作
17 * 権表示，この利用条件および下記の無保証規定が，そのままの形でソー
18 * スコード中に含まれていること．
19 * (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
20 * 用できる形で再é…
21å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œå†é…
22å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨
23 * 者
24マニュアルなど）に，上記の著作権表示，この利用条件および下記
25 * の無保証規定を掲載すること．
26 * (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
27 * 用できない形で再é…
28å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œæ¬¡ã®ã„ずれかの条件を満たすこ
29 * と．
30 * (a) 再é…
31å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨è€…
32マニュアルなど）に，上記の著
33 * 作権表示，この利用条件および下記の無保証規定を掲載すること．
34 * (b) 再é…
35å¸ƒã®å½¢æ…
36‹ã‚’，別に定める方法によって，TOPPERSプロジェクトに
37 * 報告すること．
38 * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
39 * 害からも，上記著作権者
40およびTOPPERSプロジェクトをå…
41è²¬ã™ã‚‹ã“と．
42 * また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
43 * 由に基づく請求からも，上記著作権者
44およびTOPPERSプロジェクトを
45 * å…
46è²¬ã™ã‚‹ã“と．
47 *
48 * 本ソフトウェアは，無保証で提供されているものである．上記著作権者
49お
50 * よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
51 * に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
52 * アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
53 * の責任を負わない．
54 *
55 * $Id: alarm.c 270 2017-02-09 04:03:47Z coas-nagasima $
56 */
57
58/*
59 * アラーム通知機能
60 */
61
62#include "kernel_impl.h"
63#include "check.h"
64#include "alarm.h"
65
66/*
67 * トレースログマクロのデフォルト定義
68 */
69#ifndef LOG_ALM_ENTER
70#define LOG_ALM_ENTER(p_almcb)
71#endif /* LOG_ALM_ENTER */
72
73#ifndef LOG_ALM_LEAVE
74#define LOG_ALM_LEAVE(p_almcb)
75#endif /* LOG_ALM_LEAVE */
76
77#ifndef LOG_ACRE_ALM_ENTER
78#define LOG_ACRE_ALM_ENTER(pk_calm)
79#endif /* LOG_ACRE_ALM_ENTER */
80
81#ifndef LOG_ACRE_ALM_LEAVE
82#define LOG_ACRE_ALM_LEAVE(ercd)
83#endif /* LOG_ACRE_ALM_LEAVE */
84
85#ifndef LOG_DEL_ALM_ENTER
86#define LOG_DEL_ALM_ENTER(almid)
87#endif /* LOG_DEL_ALM_ENTER */
88
89#ifndef LOG_DEL_ALM_LEAVE
90#define LOG_DEL_ALM_LEAVE(ercd)
91#endif /* LOG_DEL_ALM_LEAVE */
92
93#ifndef LOG_STA_ALM_ENTER
94#define LOG_STA_ALM_ENTER(almid, almtim)
95#endif /* LOG_STA_ALM_ENTER */
96
97#ifndef LOG_STA_ALM_LEAVE
98#define LOG_STA_ALM_LEAVE(ercd)
99#endif /* LOG_STA_ALM_LEAVE */
100
101#ifndef LOG_STP_ALM_ENTER
102#define LOG_STP_ALM_ENTER(almid)
103#endif /* LOG_STP_ALM_ENTER */
104
105#ifndef LOG_STP_ALM_LEAVE
106#define LOG_STP_ALM_LEAVE(ercd)
107#endif /* LOG_STP_ALM_LEAVE */
108
109#ifndef LOG_REF_ALM_ENTER
110#define LOG_REF_ALM_ENTER(almid, pk_ralm)
111#endif /* LOG_REF_ALM_ENTER */
112
113#ifndef LOG_REF_ALM_LEAVE
114#define LOG_REF_ALM_LEAVE(ercd, pk_ralm)
115#endif /* LOG_REF_ALM_LEAVE */
116
117/*
118 * アラーム通知の数
119 */
120#define tnum_alm ((uint_t)(tmax_almid - TMIN_ALMID + 1))
121#define tnum_salm ((uint_t)(tmax_salmid - TMIN_ALMID + 1))
122
123/*
124 * アラーム通知IDからアラーム通知管理ブロックを取り出すためのマクロ
125 */
126#define INDEX_ALM(almid) ((uint_t)((almid) - TMIN_ALMID))
127#define get_almcb(almid) (&(almcb_table[INDEX_ALM(almid)]))
128
129#ifdef TOPPERS_almini
130
131/*
132 * 使用していないアラーム通知管理ブロックのリスト
133 *
134 * アラーム通知管理ブロックのå…
135ˆé ­ã«ã¯ã‚­ãƒ¥ãƒ¼ã«ã¤ãªããŸã‚ã®é ˜åŸŸãŒãªã„た
136 * め，タイムイベントブロック（tmevtb）の領域を用いる．
137 */
138QUEUE free_almcb;
139
140/*
141 * アラーム通知機能の初期化
142 */
143void
144initialize_alarm(void)
145{
146 uint_t i, j;
147 ALMCB *p_almcb;
148 ALMINIB *p_alminib;
149
150 for (i = 0; i < tnum_salm; i++) {
151 p_almcb = &(almcb_table[i]);
152 p_almcb->p_alminib = &(alminib_table[i]);
153 p_almcb->almsta = false;
154 p_almcb->tmevtb.callback = (CBACK) call_alarm;
155 p_almcb->tmevtb.arg = (void *) p_almcb;
156 }
157 queue_initialize(&free_almcb);
158 for (j = 0; i < tnum_alm; i++, j++) {
159 p_almcb = &(almcb_table[i]);
160 p_alminib = &(aalminib_table[j]);
161 p_alminib->almatr = TA_NOEXS;
162 p_almcb->p_alminib = ((const ALMINIB *) p_alminib);
163 p_almcb->tmevtb.callback = (CBACK) call_alarm;
164 p_almcb->tmevtb.arg = (void *) p_almcb;
165 queue_insert_prev(&free_almcb, ((QUEUE *) &(p_almcb->tmevtb)));
166 }
167}
168
169#endif /* TOPPERS_almini */
170
171/*
172 * アラーム通知の生成
173 */
174#ifdef TOPPERS_acre_alm
175
176ER_UINT
177acre_alm(const T_CALM *pk_calm)
178{
179 ALMCB *p_almcb;
180 ALMINIB *p_alminib;
181 ATR almatr;
182 T_NFYINFO nfyinfo, *p_nfyinfo;
183 ER ercd, rercd;
184
185 LOG_ACRE_ALM_ENTER(pk_calm);
186 CHECK_TSKCTX_UNL();
187
188 almatr = pk_calm->almatr;
189 nfyinfo = pk_calm->nfyinfo;
190
191 CHECK_RSATR(almatr, TA_NULL);
192 rercd = check_nfyinfo(&nfyinfo);
193 if (rercd != E_OK) {
194 ercd = rercd;
195 goto error_exit;
196 }
197
198 lock_cpu();
199 if (tnum_alm == 0 || queue_empty(&free_almcb)) {
200 ercd = E_NOID;
201 }
202 else {
203 p_almcb = ((ALMCB *)(((char *) queue_delete_next(&free_almcb))
204 - offsetof(ALMCB, tmevtb)));
205 p_alminib = (ALMINIB *)(p_almcb->p_alminib);
206 p_alminib->almatr = almatr;
207 if (nfyinfo.nfymode == TNFY_HANDLER) {
208 p_alminib->exinf = nfyinfo.nfy.handler.exinf;
209 p_alminib->nfyhdr = (NFYHDR)(nfyinfo.nfy.handler.tmehdr);
210 }
211 else {
212 p_nfyinfo = &aalm_nfyinfo_table[p_alminib - aalminib_table];
213 *p_nfyinfo = nfyinfo;
214 p_alminib->exinf = (intptr_t) p_nfyinfo;
215 p_alminib->nfyhdr = notify_handler;
216 }
217 p_almcb->almsta = false;
218 ercd = ALMID(p_almcb);
219 }
220 unlock_cpu();
221
222 error_exit:
223 LOG_ACRE_ALM_LEAVE(ercd);
224 return(ercd);
225}
226
227#endif /* TOPPERS_acre_alm */
228
229/*
230 * アラーム通知の削除
231 */
232#ifdef TOPPERS_del_alm
233
234ER
235del_alm(ID almid)
236{
237 ALMCB *p_almcb;
238 ALMINIB *p_alminib;
239 ER ercd;
240
241 LOG_DEL_ALM_ENTER(almid);
242 CHECK_TSKCTX_UNL();
243 CHECK_ID(VALID_ALMID(almid));
244 p_almcb = get_almcb(almid);
245
246 lock_cpu();
247 if (p_almcb->p_alminib->almatr == TA_NOEXS) {
248 ercd = E_NOEXS;
249 }
250 else if (almid <= tmax_salmid) {
251 ercd = E_OBJ;
252 }
253 else {
254 if (p_almcb->almsta) {
255 p_almcb->almsta = false;
256 tmevtb_dequeue(&(p_almcb->tmevtb));
257 }
258
259 p_alminib = (ALMINIB *)(p_almcb->p_alminib);
260 p_alminib->almatr = TA_NOEXS;
261 queue_insert_prev(&free_almcb, ((QUEUE *) &(p_almcb->tmevtb)));
262 ercd = E_OK;
263 }
264 unlock_cpu();
265
266 error_exit:
267 LOG_DEL_ALM_LEAVE(ercd);
268 return(ercd);
269}
270
271#endif /* TOPPERS_del_alm */
272
273/*
274 * アラーム通知の動作開始
275 */
276#ifdef TOPPERS_sta_alm
277
278ER
279sta_alm(ID almid, RELTIM almtim)
280{
281 ALMCB *p_almcb;
282 ER ercd;
283
284 LOG_STA_ALM_ENTER(almid, almtim);
285 CHECK_UNL();
286 CHECK_ID(VALID_ALMID(almid));
287 CHECK_PAR(VALID_RELTIM(almtim));
288 p_almcb = get_almcb(almid);
289
290 lock_cpu();
291 if (p_almcb->p_alminib->almatr == TA_NOEXS) {
292 ercd = E_NOEXS;
293 }
294 else {
295 if (p_almcb->almsta) {
296 tmevtb_dequeue(&(p_almcb->tmevtb));
297 }
298 else {
299 p_almcb->almsta = true;
300 }
301 tmevtb_enqueue(&(p_almcb->tmevtb), almtim);
302 ercd = E_OK;
303 }
304 unlock_cpu();
305
306 error_exit:
307 LOG_STA_ALM_LEAVE(ercd);
308 return(ercd);
309}
310
311#endif /* TOPPERS_sta_alm */
312
313/*
314 * アラーム通知の動作停止
315 */
316#ifdef TOPPERS_stp_alm
317
318ER
319stp_alm(ID almid)
320{
321 ALMCB *p_almcb;
322 ER ercd;
323
324 LOG_STP_ALM_ENTER(almid);
325 CHECK_UNL();
326 CHECK_ID(VALID_ALMID(almid));
327 p_almcb = get_almcb(almid);
328
329 lock_cpu();
330 if (p_almcb->p_alminib->almatr == TA_NOEXS) {
331 ercd = E_NOEXS;
332 }
333 else {
334 if (p_almcb->almsta) {
335 p_almcb->almsta = false;
336 tmevtb_dequeue(&(p_almcb->tmevtb));
337 }
338 ercd = E_OK;
339 }
340 unlock_cpu();
341
342 error_exit:
343 LOG_STP_ALM_LEAVE(ercd);
344 return(ercd);
345}
346
347#endif /* TOPPERS_stp_alm */
348
349/*
350 * アラーム通知の状æ…
351‹å‚ç…
352§
353 */
354#ifdef TOPPERS_ref_alm
355
356ER
357ref_alm(ID almid, T_RALM *pk_ralm)
358{
359 ALMCB *p_almcb;
360 ER ercd;
361
362 LOG_REF_ALM_ENTER(almid, pk_ralm);
363 CHECK_TSKCTX_UNL();
364 CHECK_ID(VALID_ALMID(almid));
365 p_almcb = get_almcb(almid);
366
367 lock_cpu();
368 if (p_almcb->p_alminib->almatr == TA_NOEXS) {
369 ercd = E_NOEXS;
370 }
371 else {
372 if (p_almcb->almsta) {
373 pk_ralm->almstat = TALM_STA;
374 pk_ralm->lefttim = tmevt_lefttim(&(p_almcb->tmevtb));
375 }
376 else {
377 pk_ralm->almstat = TALM_STP;
378 }
379 ercd = E_OK;
380 }
381 unlock_cpu();
382
383 error_exit:
384 LOG_REF_ALM_LEAVE(ercd, pk_ralm);
385 return(ercd);
386}
387
388#endif /* TOPPERS_ref_alm */
389
390/*
391 * アラーム通知起動ルーチン
392 */
393#ifdef TOPPERS_almcal
394
395void
396call_alarm(ALMCB *p_almcb)
397{
398 /*
399 * アラーム通知を停止状æ…
400‹ã«ã™ã‚‹ï¼Ž
401 */
402 p_almcb->almsta = false;
403
404 /*
405 * 通知ハンドラを，CPUロック解除状æ…
406‹ã§å‘¼ã³å‡ºã™ï¼Ž
407 */
408 unlock_cpu();
409
410 LOG_ALM_ENTER(p_almcb);
411 (*(p_almcb->p_alminib->nfyhdr))(p_almcb->p_alminib->exinf);
412 LOG_ALM_LEAVE(p_almcb);
413
414 if (!sense_lock()) {
415 lock_cpu();
416 }
417}
418
419#endif /* TOPPERS_almcal */
Note: See TracBrowser for help on using the repository browser.