source: mypx/extension/ovrhdr/kernel/overrun.c

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

TOPPERS/ASP 1.9.1

ファイルサイズ: 7.5 KB
 
1/*
2 *  TOPPERS/ASP Kernel
3 *      Toyohashi Open Platform for Embedded Real-Time Systems/
4 *      Advanced Standard Profile Kernel
5 *
6 *  Copyright (C) 2005-2014 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 *              ¥ª¡Œ¥Ð¥é¥ó¥Ï¥ó¥É¥éµ¡Çœ
43 */
44
45#include "kernel_impl.h"
46#include "check.h"
47#include "task.h"
48#include "overrun.h"
49
50#ifdef TOPPERS_SUPPORT_OVRHDR
51#include "target_timer.h"
52
53/*
54 *  ¥È¥ì¡Œ¥¹¥í¥°¥Þ¥¯¥í€Î¥Ç¥Õ¥©¥ë¥ÈÄêµÁ
55 */
56#ifndef LOG_OVR_ENTER
57#define LOG_OVR_ENTER(p_runtsk)
58#endif /* LOG_OVR_ENTER */
59
60#ifndef LOG_OVR_LEAVE
61#define LOG_OVR_LEAVE(p_runtsk)
62#endif /* LOG_OVR_LEAVE */
63
64#ifndef LOG_STA_OVR_ENTER
65#define LOG_STA_OVR_ENTER(tskid, ovrtim)
66#endif /* LOG_STA_OVR_ENTER */
67
68#ifndef LOG_STA_OVR_LEAVE
69#define LOG_STA_OVR_LEAVE(ercd)
70#endif /* LOG_STA_OVR_LEAVE */
71
72#ifndef LOG_ISTA_OVR_ENTER
73#define LOG_ISTA_OVR_ENTER(tskid, ovrtim)
74#endif /* LOG_ISTA_OVR_ENTER */
75
76#ifndef LOG_ISTA_OVR_LEAVE
77#define LOG_ISTA_OVR_LEAVE(ercd)
78#endif /* LOG_ISTA_OVR_LEAVE */
79
80#ifndef LOG_ISTP_OVR_ENTER
81#define LOG_ISTP_OVR_ENTER(tskid)
82#endif /* LOG_ISTP_OVR_ENTER */
83
84#ifndef LOG_ISTP_OVR_LEAVE
85#define LOG_ISTP_OVR_LEAVE(ercd)
86#endif /* LOG_ISTP_OVR_LEAVE */
87
88#ifndef LOG_STP_OVR_ENTER
89#define LOG_STP_OVR_ENTER(tskid)
90#endif /* LOG_STP_OVR_ENTER */
91
92#ifndef LOG_STP_OVR_LEAVE
93#define LOG_STP_OVR_LEAVE(ercd)
94#endif /* LOG_STP_OVR_LEAVE */
95
96#ifndef LOG_REF_OVR_ENTER
97#define LOG_REF_OVR_ENTER(tskid, pk_rovr)
98#endif /* LOG_REF_OVR_ENTER */
99
100#ifndef LOG_REF_OVR_LEAVE
101#define LOG_REF_OVR_LEAVE(ercd, pk_rovr)
102#endif /* LOG_REF_OVR_LEAVE */
103
104#ifdef TOPPERS_ovrini
105
106/*
107 *  ¥ª¡Œ¥Ð¥é¥ó¥¿¥€¥Þ€¬Æ°ºîÃæ€«€òŒš€¹¥Õ¥é¥°
108 */
109bool_t  ovrtimer_flag;
110
111/*
112 *  ¥ª¡Œ¥Ð¥é¥ó¥Ï¥ó¥É¥éµ¡Çœ€ÎœéŽü²œ
113 */
114void
115initialize_overrun(void)
116{
117        ovrtimer_flag = false;
118}
119
120#endif /* TOPPERS_ovrini */
121
122/*
123 *  ¥ª¡Œ¥Ð¥é¥ó¥Ï¥ó¥É¥éÍÑ¥¿¥€¥Þ€Îưºî³«»Ï
124 */
125#ifdef TOPPERS_ovrsta
126#ifndef OMIT_OVRTIMER_START
127
128void
129ovrtimer_start(void)
130{
131        if (p_runtsk->leftotm > 0U) {
132                target_ovrtimer_start(p_runtsk->leftotm);
133                ovrtimer_flag = true;
134        }
135}
136
137#endif /* OMIT_OVRTIMER_START */
138#endif /* TOPPERS_ovrsta */
139
140/*
141 *  ¥ª¡Œ¥Ð¥é¥ó¥Ï¥ó¥É¥éÍÑ¥¿¥€¥Þ€ÎÄä»ß
142 */
143#ifdef TOPPERS_ovrstp
144#ifndef OMIT_OVRTIMER_STOP
145
146void
147ovrtimer_stop(void)
148{
149        if (ovrtimer_flag) {
150                assert(p_runtsk->leftotm > 0U);
151                p_runtsk->leftotm = target_ovrtimer_stop();
152                ovrtimer_flag = false;
153        }
154}
155
156#endif /* OMIT_OVRTIMER_STOP */
157#endif /* TOPPERS_ovrstp */
158
159/*
160 *  ¥ª¡Œ¥Ð¥é¥ó¥Ï¥ó¥É¥é€Îưºî³«»Ï
161 */
162#ifdef TOPPERS_sta_ovr
163
164ER
165sta_ovr(ID tskid, OVRTIM ovrtim)
166{
167        TCB             *p_tcb;
168        ER              ercd;
169
170        LOG_STA_OVR_ENTER(tskid, ovrtim);
171        CHECK_TSKCTX_UNL();
172        CHECK_OBJ(ovrinib.ovrhdr != NULL);
173        CHECK_TSKID_SELF(tskid);
174        CHECK_PAR(0U < ovrtim && ovrtim <= TMAX_OVRTIM);
175        p_tcb = get_tcb_self(tskid);
176
177        t_lock_cpu();
178        if (p_tcb == p_runtsk) {
179                if (p_tcb->leftotm > 0U) {
180                        (void) target_ovrtimer_stop();
181                }
182                target_ovrtimer_start(ovrtim);
183                ovrtimer_flag = true;
184        }
185        p_tcb->leftotm = ovrtim;
186        ercd = E_OK;
187        t_unlock_cpu();
188
189  error_exit:
190        LOG_STA_OVR_LEAVE(ercd);
191        return(ercd);
192}
193
194#endif /* TOPPERS_sta_ovr */
195
196/*
197 *  ¥ª¡Œ¥Ð¥é¥ó¥Ï¥ó¥É¥é€Îưºî³«»Ï¡ÊÈ󥿥¹¥¯¥³¥ó¥Æ¥­¥¹¥ÈÍÑ¡Ë
198 */
199#ifdef TOPPERS_ista_ovr
200
201ER
202ista_ovr(ID tskid, OVRTIM ovrtim)
203{
204        TCB             *p_tcb;
205        ER              ercd;
206
207        LOG_ISTA_OVR_ENTER(tskid, ovrtim);
208        CHECK_INTCTX_UNL();
209        CHECK_OBJ(ovrinib.ovrhdr != NULL);
210        CHECK_TSKID(tskid);
211        CHECK_PAR(0U < ovrtim && ovrtim <= TMAX_OVRTIM);
212        p_tcb = get_tcb(tskid);
213
214        i_lock_cpu();
215        p_tcb->leftotm = ovrtim;
216        ercd = E_OK;
217        i_unlock_cpu();
218
219  error_exit:
220        LOG_ISTA_OVR_LEAVE(ercd);
221        return(ercd);
222}
223
224#endif /* TOPPERS_ista_ovr */
225
226/*
227 *  ¥ª¡Œ¥Ð¥é¥ó¥Ï¥ó¥É¥é€ÎưºîÄä»ß
228 */
229#ifdef TOPPERS_stp_ovr
230
231ER
232stp_ovr(ID tskid)
233{
234        TCB             *p_tcb;
235        ER              ercd;
236
237        LOG_STP_OVR_ENTER(tskid);
238        CHECK_TSKCTX_UNL();
239        CHECK_OBJ(ovrinib.ovrhdr != NULL);
240        CHECK_TSKID_SELF(tskid);
241        p_tcb = get_tcb_self(tskid);
242
243        t_lock_cpu();
244        if (p_tcb->leftotm > 0U) {
245                if (p_tcb == p_runtsk) {
246                        (void) target_ovrtimer_stop();
247                        ovrtimer_flag = false;
248                }
249                p_tcb->leftotm = 0U;
250        }
251        ercd = E_OK;
252        t_unlock_cpu();
253
254  error_exit:
255        LOG_STP_OVR_LEAVE(ercd);
256        return(ercd);
257}
258
259#endif /* TOPPERS_stp_ovr */
260
261/*
262 *  ¥ª¡Œ¥Ð¥é¥ó¥Ï¥ó¥É¥é€ÎưºîÄä»ß¡ÊÈ󥿥¹¥¯¥³¥ó¥Æ¥­¥¹¥ÈÍÑ¡Ë
263 */
264#ifdef TOPPERS_istp_ovr
265
266ER
267istp_ovr(ID tskid)
268{
269        TCB             *p_tcb;
270        ER              ercd;
271
272        LOG_ISTP_OVR_ENTER(tskid);
273        CHECK_INTCTX_UNL();
274        CHECK_OBJ(ovrinib.ovrhdr != NULL);
275        CHECK_TSKID(tskid);
276        p_tcb = get_tcb(tskid);
277
278        i_lock_cpu();
279        p_tcb->leftotm = 0U;
280        ercd = E_OK;
281        i_unlock_cpu();
282
283  error_exit:
284        LOG_ISTP_OVR_LEAVE(ercd);
285        return(ercd);
286}
287
288#endif /* TOPPERS_istp_ovr */
289
290/*
291 *  ¥ª¡Œ¥Ð¥é¥ó¥Ï¥ó¥É¥é€ÎŸõÂÖ»²ŸÈ
292 */
293#ifdef TOPPERS_ref_ovr
294
295ER
296ref_ovr(ID tskid, T_ROVR *pk_rovr)
297{
298        TCB             *p_tcb;
299        ER              ercd;
300   
301        LOG_REF_OVR_ENTER(tskid, pk_rovr);
302        CHECK_TSKCTX_UNL();
303        CHECK_OBJ(ovrinib.ovrhdr != NULL);
304        CHECK_TSKID_SELF(tskid);
305        p_tcb = get_tcb_self(tskid);
306
307        t_lock_cpu();
308        if (p_tcb->leftotm > 0U) {
309                pk_rovr->ovrstat = TOVR_STA;
310                if (p_tcb == p_runtsk) {
311                        pk_rovr->leftotm = target_ovrtimer_get_current();
312                }
313                else {
314                        pk_rovr->leftotm = p_tcb->leftotm;
315                }
316        }
317        else {
318                pk_rovr->ovrstat = TOVR_STP;
319        }
320        ercd = E_OK;
321        t_unlock_cpu();
322
323  error_exit:
324        LOG_REF_OVR_LEAVE(ercd, pk_rovr);
325        return(ercd);
326}
327
328#endif /* TOPPERS_ref_ovr */
329
330/*
331 *  ¥ª¡Œ¥Ð¥é¥ó¥Ï¥ó¥É¥éµ¯Æ°¥ë¡Œ¥Á¥ó
332 *
333 *  ¥ª¡Œ¥Ð¥é¥ó¥Ï¥ó¥É¥é€ÎžÆœÐ€·žå€Ë¡€žÆœÐ€·Á°€ÎŸõÂÖ¡ÊCPU¥í¥Ã¥¯¥Õ¥é¥°¡€³ä
334 *  ¹þ€ßÍ¥ÀèÅÙ¥Þ¥¹¥¯¡Ë€ËÌဵ€Ê€€€Î€Ï¡€€³€Î¥ë¡Œ¥Á¥ó€«€é€Î¥ê¥¿¡Œ¥óžå€Ë¡€
335 *  ³ä¹þ€ßœÐžýœèÍý€Çžµ€ÎŸõÂÖ€ËÌ္€¿€á€Ç€¢€ë¡¥
336 */
337#ifdef TOPPERS_ovrcal
338
339void
340call_ovrhdr(void)
341{
342        assert(sense_context());
343        assert(!i_sense_lock());
344        assert(ovrinib.ovrhdr != NULL);
345
346        i_lock_cpu();
347        if (p_runtsk!= NULL && p_runtsk->leftotm == 1U) {
348                p_runtsk->leftotm = 0U;
349                i_unlock_cpu();
350
351                LOG_OVR_ENTER(p_runtsk);
352                ((OVRHDR)(ovrinib.ovrhdr))(TSKID(p_runtsk), p_runtsk->p_tinib->exinf);
353                LOG_OVR_LEAVE(p_runtsk);
354        }
355        else {
356                /*
357                 *  €³€Î¥ë¡Œ¥Á¥ó€¬žÆ€ÓœÐ€µ€ì€ëÁ°€Ë¡€¥ª¡Œ¥Ð¥é¥ó¥Ï¥ó¥É¥é€Îµ¯Æ°€¬
358                 *  ¥­¥ã¥ó¥»¥ë€µ€ì€¿Ÿì¹ç
359                 */
360                i_unlock_cpu();
361        }
362}
363
364#endif /* TOPPERS_ovrcal */
365#endif /* TOPPERS_SUPPORT_OVRHDR */
詳しい使い方は TracBrowser を参照してください。