source: asp_ewarm/asp-1.7.0/extension/rstr_task/kernel/task_manage.c@ 61

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

ASP for EWARM のコミット.

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-2010 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_manage.c 2018 2010-12-31 13:43:05Z ertl-hiro $
45 */
46
47/*
48 * ƒ^ƒXƒNŠÇ—‹@”\
49 */
50
51#include "kernel_impl.h"
52#include "check.h"
53#include "task.h"
54#include "wait.h"
55
56/*
57 * ƒgƒŒ[ƒXƒƒOƒ}ƒNƒ‚̃fƒtƒHƒ‹ƒg’è‹`
58 */
59#ifndef LOG_ACT_TSK_ENTER
60#define LOG_ACT_TSK_ENTER(tskid)
61#endif /* LOG_ACT_TSK_ENTER */
62
63#ifndef LOG_ACT_TSK_LEAVE
64#define LOG_ACT_TSK_LEAVE(ercd)
65#endif /* LOG_ACT_TSK_LEAVE */
66
67#ifndef LOG_IACT_TSK_ENTER
68#define LOG_IACT_TSK_ENTER(tskid)
69#endif /* LOG_IACT_TSK_ENTER */
70
71#ifndef LOG_IACT_TSK_LEAVE
72#define LOG_IACT_TSK_LEAVE(ercd)
73#endif /* LOG_IACT_TSK_LEAVE */
74
75#ifndef LOG_CAN_ACT_ENTER
76#define LOG_CAN_ACT_ENTER(tskid)
77#endif /* LOG_CAN_ACT_ENTER */
78
79#ifndef LOG_CAN_ACT_LEAVE
80#define LOG_CAN_ACT_LEAVE(ercd)
81#endif /* LOG_CAN_ACT_LEAVE */
82
83#ifndef LOG_EXT_TSK_ENTER
84#define LOG_EXT_TSK_ENTER()
85#endif /* LOG_EXT_TSK_ENTER */
86
87#ifndef LOG_EXT_TSK_LEAVE
88#define LOG_EXT_TSK_LEAVE(ercd)
89#endif /* LOG_EXT_TSK_LEAVE */
90
91#ifndef LOG_TER_TSK_ENTER
92#define LOG_TER_TSK_ENTER(tskid)
93#endif /* LOG_TER_TSK_ENTER */
94
95#ifndef LOG_TER_TSK_LEAVE
96#define LOG_TER_TSK_LEAVE(ercd)
97#endif /* LOG_TER_TSK_LEAVE */
98
99#ifndef LOG_CHG_PRI_ENTER
100#define LOG_CHG_PRI_ENTER(tskid, tskpri)
101#endif /* LOG_CHG_PRI_ENTER */
102
103#ifndef LOG_CHG_PRI_LEAVE
104#define LOG_CHG_PRI_LEAVE(ercd)
105#endif /* LOG_CHG_PRI_LEAVE */
106
107#ifndef LOG_RAS_PRI_ENTER
108#define LOG_RAS_PRI_ENTER(tskpri)
109#endif /* LOG_RAS_PRI_ENTER */
110
111#ifndef LOG_RAS_PRI_LEAVE
112#define LOG_RAS_PRI_LEAVE(ercd)
113#endif /* LOG_RAS_PRI_LEAVE */
114
115#ifndef LOG_GET_PRI_ENTER
116#define LOG_GET_PRI_ENTER(tskid, p_tskpri)
117#endif /* LOG_GET_PRI_ENTER */
118
119#ifndef LOG_GET_PRI_LEAVE
120#define LOG_GET_PRI_LEAVE(ercd, tskpri)
121#endif /* LOG_GET_PRI_LEAVE */
122
123#ifndef LOG_GET_INF_ENTER
124#define LOG_GET_INF_ENTER(p_exinf)
125#endif /* LOG_GET_INF_ENTER */
126
127#ifndef LOG_GET_INF_LEAVE
128#define LOG_GET_INF_LEAVE(ercd, exinf)
129#endif /* LOG_GET_INF_LEAVE */
130
131/*
132 * ƒ^ƒXƒN‚Ì‹N“®
133 */
134#ifdef TOPPERS_act_tsk
135
136ER
137act_tsk(ID tskid)
138{
139 TCB *p_tcb;
140 ER ercd;
141
142 LOG_ACT_TSK_ENTER(tskid);
143 CHECK_TSKCTX_UNL();
144 CHECK_TSKID_SELF(tskid);
145 p_tcb = get_tcb_self(tskid);
146
147 t_lock_cpu();
148 if (TSTAT_DORMANT(p_tcb->tstat)) {
149 if (make_active(p_tcb)) {
150 dispatch();
151 }
152 ercd = E_OK;
153 }
154 else if (!(p_tcb->actque)) {
155 p_tcb->actque = true;
156 ercd = E_OK;
157 }
158 else {
159 ercd = E_QOVR;
160 }
161 t_unlock_cpu();
162
163 error_exit:
164 LOG_ACT_TSK_LEAVE(ercd);
165 return(ercd);
166}
167
168#endif /* TOPPERS_act_tsk */
169
170/*
171 * ƒ^ƒXƒN‚Ì‹N“®i”ñƒ^ƒXƒNƒRƒ“ƒeƒLƒXƒg—pj
172 */
173#ifdef TOPPERS_iact_tsk
174
175ER
176iact_tsk(ID tskid)
177{
178 TCB *p_tcb;
179 ER ercd;
180
181 LOG_IACT_TSK_ENTER(tskid);
182 CHECK_INTCTX_UNL();
183 CHECK_TSKID(tskid);
184 p_tcb = get_tcb(tskid);
185
186 i_lock_cpu();
187 if (TSTAT_DORMANT(p_tcb->tstat)) {
188 if (make_active(p_tcb)) {
189 reqflg = true;
190 }
191 ercd = E_OK;
192 }
193 else if (!(p_tcb->actque)) {
194 p_tcb->actque = true;
195 ercd = E_OK;
196 }
197 else {
198 ercd = E_QOVR;
199 }
200 i_unlock_cpu();
201
202 error_exit:
203 LOG_IACT_TSK_LEAVE(ercd);
204 return(ercd);
205}
206
207#endif /* TOPPERS_iact_tsk */
208
209/*
210 * ƒ^ƒXƒN‹N“®—v‹‚̃Lƒƒƒ“ƒZƒ‹
211 */
212#ifdef TOPPERS_can_act
213
214ER_UINT
215can_act(ID tskid)
216{
217 TCB *p_tcb;
218 ER_UINT ercd;
219
220 LOG_CAN_ACT_ENTER(tskid);
221 CHECK_TSKCTX_UNL();
222 CHECK_TSKID_SELF(tskid);
223 p_tcb = get_tcb_self(tskid);
224
225 t_lock_cpu();
226 ercd = p_tcb->actque ? 1 : 0;
227 p_tcb->actque = false;
228 t_unlock_cpu();
229
230 error_exit:
231 LOG_CAN_ACT_LEAVE(ercd);
232 return(ercd);
233}
234
235#endif /* TOPPERS_can_act */
236
237/*
238 * Ž©ƒ^ƒXƒN‚̏I—¹
239 */
240#ifdef TOPPERS_ext_tsk
241
242ER
243ext_tsk(void)
244{
245 ER ercd;
246
247 LOG_EXT_TSK_ENTER();
248 CHECK_TSKCTX();
249
250 if (t_sense_lock()) {
251 /*
252 * CPUƒƒbƒNó‘Ô‚Åext_tsk‚ªŒÄ‚΂ꂽê‡‚́CCPUƒƒbƒN‚ð‰ðœ‚µ
253 * ‚Ä‚©‚çƒ^ƒXƒN‚ðI—¹‚·‚éDŽÀ‘•ã‚́CƒT[ƒrƒXƒR[ƒ‹“à‚Å‚ÌCPU
254 * ƒƒbƒN‚ðÈ—ª‚·‚ê‚΂悢‚¾‚¯D
255 */
256 }
257 else {
258 t_lock_cpu();
259 }
260 if (disdsp) {
261 /*
262 * ƒfƒBƒXƒpƒbƒ`‹ÖŽ~ó‘Ô‚Åext_tsk‚ªŒÄ‚΂ꂽê‡‚́CƒfƒBƒXƒpƒb
263 * ƒ`‹–‰Âó‘Ô‚É‚µ‚Ä‚©‚çƒ^ƒXƒN‚ðI—¹‚·‚éD
264 */
265 disdsp = false;
266 }
267 if (!ipmflg) {
268 /*
269 * Š„ž‚Ý—Dæ“xƒ}ƒXƒNiIPMj‚ªTIPM_ENAALLˆÈŠO‚̏ó‘Ô‚Åext_tsk
270 * ‚ªŒÄ‚΂ꂽê‡‚́CIPM‚ðTIPM_ENAALL‚É‚µ‚Ä‚©‚çƒ^ƒXƒN‚ðI—¹‚·
271 * ‚éD
272 */
273 t_set_ipm(TIPM_ENAALL);
274 ipmflg = true;
275 }
276 dspflg = true;
277
278 (void) make_non_runnable(p_runtsk);
279 make_dormant(p_runtsk);
280 if (p_runtsk->actque) {
281 p_runtsk->actque = false;
282 (void) make_active(p_runtsk);
283 }
284 exit_and_dispatch();
285 ercd = E_SYS;
286
287 error_exit:
288 LOG_EXT_TSK_LEAVE(ercd);
289 return(ercd);
290}
291
292#endif /* TOPPERS_ext_tsk */
293
294/*
295 * ƒ^ƒXƒN‚Ì‹­§I—¹
296 */
297#ifdef TOPPERS_ter_tsk
298
299ER
300ter_tsk(ID tskid)
301{
302 TCB *p_tcb;
303 ER ercd;
304
305 LOG_TER_TSK_ENTER(tskid);
306 CHECK_TSKCTX_UNL();
307 CHECK_TSKID(tskid);
308 p_tcb = get_tcb(tskid);
309 CHECK_NONSELF(p_tcb);
310
311 t_lock_cpu();
312 if (TSTAT_DORMANT(p_tcb->tstat)) {
313 ercd = E_OBJ;
314 }
315 else {
316 if (TSTAT_RUNNABLE(p_tcb->tstat)) {
317 /*
318 * p_tcb‚ÍŽ©ƒ^ƒXƒN‚Å‚È‚¢‚½‚߁CiƒVƒ“ƒOƒ‹ƒvƒƒZƒbƒT‚ł́jŽÀ
319 * só‘Ô‚Å‚È‚­Cmake_non_runnable(p_tcb)‚Ń^ƒXƒNƒfƒBƒXƒpƒb
320 * ƒ`‚ª•K—v‚ɂȂ邱‚Æ‚Í‚È‚¢D
321 */
322 (void) make_non_runnable(p_tcb);
323 }
324 else if (TSTAT_WAITING(p_tcb->tstat)) {
325 wait_dequeue_wobj(p_tcb);
326 wait_dequeue_tmevtb(p_tcb);
327 }
328 make_dormant(p_tcb);
329 if (p_tcb->actque) {
330 p_tcb->actque = false;
331 if (make_active(p_tcb)) {
332 dispatch();
333 }
334 }
335 ercd = E_OK;
336 }
337 t_unlock_cpu();
338
339 error_exit:
340 LOG_TER_TSK_LEAVE(ercd);
341 return(ercd);
342}
343
344#endif /* TOPPERS_ter_tsk */
345
346/*
347 * ƒ^ƒXƒN‚̃x[ƒX—Dæ“x‚̕ύX
348 */
349#ifdef TOPPERS_chg_pri
350
351ER
352chg_pri(ID tskid, PRI tskpri)
353{
354 TCB *p_tcb;
355 uint_t newpri;
356 ER ercd;
357
358 LOG_CHG_PRI_ENTER(tskid, tskpri);
359 CHECK_TSKCTX_UNL();
360 CHECK_TSKID_SELF(tskid);
361 CHECK_TPRI_INI(tskpri);
362 p_tcb = get_tcb_self(tskid);
363 CHECK_NONRSTR(p_tcb);
364 newpri = (tskpri == TPRI_INI) ? p_tcb->p_tinib->ipriority
365 : INT_PRIORITY(tskpri);
366
367 t_lock_cpu();
368 if (TSTAT_DORMANT(p_tcb->tstat)) {
369 ercd = E_OBJ;
370 }
371 else {
372 if (change_priority(p_tcb, newpri)) {
373 dispatch();
374 }
375 ercd = E_OK;
376 }
377 t_unlock_cpu();
378
379 error_exit:
380 LOG_CHG_PRI_LEAVE(ercd);
381 return(ercd);
382}
383
384#endif /* TOPPERS_chg_pri */
385
386/*
387 * Ž©ƒ^ƒXƒN‚Ì—Dæ“x‚̈ø‚«ã‚°
388 */
389#ifdef TOPPERS_ras_pri
390
391ER
392ras_pri(PRI tskpri)
393{
394 uint_t newpri;
395 ER ercd;
396
397 LOG_RAS_PRI_ENTER(tskpri);
398 CHECK_TSKCTX_UNL();
399 CHECK_TPRI_INI(tskpri);
400 if (tskpri == TPRI_INI) {
401 newpri = p_runtsk->p_tinib->ipriority;
402 }
403 else {
404 newpri = INT_PRIORITY(tskpri);
405 CHECK_ILUSE(newpri <= p_runtsk->p_tinib->ipriority);
406 }
407
408 t_lock_cpu();
409 if (raise_priority(newpri)) {
410 dispatch();
411 }
412 ercd = E_OK;
413 t_unlock_cpu();
414
415 error_exit:
416 LOG_RAS_PRI_LEAVE(ercd);
417 return(ercd);
418}
419
420#endif /* TOPPERS_ras_pri */
421
422/*
423 * ƒ^ƒXƒN—Dæ“x‚ÌŽQÆ
424 */
425#ifdef TOPPERS_get_pri
426
427ER
428get_pri(ID tskid, PRI *p_tskpri)
429{
430 TCB *p_tcb;
431 ER ercd;
432
433 LOG_GET_PRI_ENTER(tskid, p_tskpri);
434 CHECK_TSKCTX_UNL();
435 CHECK_TSKID_SELF(tskid);
436 p_tcb = get_tcb_self(tskid);
437
438 t_lock_cpu();
439 if (TSTAT_DORMANT(p_tcb->tstat)) {
440 ercd = E_OBJ;
441 }
442 else {
443 *p_tskpri = EXT_TSKPRI(p_tcb->priority);
444 ercd = E_OK;
445 }
446 t_unlock_cpu();
447
448 error_exit:
449 LOG_GET_PRI_LEAVE(ercd, *p_tskpri);
450 return(ercd);
451}
452
453#endif /* TOPPERS_get_pri */
454
455/*
456 * Ž©ƒ^ƒXƒN‚ÌŠg’£î•ñ‚ÌŽQÆ
457 */
458#ifdef TOPPERS_get_inf
459
460ER
461get_inf(intptr_t *p_exinf)
462{
463 ER ercd;
464
465 LOG_GET_INF_ENTER(p_exinf);
466 CHECK_TSKCTX_UNL();
467
468 t_lock_cpu();
469 *p_exinf = p_runtsk->p_tinib->exinf;
470 ercd = E_OK;
471 t_unlock_cpu();
472
473 error_exit:
474 LOG_GET_INF_LEAVE(ercd, *p_exinf);
475 return(ercd);
476}
477
478#endif /* TOPPERS_get_inf */
Note: See TracBrowser for help on using the repository browser.