source: kernel/task_except.c

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

TOPPERS/ASP 1.9.1
ファイルサイズ: 6.1 KB
行 
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-2011 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 "task.h"
50
51/*
52 *  ¥È¥ì¡Œ¥¹¥í¥°¥Þ¥¯¥í€Î¥Ç¥Õ¥©¥ë¥ÈÄêµÁ
53 */
54#ifndef LOG_RAS_TEX_ENTER
55#define LOG_RAS_TEX_ENTER(tskid, rasptn)
56#endif /* LOG_RAS_TEX_ENTER */
57
58#ifndef LOG_RAS_TEX_LEAVE
59#define LOG_RAS_TEX_LEAVE(ercd)
60#endif /* LOG_RAS_TEX_LEAVE */
61
62#ifndef LOG_IRAS_TEX_ENTER
63#define LOG_IRAS_TEX_ENTER(tskid, rasptn)
64#endif /* LOG_IRAS_TEX_ENTER */
65
66#ifndef LOG_IRAS_TEX_LEAVE
67#define LOG_IRAS_TEX_LEAVE(ercd)
68#endif /* LOG_IRAS_TEX_LEAVE */
69
70#ifndef LOG_DIS_TEX_ENTER
71#define LOG_DIS_TEX_ENTER()
72#endif /* LOG_DIS_TEX_ENTER */
73
74#ifndef LOG_DIS_TEX_LEAVE
75#define LOG_DIS_TEX_LEAVE(ercd)
76#endif /* LOG_DIS_TEX_LEAVE */
77
78#ifndef LOG_ENA_TEX_ENTER
79#define LOG_ENA_TEX_ENTER()
80#endif /* LOG_ENA_TEX_ENTER */
81
82#ifndef LOG_ENA_TEX_LEAVE
83#define LOG_ENA_TEX_LEAVE(ercd)
84#endif /* LOG_ENA_TEX_LEAVE */
85
86#ifndef LOG_SNS_TEX_ENTER
87#define LOG_SNS_TEX_ENTER()
88#endif /* LOG_SNS_TEX_ENTER */
89
90#ifndef LOG_SNS_TEX_LEAVE
91#define LOG_SNS_TEX_LEAVE(state)
92#endif /* LOG_SNS_TEX_LEAVE */
93
94#ifndef LOG_REF_TEX_ENTER
95#define LOG_REF_TEX_ENTER(tskid, pk_rtex)
96#endif /* LOG_REF_TEX_ENTER */
97
98#ifndef LOG_REF_TEX_LEAVE
99#define LOG_REF_TEX_LEAVE(ercd, pk_rtex)
100#endif /* LOG_REF_TEX_LEAVE */
101
102/*
103 *  ¥¿¥¹¥¯Îã³°œèÍý€ÎÍ×µá
104 */
105#ifdef TOPPERS_ras_tex
106
107ER
108ras_tex(ID tskid, TEXPTN rasptn)
109{
110        TCB             *p_tcb;
111        ER              ercd;
112
113        LOG_RAS_TEX_ENTER(tskid, rasptn);
114        CHECK_TSKCTX_UNL();
115        CHECK_TSKID_SELF(tskid);
116        CHECK_PAR(rasptn != 0U);
117        p_tcb = get_tcb_self(tskid);
118
119        t_lock_cpu();
120        if (TSTAT_DORMANT(p_tcb->tstat) || p_tcb->p_tinib->texrtn == NULL) {
121                ercd = E_OBJ;
122        }
123        else {
124                p_tcb->texptn |= rasptn;
125                if (p_tcb == p_runtsk && p_runtsk->enatex && ipmflg) {
126                        call_texrtn();
127                }
128                ercd = E_OK;
129        }
130        t_unlock_cpu();
131
132  error_exit:
133        LOG_RAS_TEX_LEAVE(ercd);
134        return(ercd);
135}
136
137#endif /* TOPPERS_ras_tex */
138
139/*
140 *  ¥¿¥¹¥¯Îã³°œèÍý€ÎÍ×µá¡ÊÈ󥿥¹¥¯¥³¥ó¥Æ¥­¥¹¥ÈÍÑ¡Ë
141 */
142#ifdef TOPPERS_iras_tex
143
144ER
145iras_tex(ID tskid, TEXPTN rasptn)
146{
147        TCB             *p_tcb;
148        ER              ercd;
149
150        LOG_IRAS_TEX_ENTER(tskid, rasptn);
151        CHECK_INTCTX_UNL();
152        CHECK_TSKID(tskid);
153        CHECK_PAR(rasptn != 0U);
154        p_tcb = get_tcb(tskid);
155
156        i_lock_cpu();
157        if (TSTAT_DORMANT(p_tcb->tstat) || p_tcb->p_tinib->texrtn == NULL) {
158                ercd = E_OBJ;
159        }
160        else {
161                p_tcb->texptn |= rasptn;
162                if (p_tcb == p_runtsk && p_runtsk->enatex && ipmflg) {
163                        reqflg = true;
164                }
165                ercd = E_OK;
166        }
167        i_unlock_cpu();
168
169  error_exit:
170        LOG_IRAS_TEX_LEAVE(ercd);
171        return(ercd);
172}
173
174#endif /* TOPPERS_iras_tex */
175
176/*
177 *  ¥¿¥¹¥¯Îã³°œèÍý€Î¶Ø»ß
178 */
179#ifdef TOPPERS_dis_tex
180
181ER
182dis_tex(void)
183{
184        ER              ercd;
185
186        LOG_DIS_TEX_ENTER();
187        CHECK_TSKCTX_UNL();
188
189        t_lock_cpu();
190        if (p_runtsk->p_tinib->texrtn == NULL) {
191                ercd = E_OBJ;
192        }
193        else {
194                p_runtsk->enatex = false;
195                ercd = E_OK;
196        }
197        t_unlock_cpu();
198
199  error_exit:
200        LOG_DIS_TEX_LEAVE(ercd);
201        return(ercd);
202}
203
204#endif /* TOPPERS_dis_tex */
205
206/*
207 *  ¥¿¥¹¥¯Îã³°œèÍý€Îµö²Ä
208 */
209#ifdef TOPPERS_ena_tex
210
211ER
212ena_tex(void)
213{
214        ER              ercd;
215
216        LOG_ENA_TEX_ENTER();
217        CHECK_TSKCTX_UNL();
218
219        t_lock_cpu();
220        if (p_runtsk->p_tinib->texrtn == NULL) {
221                ercd = E_OBJ;
222        }
223        else {
224                p_runtsk->enatex = true;
225                if (p_runtsk->texptn != 0U && ipmflg) {
226                        call_texrtn();
227                }
228                ercd = E_OK;
229        }
230        t_unlock_cpu();
231
232  error_exit:
233        LOG_ENA_TEX_LEAVE(ercd);
234        return(ercd);
235}
236
237#endif /* TOPPERS_ena_tex */
238
239/*
240 *  ¥¿¥¹¥¯Îã³°œèÍý¶Ø»ßŸõÂրλ²ŸÈ
241 */
242#ifdef TOPPERS_sns_tex
243
244bool_t
245sns_tex(void)
246{
247        bool_t  state;
248
249        LOG_SNS_TEX_ENTER();
250        state = (p_runtsk != NULL && p_runtsk->enatex) ? false : true;
251        LOG_SNS_TEX_LEAVE(state);
252        return(state);
253}
254
255#endif /* TOPPERS_sns_tex */
256
257/*
258 *  ¥¿¥¹¥¯Îã³°œèÍý€ÎŸõÂÖ»²ŸÈ
259 */
260#ifdef TOPPERS_ref_tex
261
262ER
263ref_tex(ID tskid, T_RTEX *pk_rtex)
264{
265        TCB             *p_tcb;
266        ER              ercd;
267
268        LOG_REF_TEX_ENTER(tskid, pk_rtex);
269        CHECK_TSKCTX_UNL();
270        CHECK_TSKID_SELF(tskid);
271        p_tcb = get_tcb_self(tskid);
272
273        t_lock_cpu();
274        if (TSTAT_DORMANT(p_tcb->tstat) || p_tcb->p_tinib->texrtn == NULL) {
275                ercd = E_OBJ;
276        }
277        else {
278                pk_rtex->texstat = (p_tcb->enatex) ? TTEX_ENA : TTEX_DIS;
279                pk_rtex->pndptn = p_tcb->texptn;
280                ercd = E_OK;
281        }
282        t_unlock_cpu();
283
284  error_exit:
285        LOG_REF_TEX_LEAVE(ercd, pk_rtex);
286        return(ercd);
287}
288
289#endif /* TOPPERS_ref_tex */
※ 詳しい使い方は TracBrowser を参照してください。