source: EcnlProtoTool/trunk/asp3_dcre/kernel/task_sync.c

Last change on this file was 429, checked in by coas-nagasima, 4 years ago

ASP3, TINET, mbed を更新
  • Property svn:eol-style set to native
  • Property svn:mime-type set to text/x-csrc;charset=UTF-8
File size: 11.4 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-2018 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
52/*
53 * トレースログマクロのデフォルト定義
54 */
55#ifndef LOG_SLP_TSK_ENTER
56#define LOG_SLP_TSK_ENTER()
57#endif /* LOG_SLP_TSK_ENTER */
58
59#ifndef LOG_SLP_TSK_LEAVE
60#define LOG_SLP_TSK_LEAVE(ercd)
61#endif /* LOG_SLP_TSK_LEAVE */
62
63#ifndef LOG_TSLP_TSK_ENTER
64#define LOG_TSLP_TSK_ENTER(tmout)
65#endif /* LOG_TSLP_TSK_ENTER */
66
67#ifndef LOG_TSLP_TSK_LEAVE
68#define LOG_TSLP_TSK_LEAVE(ercd)
69#endif /* LOG_TSLP_TSK_LEAVE */
70
71#ifndef LOG_WUP_TSK_ENTER
72#define LOG_WUP_TSK_ENTER(tskid)
73#endif /* LOG_WUP_TSK_ENTER */
74
75#ifndef LOG_WUP_TSK_LEAVE
76#define LOG_WUP_TSK_LEAVE(ercd)
77#endif /* LOG_WUP_TSK_LEAVE */
78
79#ifndef LOG_CAN_WUP_ENTER
80#define LOG_CAN_WUP_ENTER(tskid)
81#endif /* LOG_CAN_WUP_ENTER */
82
83#ifndef LOG_CAN_WUP_LEAVE
84#define LOG_CAN_WUP_LEAVE(ercd)
85#endif /* LOG_CAN_WUP_LEAVE */
86
87#ifndef LOG_REL_WAI_ENTER
88#define LOG_REL_WAI_ENTER(tskid)
89#endif /* LOG_REL_WAI_ENTER */
90
91#ifndef LOG_REL_WAI_LEAVE
92#define LOG_REL_WAI_LEAVE(ercd)
93#endif /* LOG_REL_WAI_LEAVE */
94
95#ifndef LOG_SUS_TSK_ENTER
96#define LOG_SUS_TSK_ENTER(tskid)
97#endif /* LOG_SUS_TSK_ENTER */
98
99#ifndef LOG_SUS_TSK_LEAVE
100#define LOG_SUS_TSK_LEAVE(ercd)
101#endif /* LOG_SUS_TSK_LEAVE */
102
103#ifndef LOG_RSM_TSK_ENTER
104#define LOG_RSM_TSK_ENTER(tskid)
105#endif /* LOG_RSM_TSK_ENTER */
106
107#ifndef LOG_RSM_TSK_LEAVE
108#define LOG_RSM_TSK_LEAVE(ercd)
109#endif /* LOG_RSM_TSK_LEAVE */
110
111#ifndef LOG_DLY_TSK_ENTER
112#define LOG_DLY_TSK_ENTER(dlytim)
113#endif /* LOG_DLY_TSK_ENTER */
114
115#ifndef LOG_DLY_TSK_LEAVE
116#define LOG_DLY_TSK_LEAVE(ercd)
117#endif /* LOG_DLY_TSK_LEAVE */
118
119/*
120 * 起床待ち［NGKI1252］
121 */
122#ifdef TOPPERS_slp_tsk
123
124ER
125slp_tsk(void)
126{
127 WINFO winfo;
128 ER ercd;
129
130 LOG_SLP_TSK_ENTER();
131 CHECK_DISPATCH(); /*［NGKI1254］*/
132
133 lock_cpu_dsp();
134 if (p_runtsk->raster) {
135 ercd = E_RASTER; /*［NGKI3455］*/
136 }
137 else if (p_runtsk->wupque) {
138 p_runtsk->wupque = false; /*［NGKI1259］*/
139 ercd = E_OK;
140 }
141 else {
142 make_wait(TS_WAITING_SLP, &winfo); /*［NGKI1260］*/
143 LOG_TSKSTAT(p_runtsk);
144 dispatch();
145 ercd = winfo.wercd;
146 }
147 unlock_cpu_dsp();
148
149 error_exit:
150 LOG_SLP_TSK_LEAVE(ercd);
151 return(ercd);
152}
153
154#endif /* TOPPERS_slp_tsk */
155
156/*
157 * 起床待ち（タイムアウトあり）［NGKI1253］
158 */
159#ifdef TOPPERS_tslp_tsk
160
161ER
162tslp_tsk(TMO tmout)
163{
164 WINFO winfo;
165 TMEVTB tmevtb;
166 ER ercd;
167
168 LOG_TSLP_TSK_ENTER(tmout);
169 CHECK_DISPATCH(); /*［NGKI1254］*/
170 CHECK_PAR(VALID_TMOUT(tmout)); /*［NGKI1256］*/
171
172 lock_cpu_dsp();
173 if (p_runtsk->raster) {
174 ercd = E_RASTER; /*［NGKI3455］*/
175 }
176 else if (p_runtsk->wupque) {
177 p_runtsk->wupque = false; /*［NGKI1259］*/
178 ercd = E_OK;
179 }
180 else if (tmout == TMO_POL) {
181 ercd = E_TMOUT; /*［NGKI1257］*/
182 }
183 else { /*［NGKI1260］*/
184 make_wait_tmout(TS_WAITING_SLP, &winfo, &tmevtb, tmout);
185 LOG_TSKSTAT(p_runtsk);
186 dispatch();
187 ercd = winfo.wercd;
188 }
189 unlock_cpu_dsp();
190
191 error_exit:
192 LOG_TSLP_TSK_LEAVE(ercd);
193 return(ercd);
194}
195
196#endif /* TOPPERS_tslp_tsk */
197
198/*
199 * タスクの起床［NGKI3531］
200 */
201#ifdef TOPPERS_wup_tsk
202
203ER
204wup_tsk(ID tskid)
205{
206 TCB *p_tcb;
207 ER ercd;
208
209 LOG_WUP_TSK_ENTER(tskid);
210 CHECK_UNL(); /*［NGKI1265］*/
211 if (tskid == TSK_SELF && !sense_context()) {
212 p_tcb = p_runtsk; /*［NGKI1275］*/
213 }
214 else {
215 CHECK_ID(VALID_TSKID(tskid)); /*［NGKI1267］*/
216 p_tcb = get_tcb(tskid);
217 }
218
219 lock_cpu();
220 if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
221 ercd = E_NOEXS; /*［NGKI1268］*/
222 }
223 else if (TSTAT_DORMANT(p_tcb->tstat)) {
224 ercd = E_OBJ; /*［NGKI1270］*/
225 }
226 else if (TSTAT_WAIT_SLP(p_tcb->tstat)) {
227 wait_complete(p_tcb); /*［NGKI1271］*/
228 if (p_runtsk != p_schedtsk) {
229 if (!sense_context()) {
230 dispatch();
231 }
232 else {
233 request_dispatch_retint();
234 }
235 }
236 ercd = E_OK;
237 }
238 else if (!(p_tcb->wupque)) {
239 p_tcb->wupque = true; /*［NGKI1273］*/
240 ercd = E_OK;
241 }
242 else {
243 ercd = E_QOVR; /*［NGKI1274］*/
244 }
245 unlock_cpu();
246
247 error_exit:
248 LOG_WUP_TSK_LEAVE(ercd);
249 return(ercd);
250}
251
252#endif /* TOPPERS_wup_tsk */
253
254/*
255 * タスク起床要求のキャンセル［NGKI1276］
256 */
257#ifdef TOPPERS_can_wup
258
259ER_UINT
260can_wup(ID tskid)
261{
262 TCB *p_tcb;
263 ER_UINT ercd;
264
265 LOG_CAN_WUP_ENTER(tskid);
266 CHECK_TSKCTX_UNL(); /*［NGKI1277］［NGKI1278］*/
267 if (tskid == TSK_SELF) {
268 p_tcb = p_runtsk; /*［NGKI1285］*/
269 }
270 else {
271 CHECK_ID(VALID_TSKID(tskid)); /*［NGKI1280］*/
272 p_tcb = get_tcb(tskid);
273 }
274
275 lock_cpu();
276 if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
277 ercd = E_NOEXS; /*［NGKI1281］*/
278 }
279 else if (TSTAT_DORMANT(p_tcb->tstat)) {
280 ercd = E_OBJ; /*［NGKI1283］*/
281 }
282 else {
283 ercd = p_tcb->wupque ? 1 : 0; /*［NGKI1284］*/
284 p_tcb->wupque = false; /*［NGKI1284］*/
285 }
286 unlock_cpu();
287
288 error_exit:
289 LOG_CAN_WUP_LEAVE(ercd);
290 return(ercd);
291}
292
293#endif /* TOPPERS_can_wup */
294
295/*
296 * 待ち状態の強制解除［NGKI3532］
297 */
298#ifdef TOPPERS_rel_wai
299
300ER
301rel_wai(ID tskid)
302{
303 TCB *p_tcb;
304 ER ercd;
305
306 LOG_REL_WAI_ENTER(tskid);
307 CHECK_UNL(); /*［NGKI1290］*/
308 CHECK_ID(VALID_TSKID(tskid)); /*［NGKI1292］*/
309 p_tcb = get_tcb(tskid);
310
311 lock_cpu();
312 if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
313 ercd = E_NOEXS; /*［NGKI1293］*/
314 }
315 else if (!TSTAT_WAITING(p_tcb->tstat)) {
316 ercd = E_OBJ; /*［NGKI1295］*/
317 }
318 else {
319 wait_dequeue_wobj(p_tcb); /*［NGKI1296］*/
320 wait_dequeue_tmevtb(p_tcb);
321 p_tcb->p_winfo->wercd = E_RLWAI; /*［NGKI1297］*/
322 make_non_wait(p_tcb);
323 if (p_runtsk != p_schedtsk) {
324 if (!sense_context()) {
325 dispatch();
326 }
327 else {
328 request_dispatch_retint();
329 }
330 }
331 ercd = E_OK;
332 }
333 unlock_cpu();
334
335 error_exit:
336 LOG_REL_WAI_LEAVE(ercd);
337 return(ercd);
338}
339
340#endif /* TOPPERS_rel_wai */
341
342/*
343 * 強制待ち状態への移行［NGKI1298］
344 */
345#ifdef TOPPERS_sus_tsk
346
347ER
348sus_tsk(ID tskid)
349{
350 TCB *p_tcb;
351 ER ercd;
352
353 LOG_SUS_TSK_ENTER(tskid);
354 CHECK_TSKCTX_UNL(); /*［NGKI1299］［NGKI1300］*/
355 if (tskid == TSK_SELF) {
356 p_tcb = p_runtsk; /*［NGKI1310］*/
357 }
358 else {
359 CHECK_ID(VALID_TSKID(tskid)); /*［NGKI1302］*/
360 p_tcb = get_tcb(tskid);
361 }
362
363 lock_cpu();
364 if (p_tcb == p_runtsk && !dspflg) { /*［NGKI1311］［NGKI3604］*/
365 ercd = E_CTX;
366 }
367 else if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
368 ercd = E_NOEXS; /*［NGKI1303］*/
369 }
370 else if (TSTAT_DORMANT(p_tcb->tstat)) {
371 ercd = E_OBJ; /*［NGKI1305］*/
372 }
373 else if (p_tcb->raster) {
374 ercd = E_RASTER; /*［NGKI3605］*/
375 }
376 else if (TSTAT_RUNNABLE(p_tcb->tstat)) {
377 /*
378 * 実行できる状態から強制待ち状態への遷移［NGKI1307］
379 */
380 p_tcb->tstat = TS_SUSPENDED;
381 LOG_TSKSTAT(p_tcb);
382 make_non_runnable(p_tcb);
383 if (p_runtsk != p_schedtsk) {
384 dispatch();
385 }
386 ercd = E_OK;
387 }
388 else if (TSTAT_SUSPENDED(p_tcb->tstat)) {
389 ercd = E_QOVR; /*［NGKI1306］*/
390 }
391 else {
392 /*
393 * 待ち状態から二重待ち状態への遷移［NGKI1308］
394 */
395 p_tcb->tstat |= TS_SUSPENDED;
396 LOG_TSKSTAT(p_tcb);
397 ercd = E_OK;
398 }
399 unlock_cpu();
400
401 error_exit:
402 LOG_SUS_TSK_LEAVE(ercd);
403 return(ercd);
404}
405
406#endif /* TOPPERS_sus_tsk */
407
408/*
409 * 強制待ち状態からの再開［NGKI1312］
410 */
411#ifdef TOPPERS_rsm_tsk
412
413ER
414rsm_tsk(ID tskid)
415{
416 TCB *p_tcb;
417 ER ercd;
418
419 LOG_RSM_TSK_ENTER(tskid);
420 CHECK_TSKCTX_UNL(); /*［NGKI1313］［NGKI1314］*/
421 CHECK_ID(VALID_TSKID(tskid)); /*［NGKI1316］*/
422 p_tcb = get_tcb(tskid);
423
424 lock_cpu();
425 if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
426 ercd = E_NOEXS; /*［NGKI1317］*/
427 }
428 else if (!TSTAT_SUSPENDED(p_tcb->tstat)) {
429 ercd = E_OBJ; /*［NGKI1319］*/
430 }
431 else {
432 /*
433 * 強制待ちからの再開［NGKI1320］
434 */
435 if (!TSTAT_WAITING(p_tcb->tstat)) {
436 p_tcb->tstat = TS_RUNNABLE;
437 LOG_TSKSTAT(p_tcb);
438 make_runnable(p_tcb);
439 if (p_runtsk != p_schedtsk) {
440 dispatch();
441 }
442 }
443 else {
444 p_tcb->tstat &= ~TS_SUSPENDED;
445 LOG_TSKSTAT(p_tcb);
446 }
447 ercd = E_OK;
448 }
449 unlock_cpu();
450
451 error_exit:
452 LOG_RSM_TSK_LEAVE(ercd);
453 return(ercd);
454}
455
456#endif /* TOPPERS_rsm_tsk */
457
458/*
459 * 自タスクの遅延［NGKI1348］
460 */
461#ifdef TOPPERS_dly_tsk
462
463ER
464dly_tsk(RELTIM dlytim)
465{
466 WINFO winfo;
467 TMEVTB tmevtb;
468 ER ercd;
469
470 LOG_DLY_TSK_ENTER(dlytim);
471 CHECK_DISPATCH(); /*［NGKI1349］*/
472 CHECK_PAR(VALID_RELTIM(dlytim)); /*［NGKI1351］*/
473
474 lock_cpu_dsp();
475 if (p_runtsk->raster) {
476 ercd = E_RASTER; /*［NGKI3456］*/
477 }
478 else {
479 p_runtsk->tstat = TS_WAITING_DLY; /*［NGKI1353］*/
480 make_non_runnable(p_runtsk);
481 p_runtsk->p_winfo = &winfo;
482 winfo.p_tmevtb = &tmevtb;
483 tmevtb.callback = (CBACK) wait_tmout_ok;
484 tmevtb.arg = (void *) p_runtsk;
485 tmevtb_enqueue_reltim(&tmevtb, dlytim);
486 LOG_TSKSTAT(p_runtsk);
487 dispatch();
488 ercd = winfo.wercd;
489 }
490 unlock_cpu_dsp();
491
492 error_exit:
493 LOG_DLY_TSK_LEAVE(ercd);
494 return(ercd);
495}
496
497#endif /* TOPPERS_dly_tsk */
Note: See TracBrowser for help on using the repository browser.