source: azure_iot_hub/trunk/asp3_dcre/kernel/task_manage.c@ 388

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

Azure IoT Hub Device C SDK を使ったサンプルの追加
  • Property svn:eol-style set to native
  • Property svn:keywords set to Id
  • Property svn:mime-type set to text/x-csrc
File size: 12.6 KB
RevLine 
[388]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-2017 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_manage.c 388 2019-05-22 11:25:18Z coas-nagasima $
56 */
57
58/*
59 * タスク管理機能
60 */
61
62#include "kernel_impl.h"
63#include "check.h"
64#include "task.h"
65#include "taskhook.h"
66#include "wait.h"
67
68/*
69 * トレースログマクロのデフォルト定義
70 */
71#ifndef LOG_ACRE_TSK_ENTER
72#define LOG_ACRE_TSK_ENTER(pk_ctsk)
73#endif /* LOG_ACRE_TSK_ENTER */
74
75#ifndef LOG_ACRE_TSK_LEAVE
76#define LOG_ACRE_TSK_LEAVE(ercd)
77#endif /* LOG_ACRE_TSK_LEAVE */
78
79#ifndef LOG_DEL_TSK_ENTER
80#define LOG_DEL_TSK_ENTER(tskid)
81#endif /* LOG_DEL_TSK_ENTER */
82
83#ifndef LOG_DEL_TSK_LEAVE
84#define LOG_DEL_TSK_LEAVE(ercd)
85#endif /* LOG_DEL_TSK_LEAVE */
86
87#ifndef LOG_ACT_TSK_ENTER
88#define LOG_ACT_TSK_ENTER(tskid)
89#endif /* LOG_ACT_TSK_ENTER */
90
91#ifndef LOG_ACT_TSK_LEAVE
92#define LOG_ACT_TSK_LEAVE(ercd)
93#endif /* LOG_ACT_TSK_LEAVE */
94
95#ifndef LOG_CAN_ACT_ENTER
96#define LOG_CAN_ACT_ENTER(tskid)
97#endif /* LOG_CAN_ACT_ENTER */
98
99#ifndef LOG_CAN_ACT_LEAVE
100#define LOG_CAN_ACT_LEAVE(ercd)
101#endif /* LOG_CAN_ACT_LEAVE */
102
103#ifndef LOG_GET_TST_ENTER
104#define LOG_GET_TST_ENTER(tskid, p_tskstat)
105#endif /* LOG_GET_TST_ENTER */
106
107#ifndef LOG_GET_TST_LEAVE
108#define LOG_GET_TST_LEAVE(ercd, p_tskstat)
109#endif /* LOG_GET_TST_LEAVE */
110
111#ifndef LOG_CHG_PRI_ENTER
112#define LOG_CHG_PRI_ENTER(tskid, tskpri)
113#endif /* LOG_CHG_PRI_ENTER */
114
115#ifndef LOG_CHG_PRI_LEAVE
116#define LOG_CHG_PRI_LEAVE(ercd)
117#endif /* LOG_CHG_PRI_LEAVE */
118
119#ifndef LOG_GET_PRI_ENTER
120#define LOG_GET_PRI_ENTER(tskid, p_tskpri)
121#endif /* LOG_GET_PRI_ENTER */
122
123#ifndef LOG_GET_PRI_LEAVE
124#define LOG_GET_PRI_LEAVE(ercd, p_tskpri)
125#endif /* LOG_GET_PRI_LEAVE */
126
127#ifndef LOG_GET_INF_ENTER
128#define LOG_GET_INF_ENTER(p_exinf)
129#endif /* LOG_GET_INF_ENTER */
130
131#ifndef LOG_GET_INF_LEAVE
132#define LOG_GET_INF_LEAVE(ercd, p_exinf)
133#endif /* LOG_GET_INF_LEAVE */
134
135/*
136 * タスクの生成
137 *
138 * pk_ctsk->exinfは，エラーチェックをせず，一度しか参ç…
139§ã—ないため，ロー
140 * カル変数にコピーする必
141要がない（途中で書き換わっても支障がない）．
142 */
143#ifdef TOPPERS_acre_tsk
144
145#ifndef TARGET_MIN_STKSZ
146#define TARGET_MIN_STKSZ 1U /* 未定義の場合は0でないことをチェック */
147#endif /* TARGET_MIN_STKSZ */
148
149ER_UINT
150acre_tsk(const T_CTSK *pk_ctsk)
151{
152 TCB *p_tcb;
153 TINIB *p_tinib;
154 ATR tskatr;
155 TASK task;
156 PRI itskpri;
157 size_t stksz;
158 STK_T *stk;
159 ER ercd;
160
161 LOG_ACRE_TSK_ENTER(pk_ctsk);
162 CHECK_TSKCTX_UNL();
163
164 tskatr = pk_ctsk->tskatr;
165 task = pk_ctsk->task;
166 itskpri = pk_ctsk->itskpri;
167 stksz = pk_ctsk->stksz;
168 stk = pk_ctsk->stk;
169
170 CHECK_RSATR(tskatr, TA_ACT|TA_NOACTQUE|TARGET_TSKATR);
171 CHECK_PAR(FUNC_ALIGN(task));
172 CHECK_PAR(FUNC_NONNULL(task));
173 CHECK_PAR(VALID_TPRI(itskpri));
174 CHECK_PAR(stksz >= TARGET_MIN_STKSZ);
175 if (stk != NULL) {
176 CHECK_PAR(STKSZ_ALIGN(stksz));
177 CHECK_PAR(STACK_ALIGN(stk));
178 }
179
180 lock_cpu();
181 if (queue_empty(&free_tcb)) {
182 ercd = E_NOID;
183 }
184 else {
185 if (stk == NULL) {
186 stksz = ROUND_STK_T(stksz);
187 stk = kernel_malloc(stksz);
188 tskatr |= TA_MEMALLOC;
189 }
190 if (stk == NULL) {
191 ercd = E_NOMEM;
192 }
193 else {
194 p_tcb = ((TCB *) queue_delete_next(&free_tcb));
195 p_tinib = (TINIB *)(p_tcb->p_tinib);
196 p_tinib->tskatr = tskatr;
197 p_tinib->exinf = pk_ctsk->exinf;
198 p_tinib->task = task;
199 p_tinib->ipriority = INT_PRIORITY(itskpri);
200#ifdef USE_TSKINICTXB
201 init_tskinictxb(&(p_tinib->tskinictxb), stksz, stk);
202#else /* USE_TSKINICTXB */
203 p_tinib->stksz = stksz;
204 p_tinib->stk = stk;
205#endif /* USE_TSKINICTXB */
206
207 p_tcb->actque = false;
208 make_dormant(p_tcb);
209 if ((p_tcb->p_tinib->tskatr & TA_ACT) != 0U) {
210 make_active(p_tcb);
211 if (p_runtsk != p_schedtsk) {
212 dispatch();
213 }
214 }
215 ercd = TSKID(p_tcb);
216 }
217 }
218 unlock_cpu();
219
220 error_exit:
221 LOG_ACRE_TSK_LEAVE(ercd);
222 return(ercd);
223}
224
225#endif /* TOPPERS_acre_tsk */
226
227/*
228 * タスクの削除［NGKI1100］
229 */
230#ifdef TOPPERS_del_tsk
231
232ER
233del_tsk(ID tskid)
234{
235 TCB *p_tcb;
236 TINIB *p_tinib;
237 ER ercd;
238
239 LOG_DEL_TSK_ENTER(tskid);
240 CHECK_TSKCTX_UNL(); /*［NGKI1101］［NGKI1102］*/
241 CHECK_ID(VALID_TSKID(tskid)); /*ï¼»NGKI1103ï¼½*/
242 p_tcb = get_tcb(tskid);
243
244 lock_cpu();
245 if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
246 ercd = E_NOEXS; /*ï¼»NGKI1104ï¼½*/
247 }
248 else if (tskid <= tmax_stskid || !TSTAT_DORMANT(p_tcb->tstat)) {
249 ercd = E_OBJ; /*［NGKI1106］［NGKI1107］*/
250 }
251 else {
252 p_tinib = (TINIB *)(p_tcb->p_tinib);
253#ifdef USE_TSKINICTXB
254 term_tskinictxb(&(p_tinib->tskinictxb));
255#else /* USE_TSKINICTXB */
256 if ((p_tinib->tskatr & TA_MEMALLOC) != 0U) { /*ï¼»NGKI1109ï¼½*/
257 kernel_free(p_tinib->stk);
258 }
259#endif /* USE_TSKINICTXB */
260 p_tinib->tskatr = TA_NOEXS; /*ï¼»NGKI1108ï¼½*/
261 queue_insert_prev(&free_tcb, &(p_tcb->task_queue));
262 ercd = E_OK;
263 }
264 unlock_cpu();
265
266 error_exit:
267 LOG_DEL_TSK_LEAVE(ercd);
268 return(ercd);
269}
270
271#endif /* TOPPERS_del_tsk */
272
273/*
274 * タスクの起動［NGKI3529］
275 */
276#ifdef TOPPERS_act_tsk
277
278ER
279act_tsk(ID tskid)
280{
281 TCB *p_tcb;
282 ER ercd;
283
284 LOG_ACT_TSK_ENTER(tskid);
285 CHECK_UNL(); /*ï¼»NGKI1114ï¼½*/
286 if (tskid == TSK_SELF && !sense_context()) {
287 p_tcb = p_runtsk; /*ï¼»NGKI1121ï¼½*/
288 }
289 else {
290 CHECK_ID(VALID_TSKID(tskid)); /*ï¼»NGKI1115ï¼½*/
291 p_tcb = get_tcb(tskid);
292 }
293
294 lock_cpu();
295 if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
296 ercd = E_NOEXS; /*ï¼»NGKI1116ï¼½*/
297 }
298 else if (TSTAT_DORMANT(p_tcb->tstat)) {
299 make_active(p_tcb); /*ï¼»NGKI1118ï¼½*/
300 if (p_runtsk != p_schedtsk) {
301 if (!sense_context()) {
302 dispatch();
303 }
304 else {
305 request_dispatch();
306 }
307 }
308 ercd = E_OK;
309 }
310 else if ((p_tcb->p_tinib->tskatr & TA_NOACTQUE) != 0U || p_tcb->actque) {
311 ercd = E_QOVR; /*ï¼»NGKI3528ï¼½*/
312 }
313 else {
314 p_tcb->actque = true; /*ï¼»NGKI3527ï¼½*/
315 ercd = E_OK;
316 }
317 unlock_cpu();
318
319 error_exit:
320 LOG_ACT_TSK_LEAVE(ercd);
321 return(ercd);
322}
323
324#endif /* TOPPERS_act_tsk */
325
326/*
327 * タスク起動要求のキャンセル［NGKI1138］
328 */
329#ifdef TOPPERS_can_act
330
331ER_UINT
332can_act(ID tskid)
333{
334 TCB *p_tcb;
335 ER_UINT ercd;
336
337 LOG_CAN_ACT_ENTER(tskid);
338 CHECK_TSKCTX_UNL(); /*［NGKI1139］［NGKI1140］*/
339 if (tskid == TSK_SELF) {
340 p_tcb = p_runtsk; /*ï¼»NGKI1146ï¼½*/
341 }
342 else {
343 CHECK_ID(VALID_TSKID(tskid)); /*ï¼»NGKI1141ï¼½*/
344 p_tcb = get_tcb(tskid);
345 }
346
347 lock_cpu();
348 if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
349 ercd = E_NOEXS; /*ï¼»NGKI1142ï¼½*/
350 }
351 else {
352 ercd = p_tcb->actque ? 1 : 0; /*ï¼»NGKI1144ï¼½*/
353 p_tcb->actque = false; /*ï¼»NGKI1144ï¼½*/
354 }
355 unlock_cpu();
356
357 error_exit:
358 LOG_CAN_ACT_LEAVE(ercd);
359 return(ercd);
360}
361
362#endif /* TOPPERS_can_act */
363
364/*
365 * タスク状æ…
366‹ã®å‚ç…
367§ï¼»NGKI3613ï¼½
368 */
369#ifdef TOPPERS_get_tst
370
371ER
372get_tst(ID tskid, STAT *p_tskstat)
373{
374 TCB *p_tcb;
375 uint_t tstat;
376 ER ercd;
377
378 LOG_GET_TST_ENTER(tskid, p_tskstat);
379 CHECK_TSKCTX_UNL(); /*［NGKI3614］［NGKI3615］*/
380 if (tskid == TSK_SELF) {
381 p_tcb = p_runtsk; /*ï¼»NGKI3621ï¼½*/
382 }
383 else {
384 CHECK_ID(VALID_TSKID(tskid)); /*ï¼»NGKI3616ï¼½*/
385 p_tcb = get_tcb(tskid);
386 }
387
388 lock_cpu();
389 tstat = p_tcb->tstat;
390 if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
391 ercd = E_NOEXS; /*ï¼»NGKI3617ï¼½*/
392 }
393 else {
394 if (TSTAT_DORMANT(tstat)) { /*ï¼»NGKI3620ï¼½*/
395 *p_tskstat = TTS_DMT;
396 }
397 else if (TSTAT_SUSPENDED(tstat)) {
398 if (TSTAT_WAITING(tstat)) {
399 *p_tskstat = TTS_WAS;
400 }
401 else {
402 *p_tskstat = TTS_SUS;
403 }
404 }
405 else if (TSTAT_WAITING(tstat)) {
406 *p_tskstat = TTS_WAI;
407 }
408 else if (p_tcb == p_runtsk) {
409 *p_tskstat = TTS_RUN;
410 }
411 else {
412 *p_tskstat = TTS_RDY;
413 }
414 ercd = E_OK;
415 }
416 unlock_cpu();
417
418 error_exit:
419 LOG_GET_TST_LEAVE(ercd, p_tskstat);
420 return(ercd);
421}
422
423#endif /* TOPPERS_get_tst */
424
425/*
426 * タスクのベース優å…
427ˆåº¦ã®å¤‰æ›´ï¼»NGKI1183ï¼½
428 */
429#ifdef TOPPERS_chg_pri
430
431ER
432chg_pri(ID tskid, PRI tskpri)
433{
434 TCB *p_tcb;
435 uint_t newbpri;
436 ER ercd;
437
438 LOG_CHG_PRI_ENTER(tskid, tskpri);
439 CHECK_TSKCTX_UNL(); /*［NGKI1184］［NGKI1185］*/
440 if (tskid == TSK_SELF) {
441 p_tcb = p_runtsk; /*ï¼»NGKI1198ï¼½*/
442 }
443 else {
444 CHECK_ID(VALID_TSKID(tskid)); /*ï¼»NGKI1187ï¼½*/
445 p_tcb = get_tcb(tskid);
446 }
447 if (tskpri == TPRI_INI) {
448 newbpri = p_tcb->p_tinib->ipriority; /*ï¼»NGKI1199ï¼½*/
449 }
450 else {
451 CHECK_PAR(VALID_TPRI(tskpri)); /*ï¼»NGKI1188ï¼½*/
452 newbpri = INT_PRIORITY(tskpri);
453 }
454
455 lock_cpu();
456 if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
457 ercd = E_NOEXS; /*ï¼»NGKI1189ï¼½*/
458 }
459 else if (TSTAT_DORMANT(p_tcb->tstat)) {
460 ercd = E_OBJ; /*ï¼»NGKI1191ï¼½*/
461 }
462 else if ((p_tcb->p_lastmtx != NULL || TSTAT_WAIT_MTX(p_tcb->tstat))
463 && !((*mtxhook_check_ceilpri)(p_tcb, newbpri))) {
464 ercd = E_ILUSE; /*ï¼»NGKI1201ï¼½*/
465 }
466 else {
467 p_tcb->bpriority = newbpri; /*ï¼»NGKI1192ï¼½*/
468 if (p_tcb->p_lastmtx == NULL || !((*mtxhook_scan_ceilmtx)(p_tcb))) {
469 change_priority(p_tcb, newbpri, false); /*ï¼»NGKI1193ï¼½*/
470 if (p_runtsk != p_schedtsk) {
471 dispatch();
472 } /*ï¼»NGKI1197ï¼½*/
473 }
474 ercd = E_OK;
475 }
476 unlock_cpu();
477
478 error_exit:
479 LOG_CHG_PRI_LEAVE(ercd);
480 return(ercd);
481}
482
483#endif /* TOPPERS_chg_pri */
484
485/*
486 * タスク優å…
487ˆåº¦ã®å‚ç…
488§ï¼»NGKI1202ï¼½
489 */
490#ifdef TOPPERS_get_pri
491
492ER
493get_pri(ID tskid, PRI *p_tskpri)
494{
495 TCB *p_tcb;
496 ER ercd;
497
498 LOG_GET_PRI_ENTER(tskid, p_tskpri);
499 CHECK_TSKCTX_UNL(); /*［NGKI1203］［NGKI1204］*/
500 if (tskid == TSK_SELF) {
501 p_tcb = p_runtsk; /*ï¼»NGKI1211ï¼½*/
502 }
503 else {
504 CHECK_ID(VALID_TSKID(tskid)); /*ï¼»NGKI1205ï¼½*/
505 p_tcb = get_tcb(tskid);
506 }
507
508 lock_cpu();
509 if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
510 ercd = E_NOEXS; /*ï¼»NGKI1206ï¼½*/
511 }
512 else if (TSTAT_DORMANT(p_tcb->tstat)) {
513 ercd = E_OBJ; /*ï¼»NGKI1209ï¼½*/
514 }
515 else {
516 *p_tskpri = EXT_TSKPRI(p_tcb->priority); /*ï¼»NGKI1210ï¼½*/
517 ercd = E_OK;
518 }
519 unlock_cpu();
520
521 error_exit:
522 LOG_GET_PRI_LEAVE(ercd, p_tskpri);
523 return(ercd);
524}
525
526#endif /* TOPPERS_get_pri */
527
528/*
529 * 自タスクの拡張情
530報の参ç…
531§ï¼»NGKI1212ï¼½
532 */
533#ifdef TOPPERS_get_inf
534
535ER
536get_inf(intptr_t *p_exinf)
537{
538 ER ercd;
539
540 LOG_GET_INF_ENTER(p_exinf);
541 CHECK_TSKCTX_UNL(); /*［NGKI1213］［NGKI1214］*/
542
543 lock_cpu();
544 *p_exinf = p_runtsk->p_tinib->exinf; /*ï¼»NGKI1216ï¼½*/
545 ercd = E_OK;
546 unlock_cpu();
547
548 error_exit:
549 LOG_GET_INF_LEAVE(ercd, p_exinf);
550 return(ercd);
551}
552
553#endif /* TOPPERS_get_inf */
Note: See TracBrowser for help on using the repository browser.