source: extension/dcre/kernel/eventflag.c

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

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