source: EcnlProtoTool/trunk/asp3_dcre/kernel/sys_manage.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.0 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-2019 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
51/*
52 * トレースログマクロのデフォルト定義
53 */
54#ifndef LOG_ROT_RDQ_ENTER
55#define LOG_ROT_RDQ_ENTER(tskpri)
56#endif /* LOG_ROT_RDQ_ENTER */
57
58#ifndef LOG_ROT_RDQ_LEAVE
59#define LOG_ROT_RDQ_LEAVE(ercd)
60#endif /* LOG_ROT_RDQ_LEAVE */
61
62#ifndef LOG_GET_TID_ENTER
63#define LOG_GET_TID_ENTER(p_tskid)
64#endif /* LOG_GET_TID_ENTER */
65
66#ifndef LOG_GET_TID_LEAVE
67#define LOG_GET_TID_LEAVE(ercd, p_tskid)
68#endif /* LOG_GET_TID_LEAVE */
69
70#ifndef LOG_GET_LOD_ENTER
71#define LOG_GET_LOD_ENTER(tskpri, p_load)
72#endif /* LOG_GET_LOD_ENTER */
73
74#ifndef LOG_GET_LOD_LEAVE
75#define LOG_GET_LOD_LEAVE(ercd, p_load)
76#endif /* LOG_GET_LOD_LEAVE */
77
78#ifndef LOG_GET_NTH_ENTER
79#define LOG_GET_NTH_ENTER(tskpri, nth, p_tskid)
80#endif /* LOG_GET_NTH_ENTER */
81
82#ifndef LOG_GET_NTH_LEAVE
83#define LOG_GET_NTH_LEAVE(ercd, p_tskid)
84#endif /* LOG_GET_NTH_LEAVE */
85
86#ifndef LOG_LOC_CPU_ENTER
87#define LOG_LOC_CPU_ENTER()
88#endif /* LOG_LOC_CPU_ENTER */
89
90#ifndef LOG_LOC_CPU_LEAVE
91#define LOG_LOC_CPU_LEAVE(ercd)
92#endif /* LOG_LOC_CPU_LEAVE */
93
94#ifndef LOG_UNL_CPU_ENTER
95#define LOG_UNL_CPU_ENTER()
96#endif /* LOG_UNL_CPU_ENTER */
97
98#ifndef LOG_UNL_CPU_LEAVE
99#define LOG_UNL_CPU_LEAVE(ercd)
100#endif /* LOG_UNL_CPU_LEAVE */
101
102#ifndef LOG_DIS_DSP_ENTER
103#define LOG_DIS_DSP_ENTER()
104#endif /* LOG_DIS_DSP_ENTER */
105
106#ifndef LOG_DIS_DSP_LEAVE
107#define LOG_DIS_DSP_LEAVE(ercd)
108#endif /* LOG_DIS_DSP_LEAVE */
109
110#ifndef LOG_ENA_DSP_ENTER
111#define LOG_ENA_DSP_ENTER()
112#endif /* LOG_ENA_DSP_ENTER */
113
114#ifndef LOG_ENA_DSP_LEAVE
115#define LOG_ENA_DSP_LEAVE(ercd)
116#endif /* LOG_ENA_DSP_LEAVE */
117
118#ifndef LOG_SNS_CTX_ENTER
119#define LOG_SNS_CTX_ENTER()
120#endif /* LOG_SNS_CTX_ENTER */
121
122#ifndef LOG_SNS_CTX_LEAVE
123#define LOG_SNS_CTX_LEAVE(state)
124#endif /* LOG_SNS_CTX_LEAVE */
125
126#ifndef LOG_SNS_LOC_ENTER
127#define LOG_SNS_LOC_ENTER()
128#endif /* LOG_SNS_LOC_ENTER */
129
130#ifndef LOG_SNS_LOC_LEAVE
131#define LOG_SNS_LOC_LEAVE(state)
132#endif /* LOG_SNS_LOC_LEAVE */
133
134#ifndef LOG_SNS_DSP_ENTER
135#define LOG_SNS_DSP_ENTER()
136#endif /* LOG_SNS_DSP_ENTER */
137
138#ifndef LOG_SNS_DSP_LEAVE
139#define LOG_SNS_DSP_LEAVE(state)
140#endif /* LOG_SNS_DSP_LEAVE */
141
142#ifndef LOG_SNS_DPN_ENTER
143#define LOG_SNS_DPN_ENTER()
144#endif /* LOG_SNS_DPN_ENTER */
145
146#ifndef LOG_SNS_DPN_LEAVE
147#define LOG_SNS_DPN_LEAVE(state)
148#endif /* LOG_SNS_DPN_LEAVE */
149
150#ifndef LOG_SNS_KER_ENTER
151#define LOG_SNS_KER_ENTER()
152#endif /* LOG_SNS_KER_ENTER */
153
154#ifndef LOG_SNS_KER_LEAVE
155#define LOG_SNS_KER_LEAVE(state)
156#endif /* LOG_SNS_KER_LEAVE */
157
158/*
159 * タスクの優先順位の回転［NGKI3548］
160 */
161#ifdef TOPPERS_rot_rdq
162
163ER
164rot_rdq(PRI tskpri)
165{
166 uint_t pri;
167 ER ercd;
168
169 LOG_ROT_RDQ_ENTER(tskpri);
170 CHECK_UNL(); /*［NGKI2684］*/
171 if (tskpri == TPRI_SELF && !sense_context()) {
172 pri = p_runtsk->bpriority; /*［NGKI2689］*/
173 }
174 else {
175 CHECK_PAR(VALID_TPRI(tskpri)); /*［NGKI2685］*/
176 pri = INT_PRIORITY(tskpri);
177 }
178
179 lock_cpu();
180 rotate_ready_queue(&(ready_queue[pri]));
181 if (p_runtsk != p_schedtsk) {
182 if (!sense_context()) {
183 dispatch();
184 }
185 else {
186 request_dispatch_retint();
187 }
188 }
189 ercd = E_OK;
190 unlock_cpu();
191
192 error_exit:
193 LOG_ROT_RDQ_LEAVE(ercd);
194 return(ercd);
195}
196
197#endif /* TOPPERS_rot_rdq */
198
199/*
200 * 実行状態のタスクIDの参照［NGKI3550］
201 */
202#ifdef TOPPERS_get_tid
203
204ER
205get_tid(ID *p_tskid)
206{
207 bool_t lock;
208 ER ercd;
209
210 LOG_GET_TID_ENTER(p_tskid);
211 //CHECK_UNL(); /*［NGKI2707］*/
212 lock = sense_lock();
213
214 if (!lock)
215 lock_cpu();
216 *p_tskid = (p_runtsk == NULL) ? TSK_NONE : TSKID(p_runtsk);
217 ercd = E_OK; /*［NGKI2710］［NGKI2709］*/
218 if (!lock)
219 unlock_cpu();
220
221 error_exit:
222 LOG_GET_TID_LEAVE(ercd, p_tskid);
223 return(ercd);
224}
225
226#endif /* TOPPERS_get_tid */
227
228/*
229 * 実行できるタスクの数の参照［NGKI3623］
230 */
231#ifdef TOPPERS_get_lod
232
233ER
234get_lod(PRI tskpri, uint_t *p_load)
235{
236 uint_t pri, load;
237 QUEUE *p_queue, *p_entry;
238 ER ercd;
239
240 LOG_GET_LOD_ENTER(p_tskid, p_load);
241 CHECK_TSKCTX_UNL(); /*［NGKI3624］［NGKI3625］*/
242 if (tskpri == TPRI_SELF) {
243 pri = p_runtsk->bpriority; /*［NGKI3631］*/
244 }
245 else {
246 CHECK_PAR(VALID_TPRI(tskpri)); /*［NGKI3626］*/
247 pri = INT_PRIORITY(tskpri);
248 }
249 p_queue = &(ready_queue[pri]);
250
251 lock_cpu();
252 load = 0U;
253 for (p_entry = p_queue->p_next; p_entry != p_queue;
254 p_entry = p_entry->p_next) {
255 load += 1U;
256 }
257 *p_load = load;
258 ercd = E_OK;
259 unlock_cpu();
260
261 error_exit:
262 LOG_GET_LOD_LEAVE(ercd, p_load);
263 return(ercd);
264}
265
266#endif /* TOPPERS_get_lod */
267
268/*
269 * 指定した優先順位のタスクIDの参照［NGKI3641］
270 */
271#ifdef TOPPERS_get_nth
272
273ER
274get_nth(PRI tskpri, uint_t nth, ID *p_tskid)
275{
276 uint_t pri;
277 QUEUE *p_queue, *p_entry;
278 ID tskid;
279 ER ercd;
280
281 LOG_GET_NTH_ENTER(p_tskid, nth, p_tskid);
282 CHECK_TSKCTX_UNL(); /*［NGKI3642］［NGKI3643］*/
283 if (tskpri == TPRI_SELF) {
284 pri = p_runtsk->bpriority; /*［NGKI3650］*/
285 }
286 else {
287 CHECK_PAR(VALID_TPRI(tskpri)); /*［NGKI3644］*/
288 pri = INT_PRIORITY(tskpri);
289 }
290 p_queue = &(ready_queue[pri]);
291
292 lock_cpu();
293 tskid = TSK_NONE;
294 for (p_entry = p_queue->p_next; p_entry != p_queue;
295 p_entry = p_entry->p_next) {
296 if (nth == 0U) {
297 tskid = TSKID((TCB *) p_entry);
298 break;
299 }
300 nth -= 1U;
301 }
302 *p_tskid = tskid;
303 ercd = E_OK;
304 unlock_cpu();
305
306 error_exit:
307 LOG_GET_NTH_LEAVE(ercd, p_tskid);
308 return(ercd);
309}
310
311#endif /* TOPPERS_get_nth */
312
313/*
314 * CPUロック状態への遷移［NGKI3538］
315 */
316#ifdef TOPPERS_loc_cpu
317
318ER
319loc_cpu(void)
320{
321 ER ercd;
322
323 LOG_LOC_CPU_ENTER();
324
325 if (!sense_lock()) { /*［NGKI2731］*/
326 lock_cpu(); /*［NGKI2730］*/
327 }
328 ercd = E_OK;
329
330 LOG_LOC_CPU_LEAVE(ercd);
331 return(ercd);
332}
333
334#endif /* TOPPERS_loc_cpu */
335
336/*
337 * CPUロック状態の解除［NGKI3539］
338 *
339 * CPUロック中は，ディスパッチが必要となるサービスコールを呼び出すこ
340 * とはできないため，CPUロック状態の解除時にディスパッチャを起動する
341 * 必要はない．
342 */
343#ifdef TOPPERS_unl_cpu
344
345ER
346unl_cpu(void)
347{
348 ER ercd;
349
350 LOG_UNL_CPU_ENTER();
351
352 if (sense_lock()) { /*［NGKI2738］*/
353 unlock_cpu(); /*［NGKI2737］*/
354 }
355 ercd = E_OK;
356
357 LOG_UNL_CPU_LEAVE(ercd);
358 return(ercd);
359}
360
361#endif /* TOPPERS_unl_cpu */
362
363/*
364 * ディスパッチの禁止［NGKI2740］
365 */
366#ifdef TOPPERS_dis_dsp
367
368ER
369dis_dsp(void)
370{
371 ER ercd;
372
373 LOG_DIS_DSP_ENTER();
374 CHECK_TSKCTX_UNL(); /*［NGKI2741］［NGKI2742］*/
375
376 lock_cpu();
377 enadsp = false;
378 dspflg = false;
379 ercd = E_OK;
380 unlock_cpu();
381
382 error_exit:
383 LOG_DIS_DSP_LEAVE(ercd);
384 return(ercd);
385}
386
387#endif /* TOPPERS_dis_dsp */
388
389/*
390 * ディスパッチの許可［NGKI2746］
391 */
392#ifdef TOPPERS_ena_dsp
393
394ER
395ena_dsp(void)
396{
397 ER ercd;
398
399 LOG_ENA_DSP_ENTER();
400 CHECK_TSKCTX_UNL(); /*［NGKI2747］［NGKI2748］*/
401
402 lock_cpu();
403 enadsp = true;
404 if (t_get_ipm() == TIPM_ENAALL) {
405 set_dspflg();
406 if (p_runtsk->raster && p_runtsk->enater) {
407 task_terminate(p_runtsk);
408 exit_and_dispatch();
409 ercd = E_SYS;
410 }
411 else {
412 if (p_runtsk != p_schedtsk) {
413 dispatch();
414 }
415 ercd = E_OK;
416 }
417 }
418 else {
419 ercd = E_OK;
420 }
421 unlock_cpu();
422
423 error_exit:
424 LOG_ENA_DSP_LEAVE(ercd);
425 return(ercd);
426}
427
428#endif /* TOPPERS_ena_dsp */
429
430/*
431 * コンテキストの参照［NGKI2752］
432 */
433#ifdef TOPPERS_sns_ctx
434
435bool_t
436sns_ctx(void)
437{
438 bool_t state;
439
440 LOG_SNS_CTX_ENTER();
441 state = sense_context() ? true : false;
442 LOG_SNS_CTX_LEAVE(state);
443 return(state);
444}
445
446#endif /* TOPPERS_sns_ctx */
447
448/*
449 * CPUロック状態の参照［NGKI2754］
450 */
451#ifdef TOPPERS_sns_loc
452
453bool_t
454sns_loc(void)
455{
456 bool_t state;
457
458 LOG_SNS_LOC_ENTER();
459 state = sense_lock() ? true : false;
460 LOG_SNS_LOC_LEAVE(state);
461 return(state);
462}
463
464#endif /* TOPPERS_sns_loc */
465
466/*
467 * ディスパッチ禁止状態の参照［NGKI2756］
468 */
469#ifdef TOPPERS_sns_dsp
470
471bool_t
472sns_dsp(void)
473{
474 bool_t state;
475
476 LOG_SNS_DSP_ENTER();
477 state = !enadsp;
478 LOG_SNS_DSP_LEAVE(state);
479 return(state);
480}
481
482#endif /* TOPPERS_sns_dsp */
483
484/*
485 * ディスパッチ保留状態の参照［NGKI2758］
486 */
487#ifdef TOPPERS_sns_dpn
488
489bool_t
490sns_dpn(void)
491{
492 bool_t state;
493
494 LOG_SNS_DPN_ENTER();
495 state = (sense_context() || sense_lock() || !dspflg) ? true : false;
496 LOG_SNS_DPN_LEAVE(state);
497 return(state);
498}
499
500#endif /* TOPPERS_sns_dpn */
501
502/*
503 * カーネル非動作状態の参照［NGKI2760］
504 */
505#ifdef TOPPERS_sns_ker
506
507bool_t
508sns_ker(void)
509{
510 bool_t state;
511
512 LOG_SNS_KER_ENTER();
513 state = kerflg ? false : true;
514 LOG_SNS_KER_LEAVE(state);
515 return(state);
516}
517
518#endif /* TOPPERS_sns_ker */
Note: See TracBrowser for help on using the repository browser.