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

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

ASP for EWARM のコミット.

File size: 14.5 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: eventflag.c 1966 2010-11-20 07:23:56Z ertl-hiro $
45 */
46
47/*
48 * ƒCƒxƒ“ƒgƒtƒ‰ƒO‹@”\
49 */
50
51#include "kernel_impl.h"
52#include "check.h"
53#include "task.h"
54#include "wait.h"
55#include "eventflag.h"
56
57/*
58 * ƒgƒŒ[ƒXƒƒOƒ}ƒNƒ‚̃fƒtƒHƒ‹ƒg’è‹`
59 */
60#ifndef LOG_ACRE_FLG_ENTER
61#define LOG_ACRE_FLG_ENTER(pk_cflg)
62#endif /* LOG_ACRE_FLG_ENTER */
63
64#ifndef LOG_ACRE_FLG_LEAVE
65#define LOG_ACRE_FLG_LEAVE(ercd)
66#endif /* LOG_ACRE_FLG_LEAVE */
67
68#ifndef LOG_DEL_FLG_ENTER
69#define LOG_DEL_FLG_ENTER(flgid)
70#endif /* LOG_DEL_FLG_ENTER */
71
72#ifndef LOG_DEL_FLG_LEAVE
73#define LOG_DEL_FLG_LEAVE(ercd)
74#endif /* LOG_DEL_FLG_LEAVE */
75
76#ifndef LOG_SET_FLG_ENTER
77#define LOG_SET_FLG_ENTER(flgid, setptn)
78#endif /* LOG_SET_FLG_ENTER */
79
80#ifndef LOG_SET_FLG_LEAVE
81#define LOG_SET_FLG_LEAVE(ercd)
82#endif /* LOG_SET_FLG_LEAVE */
83
84#ifndef LOG_ISET_FLG_ENTER
85#define LOG_ISET_FLG_ENTER(flgid, setptn)
86#endif /* LOG_ISET_FLG_ENTER */
87
88#ifndef LOG_ISET_FLG_LEAVE
89#define LOG_ISET_FLG_LEAVE(ercd)
90#endif /* LOG_ISET_FLG_LEAVE */
91
92#ifndef LOG_CLR_FLG_ENTER
93#define LOG_CLR_FLG_ENTER(flgid, clrptn)
94#endif /* LOG_CLR_FLG_ENTER */
95
96#ifndef LOG_CLR_FLG_LEAVE
97#define LOG_CLR_FLG_LEAVE(ercd)
98#endif /* LOG_CLR_FLG_LEAVE */
99
100#ifndef LOG_WAI_FLG_ENTER
101#define LOG_WAI_FLG_ENTER(flgid, waiptn, wfmode, p_flgptn)
102#endif /* LOG_WAI_FLG_ENTER */
103
104#ifndef LOG_WAI_FLG_LEAVE
105#define LOG_WAI_FLG_LEAVE(ercd, flgptn)
106#endif /* LOG_WAI_FLG_LEAVE */
107
108#ifndef LOG_POL_FLG_ENTER
109#define LOG_POL_FLG_ENTER(flgid, waiptn, wfmode, p_flgptn)
110#endif /* LOG_POL_FLG_ENTER */
111
112#ifndef LOG_POL_FLG_LEAVE
113#define LOG_POL_FLG_LEAVE(ercd, flgptn)
114#endif /* LOG_POL_FLG_LEAVE */
115
116#ifndef LOG_TWAI_FLG_ENTER
117#define LOG_TWAI_FLG_ENTER(flgid, waiptn, wfmode, p_flgptn, tmout)
118#endif /* LOG_TWAI_FLG_ENTER */
119
120#ifndef LOG_TWAI_FLG_LEAVE
121#define LOG_TWAI_FLG_LEAVE(ercd, flgptn)
122#endif /* LOG_TWAI_FLG_LEAVE */
123
124#ifndef LOG_INI_FLG_ENTER
125#define LOG_INI_FLG_ENTER(flgid)
126#endif /* LOG_INI_FLG_ENTER */
127
128#ifndef LOG_INI_FLG_LEAVE
129#define LOG_INI_FLG_LEAVE(ercd)
130#endif /* LOG_INI_FLG_LEAVE */
131
132#ifndef LOG_REF_FLG_ENTER
133#define LOG_REF_FLG_ENTER(flgid, pk_rflg)
134#endif /* LOG_REF_FLG_ENTER */
135
136#ifndef LOG_REF_FLG_LEAVE
137#define LOG_REF_FLG_LEAVE(ercd, pk_rflg)
138#endif /* LOG_REF_FLG_LEAVE */
139
140/*
141 * ƒCƒxƒ“ƒgƒtƒ‰ƒO‚̐”
142 */
143#define tnum_flg ((uint_t)(tmax_flgid - TMIN_FLGID + 1))
144#define tnum_sflg ((uint_t)(tmax_sflgid - TMIN_FLGID + 1))
145
146/*
147 * ƒCƒxƒ“ƒgƒtƒ‰ƒOID‚©‚çƒCƒxƒ“ƒgƒtƒ‰ƒOŠÇ—ƒuƒƒbƒN‚ðŽæ‚èo‚·‚½‚߂̃}ƒNƒ
148 */
149#define INDEX_FLG(flgid) ((uint_t)((flgid) - TMIN_FLGID))
150#define get_flgcb(flgid) (&(flgcb_table[INDEX_FLG(flgid)]))
151
152#ifdef TOPPERS_flgini
153
154/*
155 * Žg—p‚µ‚Ä‚¢‚È‚¢ƒCƒxƒ“ƒgƒtƒ‰ƒOŠÇ—ƒuƒƒbƒN‚̃ŠƒXƒg
156 */
157QUEUE free_flgcb;
158
159/*
160 * ƒCƒxƒ“ƒgƒtƒ‰ƒO‹@”\‚̏‰Šú‰»
161 */
162void
163initialize_eventflag(void)
164{
165 uint_t i, j;
166 FLGCB *p_flgcb;
167 FLGINIB *p_flginib;
168
169 for (p_flgcb = flgcb_table, i = 0; i < tnum_sflg; p_flgcb++, i++) {
170 queue_initialize(&(p_flgcb->wait_queue));
171 p_flgcb->p_flginib = &(flginib_table[i]);
172 p_flgcb->flgptn = p_flgcb->p_flginib->iflgptn;
173 }
174 queue_initialize(&free_flgcb);
175 for (j = 0; i < tnum_flg; p_flgcb++, i++, j++) {
176 p_flginib = &(aflginib_table[j]);
177 p_flginib->flgatr = TA_NOEXS;
178 p_flgcb->p_flginib = ((const FLGINIB *) p_flginib);
179 queue_insert_prev(&free_flgcb, &(p_flgcb->wait_queue));
180 }
181}
182
183#endif /* TOPPERS_flgini */
184
185/*
186 * ƒCƒxƒ“ƒgƒtƒ‰ƒO‚̐¶¬
187 */
188#ifdef TOPPERS_acre_flg
189
190ER_UINT
191acre_flg(const T_CFLG *pk_cflg)
192{
193 FLGCB *p_flgcb;
194 FLGINIB *p_flginib;
195 ER ercd;
196
197 LOG_ACRE_FLG_ENTER(pk_cflg);
198 CHECK_TSKCTX_UNL();
199 CHECK_RSATR(pk_cflg->flgatr, TA_TPRI|TA_WMUL|TA_CLR);
200
201 t_lock_cpu();
202 if (queue_empty(&free_flgcb)) {
203 ercd = E_NOID;
204 }
205 else {
206 p_flgcb = ((FLGCB *) queue_delete_next(&free_flgcb));
207 p_flginib = (FLGINIB *)(p_flgcb->p_flginib);
208 p_flginib->flgatr = pk_cflg->flgatr;
209 p_flginib->iflgptn = pk_cflg->iflgptn;
210
211 queue_initialize(&(p_flgcb->wait_queue));
212 p_flgcb->flgptn = p_flgcb->p_flginib->iflgptn;
213 ercd = FLGID(p_flgcb);
214 }
215 t_unlock_cpu();
216
217 error_exit:
218 LOG_ACRE_FLG_LEAVE(ercd);
219 return(ercd);
220}
221
222#endif /* TOPPERS_acre_flg */
223
224/*
225 * ƒCƒxƒ“ƒgƒtƒ‰ƒO‚̍폜
226 */
227#ifdef TOPPERS_del_flg
228
229ER
230del_flg(ID flgid)
231{
232 FLGCB *p_flgcb;
233 FLGINIB *p_flginib;
234 bool_t dspreq;
235 ER ercd;
236
237 LOG_DEL_FLG_ENTER(flgid);
238 CHECK_TSKCTX_UNL();
239 CHECK_FLGID(flgid);
240 p_flgcb = get_flgcb(flgid);
241
242 t_lock_cpu();
243 if (p_flgcb->p_flginib->flgatr == TA_NOEXS) {
244 ercd = E_NOEXS;
245 }
246 else if (FLGID(p_flgcb) > tmax_sflgid) {
247 dspreq = init_wait_queue(&(p_flgcb->wait_queue));
248 p_flginib = (FLGINIB *)(p_flgcb->p_flginib);
249 p_flginib->flgatr = TA_NOEXS;
250 queue_insert_prev(&free_flgcb, &(p_flgcb->wait_queue));
251 if (dspreq) {
252 dispatch();
253 }
254 ercd = E_OK;
255 }
256 else {
257 ercd = E_OBJ;
258 }
259 t_unlock_cpu();
260
261 error_exit:
262 LOG_DEL_FLG_LEAVE(ercd);
263 return(ercd);
264}
265
266#endif /* TOPPERS_del_flg */
267
268/*
269 * ƒCƒxƒ“ƒgƒtƒ‰ƒO‘Ò‚¿‰ðœðŒ‚̃`ƒFƒbƒN
270 */
271#ifdef TOPPERS_flgcnd
272
273bool_t
274check_flg_cond(FLGCB *p_flgcb, FLGPTN waiptn, MODE wfmode, FLGPTN *p_flgptn)
275{
276 if ((wfmode & TWF_ORW) != 0U ? (p_flgcb->flgptn & waiptn) != 0U
277 : (p_flgcb->flgptn & waiptn) == waiptn) {
278 *p_flgptn = p_flgcb->flgptn;
279 if ((p_flgcb->p_flginib->flgatr & TA_CLR) != 0U) {
280 p_flgcb->flgptn = 0U;
281 }
282 return(true);
283 }
284 return(false);
285}
286
287#endif /* TOPPERS_flgcnd */
288
289/*
290 * ƒCƒxƒ“ƒgƒtƒ‰ƒO‚̃Zƒbƒg
291 */
292#ifdef TOPPERS_set_flg
293
294ER
295set_flg(ID flgid, FLGPTN setptn)
296{
297 FLGCB *p_flgcb;
298 QUEUE *p_queue;
299 TCB *p_tcb;
300 WINFO_FLG *p_winfo_flg;
301 bool_t dspreq = false;
302 ER ercd;
303
304 LOG_SET_FLG_ENTER(flgid, setptn);
305 CHECK_TSKCTX_UNL();
306 CHECK_FLGID(flgid);
307 p_flgcb = get_flgcb(flgid);
308
309 t_lock_cpu();
310 if (p_flgcb->p_flginib->flgatr == TA_NOEXS) {
311 ercd = E_NOEXS;
312 }
313 else {
314 p_flgcb->flgptn |= setptn;
315 p_queue = p_flgcb->wait_queue.p_next;
316 while (p_queue != &(p_flgcb->wait_queue)) {
317 p_tcb = (TCB *) p_queue;
318 p_queue = p_queue->p_next;
319 p_winfo_flg = (WINFO_FLG *)(p_tcb->p_winfo);
320 if (check_flg_cond(p_flgcb, p_winfo_flg->waiptn,
321 p_winfo_flg->wfmode, &(p_winfo_flg->flgptn))) {
322 queue_delete(&(p_tcb->task_queue));
323 if (wait_complete(p_tcb)) {
324 dspreq = true;
325 }
326 if ((p_flgcb->p_flginib->flgatr & TA_CLR) != 0U) {
327 break;
328 }
329 }
330 }
331 if (dspreq) {
332 dispatch();
333 }
334 ercd = E_OK;
335 }
336 t_unlock_cpu();
337
338 error_exit:
339 LOG_SET_FLG_LEAVE(ercd);
340 return(ercd);
341}
342
343#endif /* TOPPERS_set_flg */
344
345/*
346 * ƒCƒxƒ“ƒgƒtƒ‰ƒO‚̃Zƒbƒgi”ñƒ^ƒXƒNƒRƒ“ƒeƒLƒXƒg—pj
347 */
348#ifdef TOPPERS_iset_flg
349
350ER
351iset_flg(ID flgid, FLGPTN setptn)
352{
353 FLGCB *p_flgcb;
354 QUEUE *p_queue;
355 TCB *p_tcb;
356 WINFO_FLG *p_winfo_flg;
357 ER ercd;
358
359 LOG_ISET_FLG_ENTER(flgid, setptn);
360 CHECK_INTCTX_UNL();
361 CHECK_FLGID(flgid);
362 p_flgcb = get_flgcb(flgid);
363
364 i_lock_cpu();
365 if (p_flgcb->p_flginib->flgatr == TA_NOEXS) {
366 ercd = E_NOEXS;
367 }
368 else {
369 p_flgcb->flgptn |= setptn;
370 p_queue = p_flgcb->wait_queue.p_next;
371 while (p_queue != &(p_flgcb->wait_queue)) {
372 p_tcb = (TCB *) p_queue;
373 p_queue = p_queue->p_next;
374 p_winfo_flg = (WINFO_FLG *)(p_tcb->p_winfo);
375 if (check_flg_cond(p_flgcb, p_winfo_flg->waiptn,
376 p_winfo_flg->wfmode, &(p_winfo_flg->flgptn))) {
377 queue_delete(&(p_tcb->task_queue));
378 if (wait_complete(p_tcb)) {
379 reqflg = true;
380 }
381 if ((p_flgcb->p_flginib->flgatr & TA_CLR) != 0U) {
382 break;
383 }
384 }
385 }
386 ercd = E_OK;
387 }
388 i_unlock_cpu();
389
390 error_exit:
391 LOG_ISET_FLG_LEAVE(ercd);
392 return(ercd);
393}
394
395#endif /* TOPPERS_iset_flg */
396
397/*
398 * ƒCƒxƒ“ƒgƒtƒ‰ƒO‚̃NƒŠƒA
399 */
400#ifdef TOPPERS_clr_flg
401
402ER
403clr_flg(ID flgid, FLGPTN clrptn)
404{
405 FLGCB *p_flgcb;
406 ER ercd;
407
408 LOG_CLR_FLG_ENTER(flgid, clrptn);
409 CHECK_TSKCTX_UNL();
410 CHECK_FLGID(flgid);
411 p_flgcb = get_flgcb(flgid);
412
413 t_lock_cpu();
414 if (p_flgcb->p_flginib->flgatr == TA_NOEXS) {
415 ercd = E_NOEXS;
416 }
417 else {
418 p_flgcb->flgptn &= clrptn;
419 ercd = E_OK;
420 }
421 t_unlock_cpu();
422
423 error_exit:
424 LOG_CLR_FLG_LEAVE(ercd);
425 return(ercd);
426}
427
428#endif /* TOPPERS_clr_flg */
429
430/*
431 * ƒCƒxƒ“ƒgƒtƒ‰ƒO‘Ò‚¿
432 */
433#ifdef TOPPERS_wai_flg
434
435ER
436wai_flg(ID flgid, FLGPTN waiptn, MODE wfmode, FLGPTN *p_flgptn)
437{
438 FLGCB *p_flgcb;
439 WINFO_FLG winfo_flg;
440 ER ercd;
441
442 LOG_WAI_FLG_ENTER(flgid, waiptn, wfmode, p_flgptn);
443 CHECK_DISPATCH();
444 CHECK_FLGID(flgid);
445 CHECK_PAR(waiptn != 0U);
446 CHECK_PAR(wfmode == TWF_ORW || wfmode == TWF_ANDW);
447 p_flgcb = get_flgcb(flgid);
448
449 t_lock_cpu();
450 if (p_flgcb->p_flginib->flgatr == TA_NOEXS) {
451 ercd = E_NOEXS;
452 }
453 else if ((p_flgcb->p_flginib->flgatr & TA_WMUL) == 0U
454 && !queue_empty(&(p_flgcb->wait_queue))) {
455 ercd = E_ILUSE;
456 }
457 else if (check_flg_cond(p_flgcb, waiptn, wfmode, p_flgptn)) {
458 ercd = E_OK;
459 }
460 else {
461 winfo_flg.waiptn = waiptn;
462 winfo_flg.wfmode = wfmode;
463 p_runtsk->tstat = (TS_WAITING | TS_WAIT_FLG);
464 wobj_make_wait((WOBJCB *) p_flgcb, (WINFO_WOBJ *) &winfo_flg);
465 dispatch();
466 ercd = winfo_flg.winfo.wercd;
467 if (ercd == E_OK) {
468 *p_flgptn = winfo_flg.flgptn;
469 }
470 }
471 t_unlock_cpu();
472
473 error_exit:
474 LOG_WAI_FLG_LEAVE(ercd, *p_flgptn);
475 return(ercd);
476}
477
478#endif /* TOPPERS_wai_flg */
479
480/*
481 * ƒCƒxƒ“ƒgƒtƒ‰ƒO‘Ò‚¿iƒ|[ƒŠƒ“ƒOj
482 */
483#ifdef TOPPERS_pol_flg
484
485ER
486pol_flg(ID flgid, FLGPTN waiptn, MODE wfmode, FLGPTN *p_flgptn)
487{
488 FLGCB *p_flgcb;
489 ER ercd;
490
491 LOG_POL_FLG_ENTER(flgid, waiptn, wfmode, p_flgptn);
492 CHECK_TSKCTX_UNL();
493 CHECK_FLGID(flgid);
494 CHECK_PAR(waiptn != 0U);
495 CHECK_PAR(wfmode == TWF_ORW || wfmode == TWF_ANDW);
496 p_flgcb = get_flgcb(flgid);
497
498 t_lock_cpu();
499 if (p_flgcb->p_flginib->flgatr == TA_NOEXS) {
500 ercd = E_NOEXS;
501 }
502 else if ((p_flgcb->p_flginib->flgatr & TA_WMUL) == 0U
503 && !queue_empty(&(p_flgcb->wait_queue))) {
504 ercd = E_ILUSE;
505 }
506 else if (check_flg_cond(p_flgcb, waiptn, wfmode, p_flgptn)) {
507 ercd = E_OK;
508 }
509 else {
510 ercd = E_TMOUT;
511 }
512 t_unlock_cpu();
513
514 error_exit:
515 LOG_POL_FLG_LEAVE(ercd, *p_flgptn);
516 return(ercd);
517}
518
519#endif /* TOPPERS_pol_flg */
520
521/*
522 * ƒCƒxƒ“ƒgƒtƒ‰ƒO‘Ò‚¿iƒ^ƒCƒ€ƒAƒEƒg‚ ‚èj
523 */
524#ifdef TOPPERS_twai_flg
525
526ER
527twai_flg(ID flgid, FLGPTN waiptn, MODE wfmode, FLGPTN *p_flgptn, TMO tmout)
528{
529 FLGCB *p_flgcb;
530 WINFO_FLG winfo_flg;
531 TMEVTB tmevtb;
532 ER ercd;
533
534 LOG_TWAI_FLG_ENTER(flgid, waiptn, wfmode, p_flgptn, tmout);
535 CHECK_DISPATCH();
536 CHECK_FLGID(flgid);
537 CHECK_PAR(waiptn != 0U);
538 CHECK_PAR(wfmode == TWF_ORW || wfmode == TWF_ANDW);
539 CHECK_TMOUT(tmout);
540 p_flgcb = get_flgcb(flgid);
541
542 t_lock_cpu();
543 if (p_flgcb->p_flginib->flgatr == TA_NOEXS) {
544 ercd = E_NOEXS;
545 }
546 else if ((p_flgcb->p_flginib->flgatr & TA_WMUL) == 0U
547 && !queue_empty(&(p_flgcb->wait_queue))) {
548 ercd = E_ILUSE;
549 }
550 else if (check_flg_cond(p_flgcb, waiptn, wfmode, p_flgptn)) {
551 ercd = E_OK;
552 }
553 else if (tmout == TMO_POL) {
554 ercd = E_TMOUT;
555 }
556 else {
557 winfo_flg.waiptn = waiptn;
558 winfo_flg.wfmode = wfmode;
559 p_runtsk->tstat = (TS_WAITING | TS_WAIT_FLG);
560 wobj_make_wait_tmout((WOBJCB *) p_flgcb, (WINFO_WOBJ *) &winfo_flg,
561 &tmevtb, tmout);
562 dispatch();
563 ercd = winfo_flg.winfo.wercd;
564 if (ercd == E_OK) {
565 *p_flgptn = winfo_flg.flgptn;
566 }
567 }
568 t_unlock_cpu();
569
570 error_exit:
571 LOG_TWAI_FLG_LEAVE(ercd, *p_flgptn);
572 return(ercd);
573}
574
575#endif /* TOPPERS_twai_flg */
576
577/*
578 * ƒCƒxƒ“ƒgƒtƒ‰ƒO‚̍ú‰»
579 */
580#ifdef TOPPERS_ini_flg
581
582ER
583ini_flg(ID flgid)
584{
585 FLGCB *p_flgcb;
586 bool_t dspreq;
587 ER ercd;
588
589 LOG_INI_FLG_ENTER(flgid);
590 CHECK_TSKCTX_UNL();
591 CHECK_FLGID(flgid);
592 p_flgcb = get_flgcb(flgid);
593
594 t_lock_cpu();
595 if (p_flgcb->p_flginib->flgatr == TA_NOEXS) {
596 ercd = E_NOEXS;
597 }
598 else {
599 dspreq = init_wait_queue(&(p_flgcb->wait_queue));
600 p_flgcb->flgptn = p_flgcb->p_flginib->iflgptn;
601 if (dspreq) {
602 dispatch();
603 }
604 ercd = E_OK;
605 }
606 t_unlock_cpu();
607
608 error_exit:
609 LOG_INI_FLG_LEAVE(ercd);
610 return(ercd);
611}
612
613#endif /* TOPPERS_ini_flg */
614
615/*
616 * ƒCƒxƒ“ƒgƒtƒ‰ƒO‚̏ó‘ÔŽQÆ
617 */
618#ifdef TOPPERS_ref_flg
619
620ER
621ref_flg(ID flgid, T_RFLG *pk_rflg)
622{
623 FLGCB *p_flgcb;
624 ER ercd;
625
626 LOG_REF_FLG_ENTER(flgid, pk_rflg);
627 CHECK_TSKCTX_UNL();
628 CHECK_FLGID(flgid);
629 p_flgcb = get_flgcb(flgid);
630
631 t_lock_cpu();
632 if (p_flgcb->p_flginib->flgatr == TA_NOEXS) {
633 ercd = E_NOEXS;
634 }
635 else {
636 pk_rflg->wtskid = wait_tskid(&(p_flgcb->wait_queue));
637 pk_rflg->flgptn = p_flgcb->flgptn;
638 ercd = E_OK;
639 }
640 t_unlock_cpu();
641
642 error_exit:
643 LOG_REF_FLG_LEAVE(ercd, pk_rflg);
644 return(ercd);
645}
646
647#endif /* TOPPERS_ref_flg */
Note: See TracBrowser for help on using the repository browser.