1 | /*
|
---|
2 | * TOPPERS/JSP Kernel
|
---|
3 | * Toyohashi Open Platform for Embedded Real-Time Systems/
|
---|
4 | * Just Standard Profile Kernel
|
---|
5 | *
|
---|
6 | * Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
|
---|
7 | * Toyohashi Univ. of Technology, JAPAN
|
---|
8 | *
|
---|
9 | * ä¸è¨è使¨©è
|
---|
10 | ã¯ï¼ä»¥ä¸ã® (1)ã(4) ã®æ¡ä»¶ãï¼Free Software Foundation
|
---|
11 | * ã«ãã£ã¦å
|
---|
12 | ¬è¡¨ããã¦ãã GNU General Public License ã® Version 2 ã«è¨
|
---|
13 | * è¿°ããã¦ããæ¡ä»¶ãæºããå ´åã«éãï¼æ¬ã½ããã¦ã§ã¢ï¼æ¬ã½ããã¦ã§ã¢
|
---|
14 | * ãæ¹å¤ãããã®ãå«ãï¼ä»¥ä¸åãï¼ã使ç¨ã»è¤è£½ã»æ¹å¤ã»åé
|
---|
15 | å¸ï¼ä»¥ä¸ï¼
|
---|
16 | * å©ç¨ã¨å¼ã¶ï¼ãããã¨ãç¡åã§è¨±è«¾ããï¼
|
---|
17 | * (1) æ¬ã½ããã¦ã§ã¢ãã½ã¼ã¹ã³ã¼ãã®å½¢ã§å©ç¨ããå ´åã«ã¯ï¼ä¸è¨ã®èä½
|
---|
18 | * 権表示ï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãï¼ãã®ã¾ã¾ã®å½¢ã§ã½ã¼
|
---|
19 | * ã¹ã³ã¼ãä¸ã«å«ã¾ãã¦ãããã¨ï¼
|
---|
20 | * (2) æ¬ã½ããã¦ã§ã¢ãï¼ã©ã¤ãã©ãªå½¢å¼ãªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
|
---|
21 | * ç¨ã§ããå½¢ã§åé
|
---|
22 | å¸ããå ´åã«ã¯ï¼åé
|
---|
23 | å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨
|
---|
24 | * è
|
---|
25 | ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®è使¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨
|
---|
26 | * ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
|
---|
27 | * (3) æ¬ã½ããã¦ã§ã¢ãï¼æ©å¨ã«çµã¿è¾¼ããªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
|
---|
28 | * ç¨ã§ããªãå½¢ã§åé
|
---|
29 | å¸ããå ´åã«ã¯ï¼æ¬¡ã®ããããã®æ¡ä»¶ãæºããã
|
---|
30 | * ã¨ï¼
|
---|
31 | * (a) åé
|
---|
32 | å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨è
|
---|
33 | ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®è
|
---|
34 | * 使¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
|
---|
35 | * (b) åé
|
---|
36 | å¸ã®å½¢æ
|
---|
37 | ãï¼å¥ã«å®ããæ¹æ³ã«ãã£ã¦ï¼TOPPERSããã¸ã§ã¯ãã«
|
---|
38 | * å ±åãããã¨ï¼
|
---|
39 | * (4) æ¬ã½ããã¦ã§ã¢ã®å©ç¨ã«ããç´æ¥çã¾ãã¯éæ¥çã«çãããããªãæ
|
---|
40 | * 害ãããï¼ä¸è¨è使¨©è
|
---|
41 | ããã³TOPPERSããã¸ã§ã¯ããå
|
---|
42 | 責ãããã¨ï¼
|
---|
43 | *
|
---|
44 | * æ¬ã½ããã¦ã§ã¢ã¯ï¼ç¡ä¿è¨¼ã§æä¾ããã¦ãããã®ã§ããï¼ä¸è¨è使¨©è
|
---|
45 | ã
|
---|
46 | * ãã³TOPPERSããã¸ã§ã¯ãã¯ï¼æ¬ã½ããã¦ã§ã¢ã«é¢ãã¦ï¼ãã®é©ç¨å¯è½æ§ã
|
---|
47 | * å«ãã¦ï¼ãããªãä¿è¨¼ãè¡ããªãï¼ã¾ãï¼æ¬ã½ããã¦ã§ã¢ã®å©ç¨ã«ããç´
|
---|
48 | * æ¥çã¾ãã¯éæ¥çã«çãããããªãæå®³ã«é¢ãã¦ãï¼ãã®è²¬ä»»ãè² ããªãï¼
|
---|
49 | *
|
---|
50 | * @(#) $Id: wait.c,v 1.6 2003/06/04 01:46:16 hiro Exp $
|
---|
51 | */
|
---|
52 |
|
---|
53 | /*
|
---|
54 | * å¾
|
---|
55 | ã¡ç¶æ
|
---|
56 | 管çã¢ã¸ã¥ã¼ã«
|
---|
57 | */
|
---|
58 |
|
---|
59 | #include "jsp_kernel.h"
|
---|
60 | #include "wait.h"
|
---|
61 |
|
---|
62 | /*
|
---|
63 | * å¾
|
---|
64 | ã¡ç¶æ
|
---|
65 | ã¸ã®ç§»è¡ï¼ã¿ã¤ã ã¢ã¦ãæå®ï¼
|
---|
66 | *
|
---|
67 | */
|
---|
68 | #ifdef __waimake
|
---|
69 |
|
---|
70 | void
|
---|
71 | make_wait_tmout(WINFO *winfo, TMEVTB *tmevtb, TMO tmout)
|
---|
72 | {
|
---|
73 | make_non_runnable(runtsk);
|
---|
74 | runtsk->winfo = winfo;
|
---|
75 | if (tmout > 0) {
|
---|
76 | winfo->tmevtb = tmevtb;
|
---|
77 | tmevtb_enqueue(tmevtb, (RELTIM) tmout,
|
---|
78 | (CBACK) wait_tmout, (VP) runtsk);
|
---|
79 | }
|
---|
80 | else {
|
---|
81 | assert(tmout == TMO_FEVR);
|
---|
82 | winfo->tmevtb = NULL;
|
---|
83 | }
|
---|
84 | }
|
---|
85 |
|
---|
86 | #endif /* __waimake */
|
---|
87 |
|
---|
88 | /*
|
---|
89 | * å¾
|
---|
90 | ã¡è§£é¤ã®ããã®ã¿ã¹ã¯ç¶æ
|
---|
91 | ã®æ´æ°
|
---|
92 | *
|
---|
93 | * tcb ã§æå®ãããã¿ã¹ã¯ãï¼å¾
|
---|
94 | ã¡è§£é¤ããããã¿ã¹ã¯ç¶æ
|
---|
95 | ãæ´æ°ããï¼å¾
|
---|
96 |
|
---|
97 | * ã¡è§£é¤ããã¿ã¹ã¯ãå®è¡ã§ããç¶æ
|
---|
98 | ã«ãªãå ´åã¯ï¼ã¬ãã£ãã¥ã¼ã«ã¤ãªãï¼
|
---|
99 | * ã¾ãï¼ãã£ã¹ããããå¿
|
---|
100 | è¦ãªå ´åã«ã¯ TRUE ãè¿ãï¼
|
---|
101 | */
|
---|
102 | Inline BOOL
|
---|
103 | make_non_wait(TCB *tcb)
|
---|
104 | {
|
---|
105 | assert(TSTAT_WAITING(tcb->tstat));
|
---|
106 |
|
---|
107 | if (!(TSTAT_SUSPENDED(tcb->tstat))) {
|
---|
108 | /*
|
---|
109 | * å¾
|
---|
110 | ã¡ç¶æ
|
---|
111 | ããå®è¡ã§ããç¶æ
|
---|
112 | ã¸ã®é·ç§»
|
---|
113 | */
|
---|
114 | return(make_runnable(tcb));
|
---|
115 | }
|
---|
116 | else {
|
---|
117 | /*
|
---|
118 | * äºéå¾
|
---|
119 | ã¡ç¶æ
|
---|
120 | ããå¼·å¶å¾
|
---|
121 | ã¡ç¶æ
|
---|
122 | ã¸ã®é·ç§»
|
---|
123 | */
|
---|
124 | tcb->tstat = TS_SUSPENDED;
|
---|
125 | LOG_TSKSTAT(tcb);
|
---|
126 | return(FALSE);
|
---|
127 | }
|
---|
128 | }
|
---|
129 |
|
---|
130 | /*
|
---|
131 | * å¾
|
---|
132 | ã¡è§£é¤
|
---|
133 | */
|
---|
134 | #ifdef __waicmp
|
---|
135 |
|
---|
136 | BOOL
|
---|
137 | wait_complete(TCB *tcb)
|
---|
138 | {
|
---|
139 | if (tcb->winfo->tmevtb != NULL) {
|
---|
140 | tmevtb_dequeue(tcb->winfo->tmevtb);
|
---|
141 | }
|
---|
142 | tcb->winfo->wercd = E_OK;
|
---|
143 | return(make_non_wait(tcb));
|
---|
144 | }
|
---|
145 |
|
---|
146 | #endif /* __waicmp */
|
---|
147 |
|
---|
148 | /*
|
---|
149 | * ã¿ã¤ã ã¢ã¦ãã«ä¼´ãå¾
|
---|
150 | ã¡è§£é¤
|
---|
151 | */
|
---|
152 | #ifdef __waitmo
|
---|
153 |
|
---|
154 | void
|
---|
155 | wait_tmout(TCB *tcb)
|
---|
156 | {
|
---|
157 | if ((tcb->tstat & TS_WAIT_WOBJ) != 0) {
|
---|
158 | queue_delete(&(tcb->task_queue));
|
---|
159 | }
|
---|
160 | tcb->winfo->wercd = E_TMOUT;
|
---|
161 | if (make_non_wait(tcb)) {
|
---|
162 | reqflg = TRUE;
|
---|
163 | }
|
---|
164 | }
|
---|
165 |
|
---|
166 | #endif /* __waitmo */
|
---|
167 | #ifdef __waitmook
|
---|
168 |
|
---|
169 | void
|
---|
170 | wait_tmout_ok(TCB *tcb)
|
---|
171 | {
|
---|
172 | tcb->winfo->wercd = E_OK;
|
---|
173 | if (make_non_wait(tcb)) {
|
---|
174 | reqflg = TRUE;
|
---|
175 | }
|
---|
176 | }
|
---|
177 |
|
---|
178 | #endif /* __waitmook */
|
---|
179 |
|
---|
180 | /*
|
---|
181 | * å¾
|
---|
182 | ã¡ç¶æ
|
---|
183 | ã®å¼·å¶è§£é¤
|
---|
184 | */
|
---|
185 | #ifdef __waican
|
---|
186 |
|
---|
187 | void
|
---|
188 | wait_cancel(TCB *tcb)
|
---|
189 | {
|
---|
190 | if (tcb->winfo->tmevtb != NULL) {
|
---|
191 | tmevtb_dequeue(tcb->winfo->tmevtb);
|
---|
192 | }
|
---|
193 | if ((tcb->tstat & TS_WAIT_WOBJ) != 0) {
|
---|
194 | queue_delete(&(tcb->task_queue));
|
---|
195 | }
|
---|
196 | }
|
---|
197 |
|
---|
198 | #endif /* __waican */
|
---|
199 | #ifdef __wairel
|
---|
200 |
|
---|
201 | BOOL
|
---|
202 | wait_release(TCB *tcb)
|
---|
203 | {
|
---|
204 | wait_cancel(tcb);
|
---|
205 | tcb->winfo->wercd = E_RLWAI;
|
---|
206 | return(make_non_wait(tcb));
|
---|
207 | }
|
---|
208 |
|
---|
209 | #endif /* __wairel */
|
---|
210 |
|
---|
211 | /*
|
---|
212 | * ã¿ã¹ã¯ã®åªå
|
---|
213 | 度é ã®å¾
|
---|
214 | ã¡ãã¥ã¼ã¸ã®æ¿å
|
---|
215 | ¥
|
---|
216 | */
|
---|
217 | Inline void
|
---|
218 | queue_insert_tpri(TCB *tcb, QUEUE *queue)
|
---|
219 | {
|
---|
220 | QUEUE *entry;
|
---|
221 | UINT priority = tcb->priority;
|
---|
222 |
|
---|
223 | for (entry = queue->next; entry != queue; entry = entry->next) {
|
---|
224 | if (priority < ((TCB *) entry)->priority) {
|
---|
225 | break;
|
---|
226 | }
|
---|
227 | }
|
---|
228 | queue_insert_prev(entry, &(tcb->task_queue));
|
---|
229 | }
|
---|
230 |
|
---|
231 | /*
|
---|
232 | * å®è¡ä¸ã®ã¿ã¹ã¯ã®åæã»éä¿¡ãªãã¸ã§ã¯ãã®å¾
|
---|
233 | ã¡ãã¥ã¼ã¸ã®æ¿å
|
---|
234 | ¥
|
---|
235 | */
|
---|
236 | Inline void
|
---|
237 | wobj_queue_insert(WOBJCB *wobjcb)
|
---|
238 | {
|
---|
239 | if ((wobjcb->wobjinib->wobjatr & TA_TPRI) != 0) {
|
---|
240 | queue_insert_tpri(runtsk, &(wobjcb->wait_queue));
|
---|
241 | }
|
---|
242 | else {
|
---|
243 | queue_insert_prev(&(wobjcb->wait_queue),
|
---|
244 | &(runtsk->task_queue));
|
---|
245 | }
|
---|
246 | }
|
---|
247 |
|
---|
248 | /*
|
---|
249 | * åæã»éä¿¡ãªãã¸ã§ã¯ãã«å¯¾ããå¾
|
---|
250 | ã¡ç¶æ
|
---|
251 | ã¸ã®ç§»è¡
|
---|
252 | */
|
---|
253 | #ifdef __wobjwai
|
---|
254 |
|
---|
255 | void
|
---|
256 | wobj_make_wait(WOBJCB *wobjcb, WINFO_WOBJ *winfo)
|
---|
257 | {
|
---|
258 | runtsk->tstat = (TS_WAITING | TS_WAIT_WOBJ | TS_WAIT_WOBJCB);
|
---|
259 | make_wait(&(winfo->winfo));
|
---|
260 | wobj_queue_insert(wobjcb);
|
---|
261 | winfo->wobjcb = wobjcb;
|
---|
262 | LOG_TSKSTAT(runtsk);
|
---|
263 | }
|
---|
264 |
|
---|
265 | #endif /* __wobjwai */
|
---|
266 | #ifdef __wobjwaitmo
|
---|
267 |
|
---|
268 | void
|
---|
269 | wobj_make_wait_tmout(WOBJCB *wobjcb, WINFO_WOBJ *winfo,
|
---|
270 | TMEVTB *tmevtb, TMO tmout)
|
---|
271 | {
|
---|
272 | runtsk->tstat = (TS_WAITING | TS_WAIT_WOBJ | TS_WAIT_WOBJCB);
|
---|
273 | make_wait_tmout(&(winfo->winfo), tmevtb, tmout);
|
---|
274 | wobj_queue_insert(wobjcb);
|
---|
275 | winfo->wobjcb = wobjcb;
|
---|
276 | LOG_TSKSTAT(runtsk);
|
---|
277 | }
|
---|
278 |
|
---|
279 | #endif /* __wobjwaitmo */
|
---|
280 | /*
|
---|
281 | * ã¿ã¹ã¯ã®åªå
|
---|
282 | åº¦å¤æ´æã®å¦ç
|
---|
283 | */
|
---|
284 | #ifdef __wobjpri
|
---|
285 |
|
---|
286 | void
|
---|
287 | wobj_change_priority(WOBJCB *wobjcb, TCB *tcb)
|
---|
288 | {
|
---|
289 | if ((wobjcb->wobjinib->wobjatr & TA_TPRI) != 0) {
|
---|
290 | queue_delete(&(tcb->task_queue));
|
---|
291 | queue_insert_tpri(tcb, &(wobjcb->wait_queue));
|
---|
292 | }
|
---|
293 | }
|
---|
294 |
|
---|
295 | #endif /* __wobjpri */
|
---|