source: asp_ewarm/asp-1.7.0/extension/dcre/kernel/task_except.c@ 61

Last change on this file since 61 was 61, checked in by ertl-honda, 11 years ago

ASP for EWARM のコミット.

File size: 7.8 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-2011 by Embedded and Real-Time Systems Laboratory
9 * Graduate School of Information Science, Nagoya Univ., JAPAN
10 *
11 * ã‹L’˜ìŒ ŽÒ‚́CˆÈ‰º‚Ì(1)`(4)‚ÌðŒ‚ð–ž‚½‚·ê‡‚ÉŒÀ‚èC–{ƒ\ƒtƒgƒEƒF
12 * ƒAi–{ƒ\ƒtƒgƒEƒFƒA‚ð‰ü•Ï‚µ‚½‚à‚Ì‚ðŠÜ‚ށDˆÈ‰º“¯‚¶j‚ðŽg—pE•¡»E‰ü
13 * •ÏEÄ”z•ziˆÈ‰ºC—˜—p‚ƌĂԁj‚·‚邱‚Ƃ𖳏ž‚Å‹–‘ø‚·‚éD
14 * (1) –{ƒ\ƒtƒgƒEƒFƒA‚ðƒ\[ƒXƒR[ƒh‚ÌŒ`‚Å—˜—p‚·‚éê‡‚ɂ́Cã‹L‚Ì’˜ì
15 * Œ •\Ž¦C‚±‚Ì—˜—pðŒ‚¨‚æ‚щº‹L‚Ì–³•ÛØ‹K’肪C‚»‚Ì‚Ü‚Ü‚ÌŒ`‚Ń\[
16 * ƒXƒR[ƒh’†‚ÉŠÜ‚Ü‚ê‚Ä‚¢‚邱‚ƁD
17 * (2) –{ƒ\ƒtƒgƒEƒFƒA‚ðCƒ‰ƒCƒuƒ‰ƒŠŒ`Ž®‚ȂǁC‘¼‚̃\ƒtƒgƒEƒFƒAŠJ”­‚ÉŽg
18 * —p‚Å‚«‚éŒ`‚ōĔz•z‚·‚éê‡‚ɂ́CÄ”z•z‚É”º‚¤ƒhƒLƒ…
19ƒƒ“ƒgi—˜—p
20 * ŽÒƒ}ƒjƒ…
21ƒAƒ‹‚Ȃǁj‚ɁCã‹L‚Ì’˜ìŒ •\Ž¦C‚±‚Ì—˜—pðŒ‚¨‚æ‚щº‹L
22 * ‚Ì–³•ÛØ‹K’è‚ðŒfÚ‚·‚邱‚ƁD
23 * (3) –{ƒ\ƒtƒgƒEƒFƒA‚ðC‹@Ší‚É‘g‚ݍž‚ނȂǁC‘¼‚̃\ƒtƒgƒEƒFƒAŠJ”­‚ÉŽg
24 * —p‚Å‚«‚È‚¢Œ`‚ōĔz•z‚·‚éê‡‚ɂ́CŽŸ‚Ì‚¢‚¸‚ê‚©‚ÌðŒ‚ð–ž‚½‚·‚±
25 * ‚ƁD
26 * (a) Ä”z•z‚É”º‚¤ƒhƒLƒ…
27ƒƒ“ƒgi—˜—pŽÒƒ}ƒjƒ…
28ƒAƒ‹‚Ȃǁj‚ɁCã‹L‚Ì’˜
29 * ìŒ •\Ž¦C‚±‚Ì—˜—pðŒ‚¨‚æ‚щº‹L‚Ì–³•ÛØ‹K’è‚ðŒfÚ‚·‚邱‚ƁD
30 * (b) Ä”z•z‚ÌŒ`‘Ô‚ðC•Ê‚É’è‚ß‚é•û–@‚É‚æ‚Á‚āCTOPPERSƒvƒƒWƒFƒNƒg‚É
31 * •ñ‚·‚邱‚ƁD
32 * (4) –{ƒ\ƒtƒgƒEƒFƒA‚Ì—˜—p‚É‚æ‚è’¼Ú“I‚Ü‚½‚͊ԐړI‚ɐ¶‚¶‚é‚¢‚©‚Ȃ鑹
33 * ŠQ‚©‚ç‚àCã‹L’˜ìŒ ŽÒ‚¨‚æ‚ÑTOPPERSƒvƒƒWƒFƒNƒg‚ð–Ɛӂ·‚邱‚ƁD
34 * ‚Ü‚½C–{ƒ\ƒtƒgƒEƒFƒA‚̃†[ƒU‚Ü‚½‚̓Gƒ“ƒhƒ†[ƒU‚©‚ç‚Ì‚¢‚©‚Ȃ闝
35 * —R‚ÉŠî‚­¿‹‚©‚ç‚àCã‹L’˜ìŒ ŽÒ‚¨‚æ‚ÑTOPPERSƒvƒƒWƒFƒNƒg‚ð
36 * –Ɛӂ·‚邱‚ƁD
37 *
38 * –{ƒ\ƒtƒgƒEƒFƒA‚́C–³•ÛØ‚Å’ñ‹Ÿ‚³‚ê‚Ä‚¢‚é‚à‚Ì‚Å‚ ‚éDã‹L’˜ìŒ ŽÒ‚¨
39 * ‚æ‚ÑTOPPERSƒvƒƒWƒFƒNƒg‚́C–{ƒ\ƒtƒgƒEƒFƒA‚ÉŠÖ‚µ‚āC“Á’è‚ÌŽg—p–Ú“I
40 * ‚ɑ΂·‚é“K‡«‚àŠÜ‚߂āC‚¢‚©‚È‚é•ÛØ‚às‚í‚È‚¢D‚Ü‚½C–{ƒ\ƒtƒgƒEƒF
41 * ƒA‚Ì—˜—p‚É‚æ‚è’¼Ú“I‚Ü‚½‚͊ԐړI‚ɐ¶‚¶‚½‚¢‚©‚Ȃ鑹ŠQ‚ÉŠÖ‚µ‚Ä‚àC‚»
42 * ‚̐ӔC‚𕉂í‚È‚¢D
43 *
44 * $Id: task_except.c 2023 2011-01-02 08:59:06Z ertl-hiro $
45 */
46
47/*
48 * ƒ^ƒXƒN—áŠOˆ—‹@”\
49 */
50
51#include "kernel_impl.h"
52#include "check.h"
53#include "task.h"
54
55/*
56 * ƒgƒŒ[ƒXƒƒOƒ}ƒNƒ‚̃fƒtƒHƒ‹ƒg’è‹`
57 */
58#ifndef LOG_DEF_TEX_ENTER
59#define LOG_DEF_TEX_ENTER(tskid, pk_dtex)
60#endif /* LOG_DEF_TEX_ENTER */
61
62#ifndef LOG_DEF_TEX_LEAVE
63#define LOG_DEF_TEX_LEAVE(ercd)
64#endif /* LOG_DEF_TEX_LEAVE */
65
66#ifndef LOG_RAS_TEX_ENTER
67#define LOG_RAS_TEX_ENTER(tskid, rasptn)
68#endif /* LOG_RAS_TEX_ENTER */
69
70#ifndef LOG_RAS_TEX_LEAVE
71#define LOG_RAS_TEX_LEAVE(ercd)
72#endif /* LOG_RAS_TEX_LEAVE */
73
74#ifndef LOG_IRAS_TEX_ENTER
75#define LOG_IRAS_TEX_ENTER(tskid, rasptn)
76#endif /* LOG_IRAS_TEX_ENTER */
77
78#ifndef LOG_IRAS_TEX_LEAVE
79#define LOG_IRAS_TEX_LEAVE(ercd)
80#endif /* LOG_IRAS_TEX_LEAVE */
81
82#ifndef LOG_DIS_TEX_ENTER
83#define LOG_DIS_TEX_ENTER()
84#endif /* LOG_DIS_TEX_ENTER */
85
86#ifndef LOG_DIS_TEX_LEAVE
87#define LOG_DIS_TEX_LEAVE(ercd)
88#endif /* LOG_DIS_TEX_LEAVE */
89
90#ifndef LOG_ENA_TEX_ENTER
91#define LOG_ENA_TEX_ENTER()
92#endif /* LOG_ENA_TEX_ENTER */
93
94#ifndef LOG_ENA_TEX_LEAVE
95#define LOG_ENA_TEX_LEAVE(ercd)
96#endif /* LOG_ENA_TEX_LEAVE */
97
98#ifndef LOG_SNS_TEX_ENTER
99#define LOG_SNS_TEX_ENTER()
100#endif /* LOG_SNS_TEX_ENTER */
101
102#ifndef LOG_SNS_TEX_LEAVE
103#define LOG_SNS_TEX_LEAVE(state)
104#endif /* LOG_SNS_TEX_LEAVE */
105
106#ifndef LOG_REF_TEX_ENTER
107#define LOG_REF_TEX_ENTER(tskid, pk_rtex)
108#endif /* LOG_REF_TEX_ENTER */
109
110#ifndef LOG_REF_TEX_LEAVE
111#define LOG_REF_TEX_LEAVE(ercd, pk_rtex)
112#endif /* LOG_REF_TEX_LEAVE */
113
114/*
115 * ƒ^ƒXƒN—áŠOˆ—ƒ‹[ƒ`ƒ“‚Ì’è‹`
116 */
117#ifdef TOPPERS_def_tex
118
119ER_UINT
120def_tex(ID tskid, const T_DTEX *pk_dtex)
121{
122 TCB *p_tcb;
123 TINIB *p_tinib;
124 ER ercd;
125
126 LOG_DEF_TEX_ENTER(tskid, pk_dtex);
127 CHECK_TSKCTX_UNL();
128 CHECK_TSKID_SELF(tskid);
129 CHECK_RSATR(pk_dtex->texatr, TA_NULL);
130 if (pk_dtex->texrtn != NULL) {
131 CHECK_ALIGN_FUNC(pk_dtex->texrtn);
132 CHECK_NONNULL_FUNC(pk_dtex->texrtn);
133 }
134 p_tcb = get_tcb_self(tskid);
135 p_tinib = (TINIB *)(p_tcb->p_tinib);
136
137 t_lock_cpu();
138 if (TSKID(p_tcb) <= tmax_stskid) {
139 ercd = E_OBJ;
140 }
141 else if (pk_dtex->texrtn != NULL) {
142 if (p_tinib->texrtn != NULL) {
143 ercd = E_OBJ;
144 }
145 else {
146 p_tinib->texatr = pk_dtex->texatr;
147 p_tinib->texrtn = pk_dtex->texrtn;
148 ercd = E_OK;
149 }
150 }
151 else {
152 if (p_tinib->texrtn != NULL) {
153 p_tinib->texrtn = NULL;
154 p_tcb->enatex = false;
155 p_tcb->texptn = 0U;
156 ercd = E_OK;
157 }
158 else {
159 ercd = E_OBJ;
160 }
161 }
162 t_unlock_cpu();
163
164 error_exit:
165 LOG_DEF_TEX_LEAVE(ercd);
166 return(ercd);
167}
168
169#endif /* TOPPERS_def_tex */
170
171/*
172 * ƒ^ƒXƒN—áŠOˆ—‚Ì—v‹
173 */
174#ifdef TOPPERS_ras_tex
175
176ER
177ras_tex(ID tskid, TEXPTN rasptn)
178{
179 TCB *p_tcb;
180 ER ercd;
181
182 LOG_RAS_TEX_ENTER(tskid, rasptn);
183 CHECK_TSKCTX_UNL();
184 CHECK_TSKID_SELF(tskid);
185 CHECK_PAR(rasptn != 0U);
186 p_tcb = get_tcb_self(tskid);
187
188 t_lock_cpu();
189 if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
190 ercd = E_NOEXS;
191 }
192 else if (TSTAT_DORMANT(p_tcb->tstat) || p_tcb->p_tinib->texrtn == NULL) {
193 ercd = E_OBJ;
194 }
195 else {
196 p_tcb->texptn |= rasptn;
197 if (p_tcb == p_runtsk && p_runtsk->enatex && ipmflg) {
198 call_texrtn();
199 }
200 ercd = E_OK;
201 }
202 t_unlock_cpu();
203
204 error_exit:
205 LOG_RAS_TEX_LEAVE(ercd);
206 return(ercd);
207}
208
209#endif /* TOPPERS_ras_tex */
210
211/*
212 * ƒ^ƒXƒN—áŠOˆ—‚Ì—v‹i”ñƒ^ƒXƒNƒRƒ“ƒeƒLƒXƒg—pj
213 */
214#ifdef TOPPERS_iras_tex
215
216ER
217iras_tex(ID tskid, TEXPTN rasptn)
218{
219 TCB *p_tcb;
220 ER ercd;
221
222 LOG_IRAS_TEX_ENTER(tskid, rasptn);
223 CHECK_INTCTX_UNL();
224 CHECK_TSKID(tskid);
225 CHECK_PAR(rasptn != 0U);
226 p_tcb = get_tcb(tskid);
227
228 i_lock_cpu();
229 if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
230 ercd = E_NOEXS;
231 }
232 else if (TSTAT_DORMANT(p_tcb->tstat) || p_tcb->p_tinib->texrtn == NULL) {
233 ercd = E_OBJ;
234 }
235 else {
236 p_tcb->texptn |= rasptn;
237 if (p_tcb == p_runtsk && p_runtsk->enatex && ipmflg) {
238 reqflg = true;
239 }
240 ercd = E_OK;
241 }
242 i_unlock_cpu();
243
244 error_exit:
245 LOG_IRAS_TEX_LEAVE(ercd);
246 return(ercd);
247}
248
249#endif /* TOPPERS_iras_tex */
250
251/*
252 * ƒ^ƒXƒN—áŠOˆ—‚Ì‹ÖŽ~
253 */
254#ifdef TOPPERS_dis_tex
255
256ER
257dis_tex(void)
258{
259 ER ercd;
260
261 LOG_DIS_TEX_ENTER();
262 CHECK_TSKCTX_UNL();
263
264 t_lock_cpu();
265 if (p_runtsk->p_tinib->texrtn == NULL) {
266 ercd = E_OBJ;
267 }
268 else {
269 p_runtsk->enatex = false;
270 ercd = E_OK;
271 }
272 t_unlock_cpu();
273
274 error_exit:
275 LOG_DIS_TEX_LEAVE(ercd);
276 return(ercd);
277}
278
279#endif /* TOPPERS_dis_tex */
280
281/*
282 * ƒ^ƒXƒN—áŠOˆ—‚Ì‹–‰Â
283 */
284#ifdef TOPPERS_ena_tex
285
286ER
287ena_tex(void)
288{
289 ER ercd;
290
291 LOG_ENA_TEX_ENTER();
292 CHECK_TSKCTX_UNL();
293
294 t_lock_cpu();
295 if (p_runtsk->p_tinib->texrtn == NULL) {
296 ercd = E_OBJ;
297 }
298 else {
299 p_runtsk->enatex = true;
300 if (p_runtsk->texptn != 0U && ipmflg) {
301 call_texrtn();
302 }
303 ercd = E_OK;
304 }
305 t_unlock_cpu();
306
307 error_exit:
308 LOG_ENA_TEX_LEAVE(ercd);
309 return(ercd);
310}
311
312#endif /* TOPPERS_ena_tex */
313
314/*
315 * ƒ^ƒXƒN—áŠOˆ—‹ÖŽ~ó‘Ô‚ÌŽQÆ
316 */
317#ifdef TOPPERS_sns_tex
318
319bool_t
320sns_tex(void)
321{
322 bool_t state;
323
324 LOG_SNS_TEX_ENTER();
325 state = (p_runtsk != NULL && p_runtsk->enatex) ? false : true;
326 LOG_SNS_TEX_LEAVE(state);
327 return(state);
328}
329
330#endif /* TOPPERS_sns_tex */
331
332/*
333 * ƒ^ƒXƒN—áŠOˆ—‚̏ó‘ÔŽQÆ
334 */
335#ifdef TOPPERS_ref_tex
336
337ER
338ref_tex(ID tskid, T_RTEX *pk_rtex)
339{
340 TCB *p_tcb;
341 ER ercd;
342
343 LOG_REF_TEX_ENTER(tskid, pk_rtex);
344 CHECK_TSKCTX_UNL();
345 CHECK_TSKID_SELF(tskid);
346 p_tcb = get_tcb_self(tskid);
347
348 t_lock_cpu();
349 if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
350 ercd = E_NOEXS;
351 }
352 else if (TSTAT_DORMANT(p_tcb->tstat) || p_tcb->p_tinib->texrtn == NULL) {
353 ercd = E_OBJ;
354 }
355 else {
356 pk_rtex->texstat = (p_tcb->enatex) ? TTEX_ENA : TTEX_DIS;
357 pk_rtex->pndptn = p_tcb->texptn;
358 ercd = E_OK;
359 }
360 t_unlock_cpu();
361
362 error_exit:
363 LOG_REF_TEX_LEAVE(ercd, pk_rtex);
364 return(ercd);
365}
366
367#endif /* TOPPERS_ref_tex */
Note: See TracBrowser for help on using the repository browser.