source: EcnlProtoTool/trunk/asp3_dcre/kernel/eventflag.c@ 270

Last change on this file since 270 was 270, checked in by coas-nagasima, 7 years ago

mruby版ECNLプロトタイピング・ツールを追加
  • Property svn:eol-style set to native
  • Property svn:keywords set to Id
  • Property svn:mime-type set to text/x-csrc
File size: 13.9 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-2016 by Embedded and Real-Time Systems Laboratory
9 * Graduate School of Information Science, Nagoya Univ., JAPAN
10 *
11 * 上記著作権者
12は，以下の(1)～(4)の条件を満たす場合に限り，本ソフトウェ
13 * ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
14 * 変・再é…
15å¸ƒï¼ˆä»¥ä¸‹ï¼Œåˆ©ç”¨ã¨å‘¼ã¶ï¼‰ã™ã‚‹ã“とを無償で許諾する．
16 * (1) 本ソフトウェアをソースコードの形で利用する場合には，上記の著作
17 * 権表示，この利用条件および下記の無保証規定が，そのままの形でソー
18 * スコード中に含まれていること．
19 * (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
20 * 用できる形で再é…
21å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œå†é…
22å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨
23 * 者
24マニュアルなど）に，上記の著作権表示，この利用条件および下記
25 * の無保証規定を掲載すること．
26 * (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
27 * 用できない形で再é…
28å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œæ¬¡ã®ã„ずれかの条件を満たすこ
29 * と．
30 * (a) 再é…
31å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨è€…
32マニュアルなど）に，上記の著
33 * 作権表示，この利用条件および下記の無保証規定を掲載すること．
34 * (b) 再é…
35å¸ƒã®å½¢æ…
36‹ã‚’，別に定める方法によって，TOPPERSプロジェクトに
37 * 報告すること．
38 * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
39 * 害からも，上記著作権者
40およびTOPPERSプロジェクトをå…
41è²¬ã™ã‚‹ã“と．
42 * また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
43 * 由に基づく請求からも，上記著作権者
44およびTOPPERSプロジェクトを
45 * å…
46è²¬ã™ã‚‹ã“と．
47 *
48 * 本ソフトウェアは，無保証で提供されているものである．上記著作権者
49お
50 * よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
51 * に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
52 * アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
53 * の責任を負わない．
54 *
55 * $Id: eventflag.c 270 2017-02-09 04:03:47Z coas-nagasima $
56 */
57
58/*
59 * イベントフラグ機能
60 */
61
62#include "kernel_impl.h"
63#include "check.h"
64#include "task.h"
65#include "wait.h"
66#include "eventflag.h"
67
68/*
69 * トレースログマクロのデフォルト定義
70 */
71#ifndef LOG_ACRE_FLG_ENTER
72#define LOG_ACRE_FLG_ENTER(pk_cflg)
73#endif /* LOG_ACRE_FLG_ENTER */
74
75#ifndef LOG_ACRE_FLG_LEAVE
76#define LOG_ACRE_FLG_LEAVE(ercd)
77#endif /* LOG_ACRE_FLG_LEAVE */
78
79#ifndef LOG_DEL_FLG_ENTER
80#define LOG_DEL_FLG_ENTER(flgid)
81#endif /* LOG_DEL_FLG_ENTER */
82
83#ifndef LOG_DEL_FLG_LEAVE
84#define LOG_DEL_FLG_LEAVE(ercd)
85#endif /* LOG_DEL_FLG_LEAVE */
86
87#ifndef LOG_SET_FLG_ENTER
88#define LOG_SET_FLG_ENTER(flgid, setptn)
89#endif /* LOG_SET_FLG_ENTER */
90
91#ifndef LOG_SET_FLG_LEAVE
92#define LOG_SET_FLG_LEAVE(ercd)
93#endif /* LOG_SET_FLG_LEAVE */
94
95#ifndef LOG_CLR_FLG_ENTER
96#define LOG_CLR_FLG_ENTER(flgid, clrptn)
97#endif /* LOG_CLR_FLG_ENTER */
98
99#ifndef LOG_CLR_FLG_LEAVE
100#define LOG_CLR_FLG_LEAVE(ercd)
101#endif /* LOG_CLR_FLG_LEAVE */
102
103#ifndef LOG_WAI_FLG_ENTER
104#define LOG_WAI_FLG_ENTER(flgid, waiptn, wfmode, p_flgptn)
105#endif /* LOG_WAI_FLG_ENTER */
106
107#ifndef LOG_WAI_FLG_LEAVE
108#define LOG_WAI_FLG_LEAVE(ercd, p_flgptn)
109#endif /* LOG_WAI_FLG_LEAVE */
110
111#ifndef LOG_POL_FLG_ENTER
112#define LOG_POL_FLG_ENTER(flgid, waiptn, wfmode, p_flgptn)
113#endif /* LOG_POL_FLG_ENTER */
114
115#ifndef LOG_POL_FLG_LEAVE
116#define LOG_POL_FLG_LEAVE(ercd, p_flgptn)
117#endif /* LOG_POL_FLG_LEAVE */
118
119#ifndef LOG_TWAI_FLG_ENTER
120#define LOG_TWAI_FLG_ENTER(flgid, waiptn, wfmode, p_flgptn, tmout)
121#endif /* LOG_TWAI_FLG_ENTER */
122
123#ifndef LOG_TWAI_FLG_LEAVE
124#define LOG_TWAI_FLG_LEAVE(ercd, p_flgptn)
125#endif /* LOG_TWAI_FLG_LEAVE */
126
127#ifndef LOG_INI_FLG_ENTER
128#define LOG_INI_FLG_ENTER(flgid)
129#endif /* LOG_INI_FLG_ENTER */
130
131#ifndef LOG_INI_FLG_LEAVE
132#define LOG_INI_FLG_LEAVE(ercd)
133#endif /* LOG_INI_FLG_LEAVE */
134
135#ifndef LOG_REF_FLG_ENTER
136#define LOG_REF_FLG_ENTER(flgid, pk_rflg)
137#endif /* LOG_REF_FLG_ENTER */
138
139#ifndef LOG_REF_FLG_LEAVE
140#define LOG_REF_FLG_LEAVE(ercd, pk_rflg)
141#endif /* LOG_REF_FLG_LEAVE */
142
143/*
144 * イベントフラグの数
145 */
146#define tnum_flg ((uint_t)(tmax_flgid - TMIN_FLGID + 1))
147#define tnum_sflg ((uint_t)(tmax_sflgid - TMIN_FLGID + 1))
148
149/*
150 * イベントフラグIDからイベントフラグ管理ブロックを取り出すためのマクロ
151 */
152#define INDEX_FLG(flgid) ((uint_t)((flgid) - TMIN_FLGID))
153#define get_flgcb(flgid) (&(flgcb_table[INDEX_FLG(flgid)]))
154
155#ifdef TOPPERS_flgini
156
157/*
158 * 使用していないイベントフラグ管理ブロックのリスト
159 */
160QUEUE free_flgcb;
161
162/*
163 * イベントフラグ機能の初期化
164 */
165void
166initialize_eventflag(void)
167{
168 uint_t i, j;
169 FLGCB *p_flgcb;
170 FLGINIB *p_flginib;
171
172 for (i = 0; i < tnum_sflg; i++) {
173 p_flgcb = &(flgcb_table[i]);
174 queue_initialize(&(p_flgcb->wait_queue));
175 p_flgcb->p_flginib = &(flginib_table[i]);
176 p_flgcb->flgptn = p_flgcb->p_flginib->iflgptn;
177 }
178 queue_initialize(&free_flgcb);
179 for (j = 0; i < tnum_flg; i++, j++) {
180 p_flgcb = &(flgcb_table[i]);
181 p_flginib = &(aflginib_table[j]);
182 p_flginib->flgatr = TA_NOEXS;
183 p_flgcb->p_flginib = ((const FLGINIB *) p_flginib);
184 queue_insert_prev(&free_flgcb, &(p_flgcb->wait_queue));
185 }
186}
187
188#endif /* TOPPERS_flgini */
189
190/*
191 * イベントフラグ待
192ち解除条件のチェック
193 */
194#ifdef TOPPERS_flgcnd
195
196bool_t
197check_flg_cond(FLGCB *p_flgcb, FLGPTN waiptn, MODE wfmode, FLGPTN *p_flgptn)
198{
199 if ((wfmode & TWF_ORW) != 0U ? (p_flgcb->flgptn & waiptn) != 0U
200 : (p_flgcb->flgptn & waiptn) == waiptn) {
201 *p_flgptn = p_flgcb->flgptn;
202 if ((p_flgcb->p_flginib->flgatr & TA_CLR) != 0U) {
203 p_flgcb->flgptn = 0U;
204 }
205 return(true);
206 }
207 return(false);
208}
209
210#endif /* TOPPERS_flgcnd */
211
212/*
213 * イベントフラグの生成
214 *
215 * pk_cflg->iflgptnは，エラーチェックをせず，一度しか参ç…
216§ã—ないため，
217 * ローカル変数にコピーする必
218要がない（途中で書き換わっても支障がな
219 * い）．
220 */
221#ifdef TOPPERS_acre_flg
222
223ER_UINT
224acre_flg(const T_CFLG *pk_cflg)
225{
226 FLGCB *p_flgcb;
227 FLGINIB *p_flginib;
228 ATR flgatr;
229 ER ercd;
230
231 LOG_ACRE_FLG_ENTER(pk_cflg);
232 CHECK_TSKCTX_UNL();
233
234 flgatr = pk_cflg->flgatr;
235
236 CHECK_RSATR(flgatr, TA_TPRI|TA_WMUL|TA_CLR);
237
238 lock_cpu();
239 if (tnum_flg == 0 || queue_empty(&free_flgcb)) {
240 ercd = E_NOID;
241 }
242 else {
243 p_flgcb = ((FLGCB *) queue_delete_next(&free_flgcb));
244 p_flginib = (FLGINIB *)(p_flgcb->p_flginib);
245 p_flginib->flgatr = flgatr;
246 p_flginib->iflgptn = pk_cflg->iflgptn;
247
248 queue_initialize(&(p_flgcb->wait_queue));
249 p_flgcb->flgptn = p_flgcb->p_flginib->iflgptn;
250 ercd = FLGID(p_flgcb);
251 }
252
253 error_exit:
254 LOG_ACRE_FLG_LEAVE(ercd);
255 return(ercd);
256}
257
258#endif /* TOPPERS_acre_flg */
259
260/*
261 * イベントフラグの削除
262 */
263#ifdef TOPPERS_del_flg
264
265ER
266del_flg(ID flgid)
267{
268 FLGCB *p_flgcb;
269 FLGINIB *p_flginib;
270 ER ercd;
271
272 LOG_DEL_FLG_ENTER(flgid);
273 CHECK_TSKCTX_UNL();
274 CHECK_PAR(VALID_FLGID(flgid));
275 p_flgcb = get_flgcb(flgid);
276
277 lock_cpu();
278 if (p_flgcb->p_flginib->flgatr == TA_NOEXS) {
279 ercd = E_NOEXS;
280 }
281 else if (flgid <= tmax_sflgid) {
282 ercd = E_OBJ;
283 }
284 else {
285 init_wait_queue(&(p_flgcb->wait_queue));
286 p_flginib = (FLGINIB *)(p_flgcb->p_flginib);
287 p_flginib->flgatr = TA_NOEXS;
288 queue_insert_prev(&free_flgcb, &(p_flgcb->wait_queue));
289 if (p_runtsk != p_schedtsk) {
290 dispatch();
291 }
292 ercd = E_OK;
293 }
294 unlock_cpu();
295
296 error_exit:
297 LOG_DEL_FLG_LEAVE(ercd);
298 return(ercd);
299}
300
301#endif /* TOPPERS_del_flg */
302
303/*
304 * イベントフラグのセット
305 */
306#ifdef TOPPERS_set_flg
307
308ER
309set_flg(ID flgid, FLGPTN setptn)
310{
311 FLGCB *p_flgcb;
312 QUEUE *p_queue;
313 TCB *p_tcb;
314 WINFO_FLG *p_winfo_flg;
315 ER ercd;
316
317 LOG_SET_FLG_ENTER(flgid, setptn);
318 CHECK_UNL();
319 CHECK_ID(VALID_FLGID(flgid));
320 p_flgcb = get_flgcb(flgid);
321
322 lock_cpu();
323 if (p_flgcb->p_flginib->flgatr == TA_NOEXS) {
324 ercd = E_NOEXS;
325 }
326 else {
327 p_flgcb->flgptn |= setptn;
328 p_queue = p_flgcb->wait_queue.p_next;
329 while (p_queue != &(p_flgcb->wait_queue)) {
330 p_tcb = (TCB *) p_queue;
331 p_queue = p_queue->p_next;
332 p_winfo_flg = (WINFO_FLG *)(p_tcb->p_winfo);
333 if (check_flg_cond(p_flgcb, p_winfo_flg->waiptn,
334 p_winfo_flg->wfmode, &(p_winfo_flg->waiptn))) {
335 queue_delete(&(p_tcb->task_queue));
336 wait_complete(p_tcb);
337 if ((p_flgcb->p_flginib->flgatr & TA_CLR) != 0U) {
338 break;
339 }
340 }
341 }
342 if (p_runtsk != p_schedtsk) {
343 if (!sense_context()) {
344 dispatch();
345 }
346 else {
347 request_dispatch();
348 }
349 }
350 ercd = E_OK;
351 }
352 unlock_cpu();
353
354 error_exit:
355 LOG_SET_FLG_LEAVE(ercd);
356 return(ercd);
357}
358
359#endif /* TOPPERS_set_flg */
360
361/*
362 * イベントフラグのクリア
363 */
364#ifdef TOPPERS_clr_flg
365
366ER
367clr_flg(ID flgid, FLGPTN clrptn)
368{
369 FLGCB *p_flgcb;
370 ER ercd;
371
372 LOG_CLR_FLG_ENTER(flgid, clrptn);
373 CHECK_TSKCTX_UNL();
374 CHECK_ID(VALID_FLGID(flgid));
375 p_flgcb = get_flgcb(flgid);
376
377 lock_cpu();
378 if (p_flgcb->p_flginib->flgatr == TA_NOEXS) {
379 ercd = E_NOEXS;
380 }
381 else {
382 p_flgcb->flgptn &= clrptn;
383 ercd = E_OK;
384 }
385 unlock_cpu();
386
387 error_exit:
388 LOG_CLR_FLG_LEAVE(ercd);
389 return(ercd);
390}
391
392#endif /* TOPPERS_clr_flg */
393
394/*
395 * イベントフラグ待
396ち
397 */
398#ifdef TOPPERS_wai_flg
399
400ER
401wai_flg(ID flgid, FLGPTN waiptn, MODE wfmode, FLGPTN *p_flgptn)
402{
403 FLGCB *p_flgcb;
404 WINFO_FLG winfo_flg;
405 ER ercd;
406
407 LOG_WAI_FLG_ENTER(flgid, waiptn, wfmode, p_flgptn);
408 CHECK_DISPATCH();
409 CHECK_ID(VALID_FLGID(flgid));
410 CHECK_PAR(waiptn != 0U);
411 CHECK_PAR(wfmode == TWF_ORW || wfmode == TWF_ANDW);
412 p_flgcb = get_flgcb(flgid);
413
414 lock_cpu_dsp();
415 if (p_flgcb->p_flginib->flgatr == TA_NOEXS) {
416 ercd = E_NOEXS;
417 }
418 else if (p_runtsk->raster) {
419 ercd = E_RASTER;
420 }
421 else if ((p_flgcb->p_flginib->flgatr & TA_WMUL) == 0U
422 && !queue_empty(&(p_flgcb->wait_queue))) {
423 ercd = E_ILUSE;
424 }
425 else if (check_flg_cond(p_flgcb, waiptn, wfmode, p_flgptn)) {
426 ercd = E_OK;
427 }
428 else {
429 winfo_flg.waiptn = waiptn;
430 winfo_flg.wfmode = wfmode;
431 p_runtsk->tstat = TS_WAITING_FLG;
432 wobj_make_wait((WOBJCB *) p_flgcb, (WINFO_WOBJ *) &winfo_flg);
433 dispatch();
434 ercd = winfo_flg.winfo.wercd;
435 if (ercd == E_OK) {
436 *p_flgptn = winfo_flg.waiptn;
437 }
438 }
439 unlock_cpu_dsp();
440
441 error_exit:
442 LOG_WAI_FLG_LEAVE(ercd, p_flgptn);
443 return(ercd);
444}
445
446#endif /* TOPPERS_wai_flg */
447
448/*
449 * イベントフラグ待
450ち（ポーリング）
451 */
452#ifdef TOPPERS_pol_flg
453
454ER
455pol_flg(ID flgid, FLGPTN waiptn, MODE wfmode, FLGPTN *p_flgptn)
456{
457 FLGCB *p_flgcb;
458 ER ercd;
459
460 LOG_POL_FLG_ENTER(flgid, waiptn, wfmode, p_flgptn);
461 CHECK_TSKCTX_UNL();
462 CHECK_ID(VALID_FLGID(flgid));
463 CHECK_PAR(waiptn != 0U);
464 CHECK_PAR(wfmode == TWF_ORW || wfmode == TWF_ANDW);
465 p_flgcb = get_flgcb(flgid);
466
467 lock_cpu();
468 if (p_flgcb->p_flginib->flgatr == TA_NOEXS) {
469 ercd = E_NOEXS;
470 }
471 else if ((p_flgcb->p_flginib->flgatr & TA_WMUL) == 0U
472 && !queue_empty(&(p_flgcb->wait_queue))) {
473 ercd = E_ILUSE;
474 }
475 else if (check_flg_cond(p_flgcb, waiptn, wfmode, p_flgptn)) {
476 ercd = E_OK;
477 }
478 else {
479 ercd = E_TMOUT;
480 }
481 unlock_cpu();
482
483 error_exit:
484 LOG_POL_FLG_LEAVE(ercd, p_flgptn);
485 return(ercd);
486}
487
488#endif /* TOPPERS_pol_flg */
489
490/*
491 * イベントフラグ待
492ち（タイムアウトあり）
493 */
494#ifdef TOPPERS_twai_flg
495
496ER
497twai_flg(ID flgid, FLGPTN waiptn, MODE wfmode, FLGPTN *p_flgptn, TMO tmout)
498{
499 FLGCB *p_flgcb;
500 WINFO_FLG winfo_flg;
501 TMEVTB tmevtb;
502 ER ercd;
503
504 LOG_TWAI_FLG_ENTER(flgid, waiptn, wfmode, p_flgptn, tmout);
505 CHECK_DISPATCH();
506 CHECK_ID(VALID_FLGID(flgid));
507 CHECK_PAR(waiptn != 0U);
508 CHECK_PAR(wfmode == TWF_ORW || wfmode == TWF_ANDW);
509 CHECK_PAR(VALID_TMOUT(tmout));
510 p_flgcb = get_flgcb(flgid);
511
512 lock_cpu_dsp();
513 if (p_flgcb->p_flginib->flgatr == TA_NOEXS) {
514 ercd = E_NOEXS;
515 }
516 else if (p_runtsk->raster) {
517 ercd = E_RASTER;
518 }
519 else if ((p_flgcb->p_flginib->flgatr & TA_WMUL) == 0U
520 && !queue_empty(&(p_flgcb->wait_queue))) {
521 ercd = E_ILUSE;
522 }
523 else if (check_flg_cond(p_flgcb, waiptn, wfmode, p_flgptn)) {
524 ercd = E_OK;
525 }
526 else if (tmout == TMO_POL) {
527 ercd = E_TMOUT;
528 }
529 else {
530 winfo_flg.waiptn = waiptn;
531 winfo_flg.wfmode = wfmode;
532 p_runtsk->tstat = TS_WAITING_FLG;
533 wobj_make_wait_tmout((WOBJCB *) p_flgcb, (WINFO_WOBJ *) &winfo_flg,
534 &tmevtb, tmout);
535 dispatch();
536 ercd = winfo_flg.winfo.wercd;
537 if (ercd == E_OK) {
538 *p_flgptn = winfo_flg.waiptn;
539 }
540 }
541 unlock_cpu_dsp();
542
543 error_exit:
544 LOG_TWAI_FLG_LEAVE(ercd, p_flgptn);
545 return(ercd);
546}
547
548#endif /* TOPPERS_twai_flg */
549
550/*
551 * イベントフラグの再初期化
552 */
553#ifdef TOPPERS_ini_flg
554
555ER
556ini_flg(ID flgid)
557{
558 FLGCB *p_flgcb;
559 ER ercd;
560
561 LOG_INI_FLG_ENTER(flgid);
562 CHECK_TSKCTX_UNL();
563 CHECK_ID(VALID_FLGID(flgid));
564 p_flgcb = get_flgcb(flgid);
565
566 lock_cpu();
567 if (p_flgcb->p_flginib->flgatr == TA_NOEXS) {
568 ercd = E_NOEXS;
569 }
570 else {
571 init_wait_queue(&(p_flgcb->wait_queue));
572 p_flgcb->flgptn = p_flgcb->p_flginib->iflgptn;
573 if (p_runtsk != p_schedtsk) {
574 dispatch();
575 }
576 ercd = E_OK;
577 }
578 unlock_cpu();
579
580 error_exit:
581 LOG_INI_FLG_LEAVE(ercd);
582 return(ercd);
583}
584
585#endif /* TOPPERS_ini_flg */
586
587/*
588 * イベントフラグの状æ…
589‹å‚ç…
590§
591 */
592#ifdef TOPPERS_ref_flg
593
594ER
595ref_flg(ID flgid, T_RFLG *pk_rflg)
596{
597 FLGCB *p_flgcb;
598 ER ercd;
599
600 LOG_REF_FLG_ENTER(flgid, pk_rflg);
601 CHECK_TSKCTX_UNL();
602 CHECK_ID(VALID_FLGID(flgid));
603 p_flgcb = get_flgcb(flgid);
604
605 lock_cpu();
606 if (p_flgcb->p_flginib->flgatr == TA_NOEXS) {
607 ercd = E_NOEXS;
608 }
609 else {
610 pk_rflg->wtskid = wait_tskid(&(p_flgcb->wait_queue));
611 pk_rflg->flgptn = p_flgcb->flgptn;
612 ercd = E_OK;
613 }
614 unlock_cpu();
615
616 error_exit:
617 LOG_REF_FLG_LEAVE(ercd, pk_rflg);
618 return(ercd);
619}
620
621#endif /* TOPPERS_ref_flg */
Note: See TracBrowser for help on using the repository browser.