source: mypx/extension/dcre/kernel/alarm.c

このファイルの最終更新内容は 7 で kominami が 2015/09/12 9:22:12 に更新しました

TOPPERS/ASP 1.9.1
ファイルサイズ: 9.9 KB
Rev行 
[7]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-2014 by Embedded and Real-Time Systems Laboratory
9 *              Graduate School of Information Science, Nagoya Univ., JAPAN
10 *
11 *  Ÿåµ­Ãøºîž¢ŒÔ€Ï¡€°Ê²Œ€Î(1)¡Á(4)€ÎŸò·ï€òËþ€¿€¹Ÿì¹ç€ËžÂ€ê¡€ËÜ¥œ¥Õ¥È¥Š¥§
12 *  ¥¢¡ÊËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò²þÊÑ€·€¿€â€Î€òŽÞ€à¡¥°Ê²ŒÆ±€ž¡Ë€ò»ÈÍÑ¡ŠÊ£Àœ¡Š²þ
13 *  ÊÑ¡ŠºÆÇÛÉۡʰʲŒ¡€ÍøÍрȞƀ֡ˀ¹€ë€³€È€ò̵œþ€ÇµöÂú€¹€ë¡¥
14 *  (1) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò¥œ¡Œ¥¹¥³¡Œ¥É€Î·Á€ÇÍøÍÑ€¹€ëŸì¹ç€Ë€Ï¡€Ÿåµ­€ÎÃøºî
15 *      ž¢ÉœŒš¡€€³€ÎÍøÍÑŸò·ï€ª€è€Ó²Œµ­€Î̵ÊÝŸÚµ¬Äꀬ¡€€œ€Î€Þ€Þ€Î·Á€Ç¥œ¡Œ
16 *      ¥¹¥³¡Œ¥ÉÃæ€ËŽÞ€Þ€ì€Æ€€€ë€³€È¡¥
17 *  (2) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò¡€¥é¥€¥Ö¥é¥ê·ÁŒ°€Ê€É¡€ÂŸ€Î¥œ¥Õ¥È¥Š¥§¥¢³«È¯€Ë»È
18 *      Íрǀ­€ë·Á€ÇºÆÇÛÉÛ€¹€ëŸì¹ç€Ë€Ï¡€ºÆÇÛÉÛ€ËÈŒ€Š¥É¥­¥å¥á¥ó¥È¡ÊÍøÍÑ
19 *      ŒÔ¥Þ¥Ë¥å¥¢¥ë€Ê€É¡Ë€Ë¡€Ÿåµ­€ÎÃøºîž¢ÉœŒš¡€€³€ÎÍøÍÑŸò·ï€ª€è€Ó²Œµ­
20 *      €Î̵ÊÝŸÚµ¬Äê€ò·ÇºÜ€¹€ë€³€È¡¥
21 *  (3) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò¡€µ¡Žï€ËÁȀ߹þ€à€Ê€É¡€ÂŸ€Î¥œ¥Õ¥È¥Š¥§¥¢³«È¯€Ë»È
22 *      Íрǀ­€Ê€€·Á€ÇºÆÇÛÉÛ€¹€ëŸì¹ç€Ë€Ï¡€Œ¡€Î€€€º€ì€«€ÎŸò·ï€òËþ€¿€¹€³
23 *      €È¡¥
24 *    (a) ºÆÇÛÉÛ€ËÈŒ€Š¥É¥­¥å¥á¥ó¥È¡ÊÍøÍьԥޥ˥奢¥ë€Ê€É¡Ë€Ë¡€Ÿåµ­€ÎÃø
25 *        ºîž¢ÉœŒš¡€€³€ÎÍøÍÑŸò·ï€ª€è€Ó²Œµ­€Î̵ÊÝŸÚµ¬Äê€ò·ÇºÜ€¹€ë€³€È¡¥
26 *    (b) ºÆÇÛÉۀηÁÂÖ€ò¡€ÊÌ€ËÄê€á€ëÊýË¡€Ë€è€Ã€Æ¡€TOPPERS¥×¥í¥ž¥§¥¯¥È€Ë
27 *        Êó¹ð€¹€ë€³€È¡¥
28 *  (4) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ÎÍøÍрˀè€êÄŸÀÜŪ€Þ€¿€ÏŽÖÀÜŪ€ËÀž€ž€ë€€€«€Ê€ë»
29 *      ³²€«€é€â¡€Ÿåµ­Ãøºîž¢ŒÔ€ª€è€ÓTOPPERS¥×¥í¥ž¥§¥¯¥È€òÌÈÀÕ€¹€ë€³€È¡¥
30 *      €Þ€¿¡€ËÜ¥œ¥Õ¥È¥Š¥§¥¢€Î¥æ¡Œ¥¶€Þ€¿€Ï¥š¥ó¥É¥æ¡Œ¥¶€«€é€Î€€€«€Ê€ëÍý
31 *      ͳ€ËŽð€Å€¯ÀÁµá€«€é€â¡€Ÿåµ­Ãøºîž¢ŒÔ€ª€è€ÓTOPPERS¥×¥í¥ž¥§¥¯¥È€ò
32 *      ÌÈÀÕ€¹€ë€³€È¡¥
33 *
34 *  ËÜ¥œ¥Õ¥È¥Š¥§¥¢€Ï¡€ÌµÊÝŸÚ€ÇÄ󶡀µ€ì€Æ€€€ë€â€Î€Ç€¢€ë¡¥Ÿåµ­Ãøºîž¢ŒÔ€ª
35 *  €è€ÓTOPPERS¥×¥í¥ž¥§¥¯¥È€Ï¡€ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ËŽØ€·€Æ¡€ÆÃÄê€Î»ÈÍÑÌÜŪ
36 *  €ËÂЀ¹€ëŬ¹çÀ­€âŽÞ€á€Æ¡€€€€«€Ê€ëÊÝŸÚ€â¹Ô€ï€Ê€€¡¥€Þ€¿¡€ËÜ¥œ¥Õ¥È¥Š¥§
37 *  ¥¢€ÎÍøÍрˀè€êÄŸÀÜŪ€Þ€¿€ÏŽÖÀÜŪ€ËÀž€ž€¿€€€«€Ê€ë»³²€ËŽØ€·€Æ€â¡€€œ
38 *  €ÎÀÕÇ€€òÉé€ï€Ê€€¡¥
39 *
40 *  @(#) $Id$
41 */
42
43/*
44 *              ¥¢¥é¡Œ¥à¥Ï¥ó¥É¥éµ¡Çœ
45 */
46
47#include "kernel_impl.h"
48#include "check.h"
49#include "alarm.h"
50
51/*
52 *  ¥È¥ì¡Œ¥¹¥í¥°¥Þ¥¯¥í€Î¥Ç¥Õ¥©¥ë¥ÈÄêµÁ
53 */
54#ifndef LOG_ALM_ENTER
55#define LOG_ALM_ENTER(p_almcb)
56#endif /* LOG_ALM_ENTER */
57
58#ifndef LOG_ALM_LEAVE
59#define LOG_ALM_LEAVE(p_almcb)
60#endif /* LOG_ALM_LEAVE */
61
62#ifndef LOG_ACRE_ALM_ENTER
63#define LOG_ACRE_ALM_ENTER(pk_calm)
64#endif /* LOG_ACRE_ALM_ENTER */
65
66#ifndef LOG_ACRE_ALM_LEAVE
67#define LOG_ACRE_ALM_LEAVE(ercd)
68#endif /* LOG_ACRE_ALM_LEAVE */
69
70#ifndef LOG_DEL_ALM_ENTER
71#define LOG_DEL_ALM_ENTER(almid)
72#endif /* LOG_DEL_ALM_ENTER */
73
74#ifndef LOG_DEL_ALM_LEAVE
75#define LOG_DEL_ALM_LEAVE(ercd)
76#endif /* LOG_DEL_ALM_LEAVE */
77
78#ifndef LOG_STA_ALM_ENTER
79#define LOG_STA_ALM_ENTER(almid, almtim)
80#endif /* LOG_STA_ALM_ENTER */
81
82#ifndef LOG_STA_ALM_LEAVE
83#define LOG_STA_ALM_LEAVE(ercd)
84#endif /* LOG_STA_ALM_LEAVE */
85
86#ifndef LOG_ISTA_ALM_ENTER
87#define LOG_ISTA_ALM_ENTER(almid, almtim)
88#endif /* LOG_ISTA_ALM_ENTER */
89
90#ifndef LOG_ISTA_ALM_LEAVE
91#define LOG_ISTA_ALM_LEAVE(ercd)
92#endif /* LOG_ISTA_ALM_LEAVE */
93
94#ifndef LOG_STP_ALM_ENTER
95#define LOG_STP_ALM_ENTER(almid)
96#endif /* LOG_STP_ALM_ENTER */
97
98#ifndef LOG_STP_ALM_LEAVE
99#define LOG_STP_ALM_LEAVE(ercd)
100#endif /* LOG_STP_ALM_LEAVE */
101
102#ifndef LOG_ISTP_ALM_ENTER
103#define LOG_ISTP_ALM_ENTER(almid)
104#endif /* LOG_ISTP_ALM_ENTER */
105
106#ifndef LOG_ISTP_ALM_LEAVE
107#define LOG_ISTP_ALM_LEAVE(ercd)
108#endif /* LOG_ISTP_ALM_LEAVE */
109
110#ifndef LOG_REF_ALM_ENTER
111#define LOG_REF_ALM_ENTER(almid, pk_ralm)
112#endif /* LOG_REF_ALM_ENTER */
113
114#ifndef LOG_REF_ALM_LEAVE
115#define LOG_REF_ALM_LEAVE(ercd, pk_ralm)
116#endif /* LOG_REF_ALM_LEAVE */
117
118/*
119 *  ¥¢¥é¡Œ¥à¥Ï¥ó¥É¥é€Î¿ô
120 */
121#define tnum_alm        ((uint_t)(tmax_almid - TMIN_ALMID + 1))
122#define tnum_salm       ((uint_t)(tmax_salmid - TMIN_ALMID + 1))
123
124/*
125 *  ¥¢¥é¡Œ¥à¥Ï¥ó¥É¥éID€«€é¥¢¥é¡Œ¥à¥Ï¥ó¥É¥éŽÉÍý¥Ö¥í¥Ã¥¯€òŒè€êœÐ€¹€¿€á€Î¥Þ¥¯¥í
126 */
127#define INDEX_ALM(almid)        ((uint_t)((almid) - TMIN_ALMID))
128#define get_almcb(almid)        (&(almcb_table[INDEX_ALM(almid)]))
129
130#ifdef TOPPERS_almini
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        }
155        queue_initialize(&free_almcb);
156        for (j = 0; i < tnum_alm; i++, j++) {
157                p_almcb = &(almcb_table[i]);
158                p_alminib = &(aalminib_table[j]);
159                p_alminib->almatr = TA_NOEXS;
160                p_almcb->p_alminib = ((const ALMINIB *) p_alminib);
161                queue_insert_prev(&free_almcb, ((QUEUE *) &(p_almcb->tmevtb)));
162        }
163}
164
165#endif /* TOPPERS_almini */
166
167/*
168 *  ¥¢¥é¡Œ¥à¥Ï¥ó¥É¥é€ÎÀžÀ®
169 */
170#ifdef TOPPERS_acre_alm
171
172ER_UINT
173acre_alm(const T_CALM *pk_calm)
174{
175        ALMCB   *p_almcb;
176        ALMINIB *p_alminib;
177        ER              ercd;
178
179        LOG_ACRE_ALM_ENTER(pk_calm);
180        CHECK_TSKCTX_UNL();
181        CHECK_RSATR(pk_calm->almatr, TA_NULL);
182        CHECK_ALIGN_FUNC(pk_calm->almhdr);
183        CHECK_NONNULL_FUNC(pk_calm->almhdr);
184
185        t_lock_cpu();
186        if (tnum_alm == 0 || queue_empty(&free_almcb)) {
187                ercd = E_NOID;
188        }
189        else {
190                p_almcb = ((ALMCB *)(((char *) queue_delete_next(&free_almcb))
191                                                                                                - offsetof(ALMCB, tmevtb)));
192                p_alminib = (ALMINIB *)(p_almcb->p_alminib);
193                p_alminib->almatr = pk_calm->almatr;
194                p_alminib->exinf = pk_calm->exinf;
195                p_alminib->almhdr = pk_calm->almhdr;
196
197                p_almcb->almsta = false;
198                ercd = ALMID(p_almcb);
199        }
200        t_unlock_cpu();
201
202  error_exit:
203        LOG_ACRE_ALM_LEAVE(ercd);
204        return(ercd);
205}
206
207#endif /* TOPPERS_acre_alm */
208
209/*
210 *  ¥¢¥é¡Œ¥à¥Ï¥ó¥É¥é€Îºïœü
211 */
212#ifdef TOPPERS_del_alm
213
214ER
215del_alm(ID almid)
216{
217        ALMCB   *p_almcb;
218        ALMINIB *p_alminib;
219        ER              ercd;
220
221        LOG_DEL_ALM_ENTER(almid);
222        CHECK_TSKCTX_UNL();
223        CHECK_ALMID(almid);
224        p_almcb = get_almcb(almid);
225
226        t_lock_cpu();
227        if (p_almcb->p_alminib->almatr == TA_NOEXS) {
228                ercd = E_NOEXS;
229        }
230        else if (ALMID(p_almcb) > tmax_salmid) {
231                if (p_almcb->almsta) {
232                        p_almcb->almsta = false;
233                        tmevtb_dequeue(&(p_almcb->tmevtb));
234                }
235
236                p_alminib = (ALMINIB *)(p_almcb->p_alminib);
237                p_alminib->almatr = TA_NOEXS;
238                queue_insert_prev(&free_almcb, ((QUEUE *) &(p_almcb->tmevtb)));
239                ercd = E_OK;
240        }
241        else {
242                ercd = E_OBJ;
243        }
244        t_unlock_cpu();
245
246  error_exit:
247        LOG_DEL_ALM_LEAVE(ercd);
248        return(ercd);
249}
250
251#endif /* TOPPERS_del_alm */
252
253/*
254 *  ¥¢¥é¡Œ¥à¥Ï¥ó¥É¥é€ÎÆ°ºî³«»Ï
255 */
256#ifdef TOPPERS_sta_alm
257
258ER
259sta_alm(ID almid, RELTIM almtim)
260{
261        ALMCB   *p_almcb;
262        ER              ercd;
263
264        LOG_STA_ALM_ENTER(almid, almtim);
265        CHECK_TSKCTX_UNL();
266        CHECK_ALMID(almid);
267        CHECK_PAR(almtim <= TMAX_RELTIM);
268        p_almcb = get_almcb(almid);
269
270        t_lock_cpu();
271        if (p_almcb->p_alminib->almatr == TA_NOEXS) {
272                ercd = E_NOEXS;
273        }
274        else {
275                if (p_almcb->almsta) {
276                        tmevtb_dequeue(&(p_almcb->tmevtb));
277                }
278                else {
279                        p_almcb->almsta = true;
280                }
281                tmevtb_enqueue(&(p_almcb->tmevtb), almtim,
282                                                                        (CBACK) call_almhdr, (void *) p_almcb);
283                ercd = E_OK;
284        }
285        t_unlock_cpu();
286
287  error_exit:
288        LOG_STA_ALM_LEAVE(ercd);
289        return(ercd);
290}
291
292#endif /* TOPPERS_sta_alm */
293
294/*
295 *  ¥¢¥é¡Œ¥à¥Ï¥ó¥É¥é€ÎÆ°ºî³«»Ï¡ÊÈ󥿥¹¥¯¥³¥ó¥Æ¥­¥¹¥ÈÍÑ¡Ë
296 */
297#ifdef TOPPERS_ista_alm
298
299ER
300ista_alm(ID almid, RELTIM almtim)
301{
302        ALMCB   *p_almcb;
303        ER              ercd;
304
305        LOG_ISTA_ALM_ENTER(almid, almtim);
306        CHECK_INTCTX_UNL();
307        CHECK_ALMID(almid);
308        CHECK_PAR(almtim <= TMAX_RELTIM);
309        p_almcb = get_almcb(almid);
310
311        i_lock_cpu();
312        if (p_almcb->p_alminib->almatr == TA_NOEXS) {
313                ercd = E_NOEXS;
314        }
315        else {
316                if (p_almcb->almsta) {
317                        tmevtb_dequeue(&(p_almcb->tmevtb));
318                }
319                else {
320                        p_almcb->almsta = true;
321                }
322                tmevtb_enqueue(&(p_almcb->tmevtb), almtim,
323                                                                        (CBACK) call_almhdr, (void *) p_almcb);
324                ercd = E_OK;
325        }
326        i_unlock_cpu();
327
328  error_exit:
329        LOG_ISTA_ALM_LEAVE(ercd);
330        return(ercd);
331}
332
333#endif /* TOPPERS_ista_alm */
334
335/*
336 *  ¥¢¥é¡Œ¥à¥Ï¥ó¥É¥é€ÎÆ°ºîÄä»ß
337 */
338#ifdef TOPPERS_stp_alm
339
340ER
341stp_alm(ID almid)
342{
343        ALMCB   *p_almcb;
344        ER              ercd;
345
346        LOG_STP_ALM_ENTER(almid);
347        CHECK_TSKCTX_UNL();
348        CHECK_ALMID(almid);
349        p_almcb = get_almcb(almid);
350
351        t_lock_cpu();
352        if (p_almcb->p_alminib->almatr == TA_NOEXS) {
353                ercd = E_NOEXS;
354        }
355        else {
356                if (p_almcb->almsta) {
357                        p_almcb->almsta = false;
358                        tmevtb_dequeue(&(p_almcb->tmevtb));
359                }
360                ercd = E_OK;
361        }
362        t_unlock_cpu();
363
364  error_exit:
365        LOG_STP_ALM_LEAVE(ercd);
366        return(ercd);
367}
368
369#endif /* TOPPERS_stp_alm */
370
371/*
372 *  ¥¢¥é¡Œ¥à¥Ï¥ó¥É¥é€ÎÆ°ºîÄä»ß¡ÊÈ󥿥¹¥¯¥³¥ó¥Æ¥­¥¹¥ÈÍÑ¡Ë
373 */
374#ifdef TOPPERS_istp_alm
375
376ER
377istp_alm(ID almid)
378{
379        ALMCB   *p_almcb;
380        ER              ercd;
381
382        LOG_ISTP_ALM_ENTER(almid);
383        CHECK_INTCTX_UNL();
384        CHECK_ALMID(almid);
385        p_almcb = get_almcb(almid);
386
387        i_lock_cpu();
388        if (p_almcb->p_alminib->almatr == TA_NOEXS) {
389                ercd = E_NOEXS;
390        }
391        else {
392                if (p_almcb->almsta) {
393                        p_almcb->almsta = false;
394                        tmevtb_dequeue(&(p_almcb->tmevtb));
395                }
396                ercd = E_OK;
397        }
398        i_unlock_cpu();
399
400  error_exit:
401        LOG_ISTP_ALM_LEAVE(ercd);
402        return(ercd);
403}
404
405#endif /* TOPPERS_istp_alm */
406
407/*
408 *  ¥¢¥é¡Œ¥à¥Ï¥ó¥É¥é€ÎŸõÂÖ»²ŸÈ
409 */
410#ifdef TOPPERS_ref_alm
411
412ER
413ref_alm(ID almid, T_RALM *pk_ralm)
414{
415        ALMCB   *p_almcb;
416        ER              ercd;
417   
418        LOG_REF_ALM_ENTER(almid, pk_ralm);
419        CHECK_TSKCTX_UNL();
420        CHECK_ALMID(almid);
421        p_almcb = get_almcb(almid);
422
423        t_lock_cpu();
424        if (p_almcb->p_alminib->almatr == TA_NOEXS) {
425                ercd = E_NOEXS;
426        }
427        else {
428                if (p_almcb->almsta) {
429                        pk_ralm->almstat = TALM_STA;
430                        pk_ralm->lefttim = tmevt_lefttim(&(p_almcb->tmevtb));
431                }
432                else {
433                        pk_ralm->almstat = TALM_STP;
434                }
435                ercd = E_OK;
436        }
437        t_unlock_cpu();
438
439  error_exit:
440        LOG_REF_ALM_LEAVE(ercd, pk_ralm);
441        return(ercd);
442}
443
444#endif /* TOPPERS_ref_alm */
445
446/*
447 *  ¥¢¥é¡Œ¥à¥Ï¥ó¥É¥éµ¯Æ°¥ë¡Œ¥Á¥ó
448 */
449#ifdef TOPPERS_almcal
450
451void
452call_almhdr(ALMCB *p_almcb)
453{
454        PRI             saved_ipm;
455
456        /*
457         *  ¥¢¥é¡Œ¥à¥Ï¥ó¥É¥é€òÄä»ßŸõÂրˀ¹€ë¡¥
458         */
459        p_almcb->almsta = false;
460
461        /*
462         *  ¥¢¥é¡Œ¥à¥Ï¥ó¥É¥é€ò¡€CPU¥í¥Ã¥¯²òœüŸõÂրǞƀӜЀ¹¡¥
463         */
464        saved_ipm = i_get_ipm();
465        i_unlock_cpu();
466
467        LOG_ALM_ENTER(p_almcb);
468        (*((ALMHDR)(p_almcb->p_alminib->almhdr)))(p_almcb->p_alminib->exinf);
469        LOG_ALM_LEAVE(p_almcb);
470
471        if (!i_sense_lock()) {
472                i_lock_cpu();
473        }
474        i_set_ipm(saved_ipm);
475}
476
477#endif /* TOPPERS_almcal */
※ 詳しい使い方は TracBrowser を参照してください。