source: asp3_wo_tecs/trunk/extension/subprio/kernel/task_manage.c@ 302

Last change on this file since 302 was 302, checked in by ertl-honda, 7 years ago

TECSレスのASP3の開発のため以下のtrunkからコピー
​http://dev.toppers.jp/svn/asp3/branches/WO_TECS-3.C.0
File size: 9.6 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-2015 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 470 2015-12-30 09:50:36Z ertl-hiro $
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_ACT_TSK_ENTER
72#define LOG_ACT_TSK_ENTER(tskid)
73#endif /* LOG_ACT_TSK_ENTER */
74
75#ifndef LOG_ACT_TSK_LEAVE
76#define LOG_ACT_TSK_LEAVE(ercd)
77#endif /* LOG_ACT_TSK_LEAVE */
78
79#ifndef LOG_CAN_ACT_ENTER
80#define LOG_CAN_ACT_ENTER(tskid)
81#endif /* LOG_CAN_ACT_ENTER */
82
83#ifndef LOG_CAN_ACT_LEAVE
84#define LOG_CAN_ACT_LEAVE(ercd)
85#endif /* LOG_CAN_ACT_LEAVE */
86
87#ifndef LOG_GET_TST_ENTER
88#define LOG_GET_TST_ENTER(tskid, p_tskstat)
89#endif /* LOG_GET_TST_ENTER */
90
91#ifndef LOG_GET_TST_LEAVE
92#define LOG_GET_TST_LEAVE(ercd, p_tskstat)
93#endif /* LOG_GET_TST_LEAVE */
94
95#ifndef LOG_CHG_PRI_ENTER
96#define LOG_CHG_PRI_ENTER(tskid, tskpri)
97#endif /* LOG_CHG_PRI_ENTER */
98
99#ifndef LOG_CHG_PRI_LEAVE
100#define LOG_CHG_PRI_LEAVE(ercd)
101#endif /* LOG_CHG_PRI_LEAVE */
102
103#ifndef LOG_GET_PRI_ENTER
104#define LOG_GET_PRI_ENTER(tskid, p_tskpri)
105#endif /* LOG_GET_PRI_ENTER */
106
107#ifndef LOG_GET_PRI_LEAVE
108#define LOG_GET_PRI_LEAVE(ercd, p_tskpri)
109#endif /* LOG_GET_PRI_LEAVE */
110
111#ifndef LOG_CHG_SPR_ENTER
112#define LOG_CHG_SPR_ENTER(tskid, subpri)
113#endif /* LOG_CHG_SPR_ENTER */
114
115#ifndef LOG_CHG_SPR_LEAVE
116#define LOG_CHG_SPR_LEAVE(ercd)
117#endif /* LOG_CHG_SPR_LEAVE */
118
119#ifndef LOG_GET_INF_ENTER
120#define LOG_GET_INF_ENTER(p_exinf)
121#endif /* LOG_GET_INF_ENTER */
122
123#ifndef LOG_GET_INF_LEAVE
124#define LOG_GET_INF_LEAVE(ercd, p_exinf)
125#endif /* LOG_GET_INF_LEAVE */
126
127/*
128 * タスクの起動［NGKI3529］
129 */
130#ifdef TOPPERS_act_tsk
131
132ER
133act_tsk(ID tskid)
134{
135 TCB *p_tcb;
136 ER ercd;
137
138 LOG_ACT_TSK_ENTER(tskid);
139 CHECK_UNL(); /*ï¼»NGKI1114ï¼½*/
140 if (tskid == TSK_SELF && !sense_context()) {
141 p_tcb = p_runtsk; /*ï¼»NGKI1121ï¼½*/
142 }
143 else {
144 CHECK_ID(VALID_TSKID(tskid)); /*ï¼»NGKI1115ï¼½*/
145 p_tcb = get_tcb(tskid);
146 }
147
148 lock_cpu();
149 if (TSTAT_DORMANT(p_tcb->tstat)) {
150 make_active(p_tcb); /*ï¼»NGKI1118ï¼½*/
151 if (p_runtsk != p_schedtsk) {
152 if (!sense_context()) {
153 dispatch();
154 }
155 else {
156 request_dispatch();
157 }
158 }
159 ercd = E_OK;
160 }
161 else if ((p_tcb->p_tinib->tskatr & TA_NOACTQUE) != 0U || p_tcb->actque) {
162 ercd = E_QOVR; /*ï¼»NGKI3528ï¼½*/
163 }
164 else {
165 p_tcb->actque = true; /*ï¼»NGKI3527ï¼½*/
166 ercd = E_OK;
167 }
168 unlock_cpu();
169
170 error_exit:
171 LOG_ACT_TSK_LEAVE(ercd);
172 return(ercd);
173}
174
175#endif /* TOPPERS_act_tsk */
176
177/*
178 * タスク起動要求のキャンセル［NGKI1138］
179 */
180#ifdef TOPPERS_can_act
181
182ER_UINT
183can_act(ID tskid)
184{
185 TCB *p_tcb;
186 ER_UINT ercd;
187
188 LOG_CAN_ACT_ENTER(tskid);
189 CHECK_TSKCTX_UNL(); /*［NGKI1139］［NGKI1140］*/
190 if (tskid == TSK_SELF) {
191 p_tcb = p_runtsk; /*ï¼»NGKI1146ï¼½*/
192 }
193 else {
194 CHECK_ID(VALID_TSKID(tskid)); /*ï¼»NGKI1141ï¼½*/
195 p_tcb = get_tcb(tskid);
196 }
197
198 lock_cpu();
199 ercd = p_tcb->actque ? 1 : 0; /*ï¼»NGKI1144ï¼½*/
200 p_tcb->actque = false; /*ï¼»NGKI1144ï¼½*/
201 unlock_cpu();
202
203 error_exit:
204 LOG_CAN_ACT_LEAVE(ercd);
205 return(ercd);
206}
207
208#endif /* TOPPERS_can_act */
209
210/*
211 * タスク状æ…
212‹ã®å‚ç…
213§ï¼»NGKI3613ï¼½
214 */
215#ifdef TOPPERS_get_tst
216
217ER
218get_tst(ID tskid, STAT *p_tskstat)
219{
220 TCB *p_tcb;
221 uint_t tstat;
222 ER ercd;
223
224 LOG_GET_TST_ENTER(tskid, p_tskstat);
225 CHECK_TSKCTX_UNL(); /*［NGKI3614］［NGKI3615］*/
226 if (tskid == TSK_SELF) {
227 p_tcb = p_runtsk; /*ï¼»NGKI3621ï¼½*/
228 }
229 else {
230 CHECK_ID(VALID_TSKID(tskid)); /*ï¼»NGKI3616ï¼½*/
231 p_tcb = get_tcb(tskid);
232 }
233
234 lock_cpu();
235 tstat = p_tcb->tstat;
236 if (TSTAT_DORMANT(tstat)) { /*ï¼»NGKI3620ï¼½*/
237 *p_tskstat = TTS_DMT;
238 }
239 else if (TSTAT_SUSPENDED(tstat)) {
240 if (TSTAT_WAITING(tstat)) {
241 *p_tskstat = TTS_WAS;
242 }
243 else {
244 *p_tskstat = TTS_SUS;
245 }
246 }
247 else if (TSTAT_WAITING(tstat)) {
248 *p_tskstat = TTS_WAI;
249 }
250 else if (p_tcb == p_runtsk) {
251 *p_tskstat = TTS_RUN;
252 }
253 else {
254 *p_tskstat = TTS_RDY;
255 }
256 ercd = E_OK;
257 unlock_cpu();
258
259 error_exit:
260 LOG_GET_TST_LEAVE(ercd, p_tskstat);
261 return(ercd);
262}
263
264#endif /* TOPPERS_get_tst */
265
266/*
267 * タスクのベース優å…
268ˆåº¦ã®å¤‰æ›´ï¼»NGKI1183ï¼½
269 */
270#ifdef TOPPERS_chg_pri
271
272ER
273chg_pri(ID tskid, PRI tskpri)
274{
275 TCB *p_tcb;
276 uint_t newbpri;
277 ER ercd;
278
279 LOG_CHG_PRI_ENTER(tskid, tskpri);
280 CHECK_TSKCTX_UNL(); /*［NGKI1184］［NGKI1185］*/
281 if (tskid == TSK_SELF) {
282 p_tcb = p_runtsk; /*ï¼»NGKI1198ï¼½*/
283 }
284 else {
285 CHECK_ID(VALID_TSKID(tskid)); /*ï¼»NGKI1187ï¼½*/
286 p_tcb = get_tcb(tskid);
287 }
288 if (tskpri == TPRI_INI) {
289 newbpri = p_tcb->p_tinib->ipriority; /*ï¼»NGKI1199ï¼½*/
290 }
291 else {
292 CHECK_PAR(VALID_TPRI(tskpri)); /*ï¼»NGKI1188ï¼½*/
293 newbpri = INT_PRIORITY(tskpri);
294 }
295
296 lock_cpu();
297 if (TSTAT_DORMANT(p_tcb->tstat)) {
298 ercd = E_OBJ; /*ï¼»NGKI1191ï¼½*/
299 }
300 else if ((p_tcb->p_lastmtx != NULL || TSTAT_WAIT_MTX(p_tcb->tstat))
301 && !((*mtxhook_check_ceilpri)(p_tcb, newbpri))) {
302 ercd = E_ILUSE; /*ï¼»NGKI1201ï¼½*/
303 }
304 else {
305 p_tcb->bpriority = newbpri; /*ï¼»NGKI1192ï¼½*/
306 if (p_tcb->p_lastmtx == NULL || !((*mtxhook_scan_ceilmtx)(p_tcb))) {
307 change_priority(p_tcb, newbpri, false); /*ï¼»NGKI1193ï¼½*/
308 if (p_runtsk != p_schedtsk) {
309 dispatch();
310 } /*ï¼»NGKI1197ï¼½*/
311 }
312 ercd = E_OK;
313 }
314 unlock_cpu();
315
316 error_exit:
317 LOG_CHG_PRI_LEAVE(ercd);
318 return(ercd);
319}
320
321#endif /* TOPPERS_chg_pri */
322
323/*
324 * タスク優å…
325ˆåº¦ã®å‚ç…
326§ï¼»NGKI1202ï¼½
327 */
328#ifdef TOPPERS_get_pri
329
330ER
331get_pri(ID tskid, PRI *p_tskpri)
332{
333 TCB *p_tcb;
334 ER ercd;
335
336 LOG_GET_PRI_ENTER(tskid, p_tskpri);
337 CHECK_TSKCTX_UNL(); /*［NGKI1203］［NGKI1204］*/
338 if (tskid == TSK_SELF) {
339 p_tcb = p_runtsk; /*ï¼»NGKI1211ï¼½*/
340 }
341 else {
342 CHECK_ID(VALID_TSKID(tskid)); /*ï¼»NGKI1205ï¼½*/
343 p_tcb = get_tcb(tskid);
344 }
345
346 lock_cpu();
347 if (TSTAT_DORMANT(p_tcb->tstat)) {
348 ercd = E_OBJ; /*ï¼»NGKI1209ï¼½*/
349 }
350 else {
351 *p_tskpri = EXT_TSKPRI(p_tcb->priority); /*ï¼»NGKI1210ï¼½*/
352 ercd = E_OK;
353 }
354 unlock_cpu();
355
356 error_exit:
357 LOG_GET_PRI_LEAVE(ercd, p_tskpri);
358 return(ercd);
359}
360
361#endif /* TOPPERS_get_pri */
362
363/*
364 * タスクのサブ優å…
365ˆåº¦ã®å¤‰æ›´ï¼»NGK3665ï¼½
366 */
367#ifdef TOPPERS_chg_spr
368
369ER
370chg_spr(ID tskid, uint_t subpri)
371{
372 TCB *p_tcb;
373 ER ercd;
374
375 LOG_CHG_SPR_ENTER(tskid, subpri);
376 CHECK_TSKCTX_UNL(); /*［NGKI3666］［NGKI3667］*/
377 if (tskid == TSK_SELF) {
378 p_tcb = p_runtsk; /*ï¼»NGKI3674ï¼½*/
379 }
380 else {
381 CHECK_ID(VALID_TSKID(tskid)); /*ï¼»NGKI3669ï¼½*/
382 p_tcb = get_tcb(tskid);
383 }
384
385 lock_cpu();
386 change_subprio(p_tcb, subpri);
387 if (p_runtsk != p_schedtsk) {
388 dispatch();
389 }
390 ercd = E_OK;
391 unlock_cpu();
392
393 error_exit:
394 LOG_CHG_SPR_LEAVE(ercd);
395 return(ercd);
396}
397
398#endif /* TOPPERS_chg_spr */
399
400/*
401 * 自タスクの拡張情
402報の参ç…
403§ï¼»NGKI1212ï¼½
404 */
405#ifdef TOPPERS_get_inf
406
407ER
408get_inf(intptr_t *p_exinf)
409{
410 ER ercd;
411
412 LOG_GET_INF_ENTER(p_exinf);
413 CHECK_TSKCTX_UNL(); /*［NGKI1213］［NGKI1214］*/
414
415 lock_cpu();
416 *p_exinf = p_runtsk->p_tinib->exinf; /*ï¼»NGKI1216ï¼½*/
417 ercd = E_OK;
418 unlock_cpu();
419
420 error_exit:
421 LOG_GET_INF_LEAVE(ercd, p_exinf);
422 return(ercd);
423}
424
425#endif /* TOPPERS_get_inf */
Note: See TracBrowser for help on using the repository browser.