source: rubycfg_asp/trunk/asp_dcre/kernel/task_sync.c@ 313

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

ソースを追加
  • Property svn:eol-style set to native
  • Property svn:keywords set to Id
  • Property svn:mime-type set to text/x-csrc
File size: 11.1 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 * 上記著作権者
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: task_sync.c 313 2017-07-23 04:50:32Z 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
67/*
68 * トレースログマクロのデフォルト定義
69 */
70#ifndef LOG_SLP_TSK_ENTER
71#define LOG_SLP_TSK_ENTER()
72#endif /* LOG_SLP_TSK_ENTER */
73
74#ifndef LOG_SLP_TSK_LEAVE
75#define LOG_SLP_TSK_LEAVE(ercd)
76#endif /* LOG_SLP_TSK_LEAVE */
77
78#ifndef LOG_TSLP_TSK_ENTER
79#define LOG_TSLP_TSK_ENTER(tmout)
80#endif /* LOG_TSLP_TSK_ENTER */
81
82#ifndef LOG_TSLP_TSK_LEAVE
83#define LOG_TSLP_TSK_LEAVE(ercd)
84#endif /* LOG_TSLP_TSK_LEAVE */
85
86#ifndef LOG_WUP_TSK_ENTER
87#define LOG_WUP_TSK_ENTER(tskid)
88#endif /* LOG_WUP_TSK_ENTER */
89
90#ifndef LOG_WUP_TSK_LEAVE
91#define LOG_WUP_TSK_LEAVE(ercd)
92#endif /* LOG_WUP_TSK_LEAVE */
93
94#ifndef LOG_IWUP_TSK_ENTER
95#define LOG_IWUP_TSK_ENTER(tskid)
96#endif /* LOG_IWUP_TSK_ENTER */
97
98#ifndef LOG_IWUP_TSK_LEAVE
99#define LOG_IWUP_TSK_LEAVE(ercd)
100#endif /* LOG_IWUP_TSK_LEAVE */
101
102#ifndef LOG_CAN_WUP_ENTER
103#define LOG_CAN_WUP_ENTER(tskid)
104#endif /* LOG_CAN_WUP_ENTER */
105
106#ifndef LOG_CAN_WUP_LEAVE
107#define LOG_CAN_WUP_LEAVE(ercd)
108#endif /* LOG_CAN_WUP_LEAVE */
109
110#ifndef LOG_REL_WAI_ENTER
111#define LOG_REL_WAI_ENTER(tskid)
112#endif /* LOG_REL_WAI_ENTER */
113
114#ifndef LOG_REL_WAI_LEAVE
115#define LOG_REL_WAI_LEAVE(ercd)
116#endif /* LOG_REL_WAI_LEAVE */
117
118#ifndef LOG_IREL_WAI_ENTER
119#define LOG_IREL_WAI_ENTER(tskid)
120#endif /* LOG_IREL_WAI_ENTER */
121
122#ifndef LOG_IREL_WAI_LEAVE
123#define LOG_IREL_WAI_LEAVE(ercd)
124#endif /* LOG_IREL_WAI_LEAVE */
125
126#ifndef LOG_SUS_TSK_ENTER
127#define LOG_SUS_TSK_ENTER(tskid)
128#endif /* LOG_SUS_TSK_ENTER */
129
130#ifndef LOG_SUS_TSK_LEAVE
131#define LOG_SUS_TSK_LEAVE(ercd)
132#endif /* LOG_SUS_TSK_LEAVE */
133
134#ifndef LOG_RSM_TSK_ENTER
135#define LOG_RSM_TSK_ENTER(tskid)
136#endif /* LOG_RSM_TSK_ENTER */
137
138#ifndef LOG_RSM_TSK_LEAVE
139#define LOG_RSM_TSK_LEAVE(ercd)
140#endif /* LOG_RSM_TSK_LEAVE */
141
142#ifndef LOG_DLY_TSK_ENTER
143#define LOG_DLY_TSK_ENTER(dlytim)
144#endif /* LOG_DLY_TSK_ENTER */
145
146#ifndef LOG_DLY_TSK_LEAVE
147#define LOG_DLY_TSK_LEAVE(ercd)
148#endif /* LOG_DLY_TSK_LEAVE */
149
150/*
151 * 起床待
152ち
153 */
154#ifdef TOPPERS_slp_tsk
155
156ER
157slp_tsk(void)
158{
159 WINFO winfo;
160 ER ercd;
161
162 LOG_SLP_TSK_ENTER();
163 CHECK_DISPATCH();
164
165 t_lock_cpu();
166 if (p_runtsk->wupque) {
167 p_runtsk->wupque = false;
168 ercd = E_OK;
169 }
170 else {
171 p_runtsk->tstat = (TS_WAITING | TS_WAIT_SLP);
172 make_wait(&winfo);
173 LOG_TSKSTAT(p_runtsk);
174 dispatch();
175 ercd = winfo.wercd;
176 }
177 t_unlock_cpu();
178
179 error_exit:
180 LOG_SLP_TSK_LEAVE(ercd);
181 return(ercd);
182}
183
184#endif /* TOPPERS_slp_tsk */
185
186/*
187 * 起床待
188ち（タイムアウトあり）
189 */
190#ifdef TOPPERS_tslp_tsk
191
192ER
193tslp_tsk(TMO tmout)
194{
195 WINFO winfo;
196 TMEVTB tmevtb;
197 ER ercd;
198
199 LOG_TSLP_TSK_ENTER(tmout);
200 CHECK_DISPATCH();
201 CHECK_TMOUT(tmout);
202
203 t_lock_cpu();
204 if (p_runtsk->wupque) {
205 p_runtsk->wupque = false;
206 ercd = E_OK;
207 }
208 else if (tmout == TMO_POL) {
209 ercd = E_TMOUT;
210 }
211 else {
212 p_runtsk->tstat = (TS_WAITING | TS_WAIT_SLP);
213 make_wait_tmout(&winfo, &tmevtb, tmout);
214 LOG_TSKSTAT(p_runtsk);
215 dispatch();
216 ercd = winfo.wercd;
217 }
218 t_unlock_cpu();
219
220 error_exit:
221 LOG_TSLP_TSK_LEAVE(ercd);
222 return(ercd);
223}
224
225#endif /* TOPPERS_tslp_tsk */
226
227/*
228 * タスクの起床
229 */
230#ifdef TOPPERS_wup_tsk
231
232ER
233wup_tsk(ID tskid)
234{
235 TCB *p_tcb;
236 ER ercd;
237
238 LOG_WUP_TSK_ENTER(tskid);
239 CHECK_TSKCTX_UNL();
240 CHECK_TSKID_SELF(tskid);
241 p_tcb = get_tcb_self(tskid);
242
243 t_lock_cpu();
244 if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
245 ercd = E_NOEXS;
246 }
247 else if (TSTAT_DORMANT(p_tcb->tstat)) {
248 ercd = E_OBJ;
249 }
250 else if (TSTAT_WAIT_SLP(p_tcb->tstat)) {
251 if (wait_complete(p_tcb)) {
252 dispatch();
253 }
254 ercd = E_OK;
255 }
256 else if (!(p_tcb->wupque)) {
257 p_tcb->wupque = true;
258 ercd = E_OK;
259 }
260 else {
261 ercd = E_QOVR;
262 }
263 t_unlock_cpu();
264
265 error_exit:
266 LOG_WUP_TSK_LEAVE(ercd);
267 return(ercd);
268}
269
270#endif /* TOPPERS_wup_tsk */
271
272/*
273 * タスクの起床（非タスクコンテキスト用）
274 */
275#ifdef TOPPERS_iwup_tsk
276
277ER
278iwup_tsk(ID tskid)
279{
280 TCB *p_tcb;
281 ER ercd;
282
283 LOG_IWUP_TSK_ENTER(tskid);
284 CHECK_INTCTX_UNL();
285 CHECK_TSKID(tskid);
286 p_tcb = get_tcb(tskid);
287
288 i_lock_cpu();
289 if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
290 ercd = E_NOEXS;
291 }
292 else if (TSTAT_DORMANT(p_tcb->tstat)) {
293 ercd = E_OBJ;
294 }
295 else if (TSTAT_WAIT_SLP(p_tcb->tstat)) {
296 if (wait_complete(p_tcb)) {
297 reqflg = true;
298 }
299 ercd = E_OK;
300 }
301 else if (!(p_tcb->wupque)) {
302 p_tcb->wupque = true;
303 ercd = E_OK;
304 }
305 else {
306 ercd = E_QOVR;
307 }
308 i_unlock_cpu();
309
310 error_exit:
311 LOG_IWUP_TSK_LEAVE(ercd);
312 return(ercd);
313}
314
315#endif /* TOPPERS_iwup_tsk */
316
317/*
318 * タスク起床要求のキャンセル
319 */
320#ifdef TOPPERS_can_wup
321
322ER_UINT
323can_wup(ID tskid)
324{
325 TCB *p_tcb;
326 ER_UINT ercd;
327
328 LOG_CAN_WUP_ENTER(tskid);
329 CHECK_TSKCTX_UNL();
330 CHECK_TSKID_SELF(tskid);
331 p_tcb = get_tcb_self(tskid);
332
333 t_lock_cpu();
334 if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
335 ercd = E_NOEXS;
336 }
337 else if (TSTAT_DORMANT(p_tcb->tstat)) {
338 ercd = E_OBJ;
339 }
340 else {
341 ercd = p_tcb->wupque ? 1 : 0;
342 p_tcb->wupque = false;
343 }
344 t_unlock_cpu();
345
346 error_exit:
347 LOG_CAN_WUP_LEAVE(ercd);
348 return(ercd);
349}
350
351#endif /* TOPPERS_can_wup */
352
353/*
354 * 待
355ち状æ…
356‹ã®å¼·åˆ¶è§£é™¤
357 */
358#ifdef TOPPERS_rel_wai
359
360ER
361rel_wai(ID tskid)
362{
363 TCB *p_tcb;
364 ER ercd;
365
366 LOG_REL_WAI_ENTER(tskid);
367 CHECK_TSKCTX_UNL();
368 CHECK_TSKID(tskid);
369 p_tcb = get_tcb(tskid);
370
371 t_lock_cpu();
372 if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
373 ercd = E_NOEXS;
374 }
375 else if (!TSTAT_WAITING(p_tcb->tstat)) {
376 ercd = E_OBJ;
377 }
378 else {
379 if (wait_release(p_tcb)) {
380 dispatch();
381 }
382 ercd = E_OK;
383 }
384 t_unlock_cpu();
385
386 error_exit:
387 LOG_REL_WAI_LEAVE(ercd);
388 return(ercd);
389}
390
391#endif /* TOPPERS_rel_wai */
392
393/*
394 * 待
395ち状æ…
396‹ã®å¼·åˆ¶è§£é™¤ï¼ˆéžã‚¿ã‚¹ã‚¯ã‚³ãƒ³ãƒ†ã‚­ã‚¹ãƒˆç”¨ï¼‰
397 */
398#ifdef TOPPERS_irel_wai
399
400ER
401irel_wai(ID tskid)
402{
403 TCB *p_tcb;
404 ER ercd;
405
406 LOG_IREL_WAI_ENTER(tskid);
407 CHECK_INTCTX_UNL();
408 CHECK_TSKID(tskid);
409 p_tcb = get_tcb(tskid);
410
411 i_lock_cpu();
412 if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
413 ercd = E_NOEXS;
414 }
415 else if (!TSTAT_WAITING(p_tcb->tstat)) {
416 ercd = E_OBJ;
417 }
418 else {
419 if (wait_release(p_tcb)) {
420 reqflg = true;
421 }
422 ercd = E_OK;
423 }
424 i_unlock_cpu();
425
426 error_exit:
427 LOG_IREL_WAI_LEAVE(ercd);
428 return(ercd);
429}
430
431#endif /* TOPPERS_irel_wai */
432
433/*
434 * 強制待
435ち状æ…
436‹ã¸ã®ç§»è¡Œ
437 */
438#ifdef TOPPERS_sus_tsk
439
440ER
441sus_tsk(ID tskid)
442{
443 TCB *p_tcb;
444 ER ercd;
445
446 LOG_SUS_TSK_ENTER(tskid);
447 CHECK_TSKCTX_UNL();
448 CHECK_TSKID_SELF(tskid);
449 p_tcb = get_tcb_self(tskid);
450
451 t_lock_cpu();
452 if (p_tcb == p_runtsk && !dspflg) {
453 ercd = E_CTX;
454 }
455 else if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
456 ercd = E_NOEXS;
457 }
458 else if (TSTAT_DORMANT(p_tcb->tstat)) {
459 ercd = E_OBJ;
460 }
461 else if (TSTAT_RUNNABLE(p_tcb->tstat)) {
462 /*
463 * 実行できる状æ…
464‹ã‹ã‚‰å¼·åˆ¶å¾…
465ち状æ…
466‹ã¸ã®é·ç§»
467 */
468 p_tcb->tstat = TS_SUSPENDED;
469 LOG_TSKSTAT(p_tcb);
470 if (make_non_runnable(p_tcb)) {
471 dispatch();
472 }
473 ercd = E_OK;
474 }
475 else if (TSTAT_SUSPENDED(p_tcb->tstat)) {
476 ercd = E_QOVR;
477 }
478 else {
479 /*
480 * 待
481ち状æ…
482‹ã‹ã‚‰äºŒé‡å¾…
483ち状æ…
484‹ã¸ã®é·ç§»
485 */
486 p_tcb->tstat |= TS_SUSPENDED;
487 LOG_TSKSTAT(p_tcb);
488 ercd = E_OK;
489 }
490 t_unlock_cpu();
491
492 error_exit:
493 LOG_SUS_TSK_LEAVE(ercd);
494 return(ercd);
495}
496
497#endif /* TOPPERS_sus_tsk */
498
499/*
500 * 強制待
501ち状æ…
502‹ã‹ã‚‰ã®å†é–‹
503 */
504#ifdef TOPPERS_rsm_tsk
505
506ER
507rsm_tsk(ID tskid)
508{
509 TCB *p_tcb;
510 ER ercd;
511
512 LOG_RSM_TSK_ENTER(tskid);
513 CHECK_TSKCTX_UNL();
514 CHECK_TSKID(tskid);
515 p_tcb = get_tcb(tskid);
516
517 t_lock_cpu();
518 if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
519 ercd = E_NOEXS;
520 }
521 else if (!TSTAT_SUSPENDED(p_tcb->tstat)) {
522 ercd = E_OBJ;
523 }
524 else if (!TSTAT_WAITING(p_tcb->tstat)) {
525 /*
526 * 強制待
527ち状æ…
528‹ã‹ã‚‰å®Ÿè¡Œã§ãã‚‹çŠ¶æ…
529‹ã¸ã®é·ç§»
530 */
531 p_tcb->tstat = TS_RUNNABLE;
532 LOG_TSKSTAT(p_tcb);
533 if (make_runnable(p_tcb)) {
534 dispatch();
535 }
536 ercd = E_OK;
537 }
538 else {
539 /*
540 * 二重待
541ち状æ…
542‹ã‹ã‚‰å¾…
543ち状æ…
544‹ã¸ã®é·ç§»
545 */
546 p_tcb->tstat &= ~TS_SUSPENDED;
547 LOG_TSKSTAT(p_tcb);
548 ercd = E_OK;
549 }
550 t_unlock_cpu();
551
552 error_exit:
553 LOG_RSM_TSK_LEAVE(ercd);
554 return(ercd);
555}
556
557#endif /* TOPPERS_rsm_tsk */
558
559/*
560 * 自タスクの遅
561延
562 */
563#ifdef TOPPERS_dly_tsk
564
565ER
566dly_tsk(RELTIM dlytim)
567{
568 WINFO winfo;
569 TMEVTB tmevtb;
570 ER ercd;
571
572 LOG_DLY_TSK_ENTER(dlytim);
573 CHECK_DISPATCH();
574 CHECK_PAR(dlytim <= TMAX_RELTIM);
575
576 t_lock_cpu();
577 p_runtsk->tstat = (TS_WAITING | TS_WAIT_DLY);
578 (void) make_non_runnable(p_runtsk);
579 p_runtsk->p_winfo = &winfo;
580 winfo.p_tmevtb = &tmevtb;
581 tmevtb_enqueue(&tmevtb, dlytim, (CBACK) wait_tmout_ok, (void *) p_runtsk);
582 LOG_TSKSTAT(p_runtsk);
583 dispatch();
584 ercd = winfo.wercd;
585 t_unlock_cpu();
586
587 error_exit:
588 LOG_DLY_TSK_LEAVE(ercd);
589 return(ercd);
590}
591
592#endif /* TOPPERS_dly_tsk */
Note: See TracBrowser for help on using the repository browser.