source: UsbWattMeter/trunk/asp_dcre/kernel/sys_manage.c@ 167

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

MIMEにSJISを設定
  • Property svn:eol-style set to native
  • Property svn:keywords set to Id
  • Property svn:mime-type set to text/x-csrc; charset=SHIFT_JIS
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-2008 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: sys_manage.c 167 2016-03-08 11:37:45Z coas-nagasima $
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_IROT_RDQ_ENTER
63#define LOG_IROT_RDQ_ENTER(tskpri)
64#endif /* LOG_IROT_RDQ_ENTER */
65
66#ifndef LOG_IROT_RDQ_LEAVE
67#define LOG_IROT_RDQ_LEAVE(ercd)
68#endif /* LOG_IROT_RDQ_LEAVE */
69
70#ifndef LOG_GET_TID_ENTER
71#define LOG_GET_TID_ENTER(p_tskid)
72#endif /* LOG_GET_TID_ENTER */
73
74#ifndef LOG_GET_TID_LEAVE
75#define LOG_GET_TID_LEAVE(ercd, tskid)
76#endif /* LOG_GET_TID_LEAVE */
77
78#ifndef LOG_IGET_TID_ENTER
79#define LOG_IGET_TID_ENTER(p_tskid)
80#endif /* LOG_IGET_TID_ENTER */
81
82#ifndef LOG_IGET_TID_LEAVE
83#define LOG_IGET_TID_LEAVE(ercd, tskid)
84#endif /* LOG_IGET_TID_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_ILOC_CPU_ENTER
95#define LOG_ILOC_CPU_ENTER()
96#endif /* LOG_ILOC_CPU_ENTER */
97
98#ifndef LOG_ILOC_CPU_LEAVE
99#define LOG_ILOC_CPU_LEAVE(ercd)
100#endif /* LOG_ILOC_CPU_LEAVE */
101
102#ifndef LOG_UNL_CPU_ENTER
103#define LOG_UNL_CPU_ENTER()
104#endif /* LOG_UNL_CPU_ENTER */
105
106#ifndef LOG_UNL_CPU_LEAVE
107#define LOG_UNL_CPU_LEAVE(ercd)
108#endif /* LOG_UNL_CPU_LEAVE */
109
110#ifndef LOG_IUNL_CPU_ENTER
111#define LOG_IUNL_CPU_ENTER()
112#endif /* LOG_IUNL_CPU_ENTER */
113
114#ifndef LOG_IUNL_CPU_LEAVE
115#define LOG_IUNL_CPU_LEAVE(ercd)
116#endif /* LOG_IUNL_CPU_LEAVE */
117
118#ifndef LOG_DIS_DSP_ENTER
119#define LOG_DIS_DSP_ENTER()
120#endif /* LOG_DIS_DSP_ENTER */
121
122#ifndef LOG_DIS_DSP_LEAVE
123#define LOG_DIS_DSP_LEAVE(ercd)
124#endif /* LOG_DIS_DSP_LEAVE */
125
126#ifndef LOG_ENA_DSP_ENTER
127#define LOG_ENA_DSP_ENTER()
128#endif /* LOG_ENA_DSP_ENTER */
129
130#ifndef LOG_ENA_DSP_LEAVE
131#define LOG_ENA_DSP_LEAVE(ercd)
132#endif /* LOG_ENA_DSP_LEAVE */
133
134#ifndef LOG_SNS_CTX_ENTER
135#define LOG_SNS_CTX_ENTER()
136#endif /* LOG_SNS_CTX_ENTER */
137
138#ifndef LOG_SNS_CTX_LEAVE
139#define LOG_SNS_CTX_LEAVE(state)
140#endif /* LOG_SNS_CTX_LEAVE */
141
142#ifndef LOG_SNS_LOC_ENTER
143#define LOG_SNS_LOC_ENTER()
144#endif /* LOG_SNS_LOC_ENTER */
145
146#ifndef LOG_SNS_LOC_LEAVE
147#define LOG_SNS_LOC_LEAVE(state)
148#endif /* LOG_SNS_LOC_LEAVE */
149
150#ifndef LOG_SNS_DSP_ENTER
151#define LOG_SNS_DSP_ENTER()
152#endif /* LOG_SNS_DSP_ENTER */
153
154#ifndef LOG_SNS_DSP_LEAVE
155#define LOG_SNS_DSP_LEAVE(state)
156#endif /* LOG_SNS_DSP_LEAVE */
157
158#ifndef LOG_SNS_DPN_ENTER
159#define LOG_SNS_DPN_ENTER()
160#endif /* LOG_SNS_DPN_ENTER */
161
162#ifndef LOG_SNS_DPN_LEAVE
163#define LOG_SNS_DPN_LEAVE(state)
164#endif /* LOG_SNS_DPN_LEAVE */
165
166#ifndef LOG_SNS_KER_ENTER
167#define LOG_SNS_KER_ENTER()
168#endif /* LOG_SNS_KER_ENTER */
169
170#ifndef LOG_SNS_KER_LEAVE
171#define LOG_SNS_KER_LEAVE(state)
172#endif /* LOG_SNS_KER_LEAVE */
173
174/*
175 * タスクの優先順位の回転
176 */
177#ifdef TOPPERS_rot_rdq
178
179ER
180rot_rdq(PRI tskpri)
181{
182 uint_t pri;
183 ER ercd;
184
185 LOG_ROT_RDQ_ENTER(tskpri);
186 CHECK_TSKCTX_UNL();
187 CHECK_TPRI_SELF(tskpri);
188
189 t_lock_cpu();
190 pri = (tskpri == TPRI_SELF) ? p_runtsk->priority : INT_PRIORITY(tskpri);
191 if (rotate_ready_queue(pri)) {
192 dispatch();
193 }
194 ercd = E_OK;
195 t_unlock_cpu();
196
197 error_exit:
198 LOG_ROT_RDQ_LEAVE(ercd);
199 return(ercd);
200}
201
202#endif /* TOPPERS_rot_rdq */
203
204/*
205 * タスクの優先順位の回転（非タスクコンテキスト用）
206 */
207#ifdef TOPPERS_irot_rdq
208
209ER
210irot_rdq(PRI tskpri)
211{
212 ER ercd;
213
214 LOG_IROT_RDQ_ENTER(tskpri);
215 CHECK_INTCTX_UNL();
216 CHECK_TPRI(tskpri);
217
218 i_lock_cpu();
219 if (rotate_ready_queue(INT_PRIORITY(tskpri))) {
220 reqflg = true;
221 }
222 ercd = E_OK;
223 i_unlock_cpu();
224
225 error_exit:
226 LOG_IROT_RDQ_LEAVE(ercd);
227 return(ercd);
228}
229
230#endif /* TOPPERS_irot_rdq */
231
232/*
233 * 実行状態のタスクIDの参照
234 */
235#ifdef TOPPERS_get_tid
236
237ER
238get_tid(ID *p_tskid)
239{
240 ER ercd;
241
242 LOG_GET_TID_ENTER(p_tskid);
243 CHECK_TSKCTX_UNL();
244
245 t_lock_cpu();
246 *p_tskid = TSKID(p_runtsk);
247 ercd = E_OK;
248 t_unlock_cpu();
249
250 error_exit:
251 LOG_GET_TID_LEAVE(ercd, *p_tskid);
252 return(ercd);
253}
254
255#endif /* TOPPERS_get_tid */
256
257/*
258 * 実行状態のタスクIDの参照（非タスクコンテキスト用）
259 */
260#ifdef TOPPERS_iget_tid
261
262ER
263iget_tid(ID *p_tskid)
264{
265 ER ercd;
266
267 LOG_IGET_TID_ENTER(p_tskid);
268 CHECK_INTCTX_UNL();
269
270 i_lock_cpu();
271 *p_tskid = (p_runtsk == NULL) ? TSK_NONE : TSKID(p_runtsk);
272 ercd = E_OK;
273 i_unlock_cpu();
274
275 error_exit:
276 LOG_IGET_TID_LEAVE(ercd, *p_tskid);
277 return(ercd);
278}
279
280#endif /* TOPPERS_iget_tid */
281
282/*
283 * CPUロック状態への移行
284 */
285#ifdef TOPPERS_loc_cpu
286
287ER
288loc_cpu(void)
289{
290 ER ercd;
291
292 LOG_LOC_CPU_ENTER();
293 CHECK_TSKCTX();
294
295 if (!t_sense_lock()) {
296 t_lock_cpu();
297 }
298 ercd = E_OK;
299
300 error_exit:
301 LOG_LOC_CPU_LEAVE(ercd);
302 return(ercd);
303}
304
305#endif /* TOPPERS_loc_cpu */
306
307/*
308 * CPUロック状態への移行（非タスクコンテキスト用）
309 */
310#ifdef TOPPERS_iloc_cpu
311
312ER
313iloc_cpu(void)
314{
315 ER ercd;
316
317 LOG_ILOC_CPU_ENTER();
318 CHECK_INTCTX();
319
320 if (!i_sense_lock()) {
321 i_lock_cpu();
322 }
323 ercd = E_OK;
324
325 error_exit:
326 LOG_ILOC_CPU_LEAVE(ercd);
327 return(ercd);
328}
329
330#endif /* TOPPERS_iloc_cpu */
331
332/*
333 * CPUロック状態の解除
334 *
335 * CPUロック中は，ディスパッチが必要となるサービスコールを呼び出すこ
336 * とはできないため，CPUロック状態の解除時にディスパッチャを起動する
337 * 必要はない．
338 */
339#ifdef TOPPERS_unl_cpu
340
341ER
342unl_cpu(void)
343{
344 ER ercd;
345
346 LOG_UNL_CPU_ENTER();
347 CHECK_TSKCTX();
348
349 if (t_sense_lock()) {
350 t_unlock_cpu();
351 }
352 ercd = E_OK;
353
354 error_exit:
355 LOG_UNL_CPU_LEAVE(ercd);
356 return(ercd);
357}
358
359#endif /* TOPPERS_unl_cpu */
360
361/*
362 * CPUロック状態の解除（非タスクコンテキスト用）
363 *
364 * CPUロック中は，ディスパッチが必要となるサービスコールを呼び出すこ
365 * とはできないため，CPUロック状態の解除時にディスパッチャの起動を要
366 * 求する必要はない．
367 */
368#ifdef TOPPERS_iunl_cpu
369
370ER
371iunl_cpu(void)
372{
373 ER ercd;
374
375 LOG_IUNL_CPU_ENTER();
376 CHECK_INTCTX();
377
378 if (i_sense_lock()) {
379 i_unlock_cpu();
380 }
381 ercd = E_OK;
382
383 error_exit:
384 LOG_IUNL_CPU_LEAVE(ercd);
385 return(ercd);
386}
387
388#endif /* TOPPERS_iunl_cpu */
389
390/*
391 * ディスパッチの禁止
392 */
393#ifdef TOPPERS_dis_dsp
394
395ER
396dis_dsp(void)
397{
398 ER ercd;
399
400 LOG_DIS_DSP_ENTER();
401 CHECK_TSKCTX_UNL();
402
403 t_lock_cpu();
404 disdsp = true;
405 dspflg = false;
406 ercd = E_OK;
407 t_unlock_cpu();
408
409 error_exit:
410 LOG_DIS_DSP_LEAVE(ercd);
411 return(ercd);
412}
413
414#endif /* TOPPERS_dis_dsp */
415
416/*
417 * ディスパッチの許可
418 */
419#ifdef TOPPERS_ena_dsp
420
421ER
422ena_dsp(void)
423{
424 ER ercd;
425
426 LOG_ENA_DSP_ENTER();
427 CHECK_TSKCTX_UNL();
428
429 t_lock_cpu();
430 disdsp = false;
431 if (ipmflg) {
432 dspflg = true;
433 if (p_runtsk != p_schedtsk) {
434 dispatch();
435 }
436 }
437 ercd = E_OK;
438 t_unlock_cpu();
439
440 error_exit:
441 LOG_ENA_DSP_LEAVE(ercd);
442 return(ercd);
443}
444
445#endif /* TOPPERS_ena_dsp */
446
447/*
448 * コンテキストの参照
449 */
450#ifdef TOPPERS_sns_ctx
451
452bool_t
453sns_ctx(void)
454{
455 bool_t state;
456
457 LOG_SNS_CTX_ENTER();
458 state = sense_context() ? true : false;
459 LOG_SNS_CTX_LEAVE(state);
460 return(state);
461}
462
463#endif /* TOPPERS_sns_ctx */
464
465/*
466 * CPUロック状態の参照
467 */
468#ifdef TOPPERS_sns_loc
469
470bool_t
471sns_loc(void)
472{
473 bool_t state;
474
475 LOG_SNS_LOC_ENTER();
476 state = x_sense_lock() ? true : false;
477 LOG_SNS_LOC_LEAVE(state);
478 return(state);
479}
480
481#endif /* TOPPERS_sns_loc */
482
483/*
484 * ディスパッチ禁止状態の参照
485 */
486#ifdef TOPPERS_sns_dsp
487
488bool_t
489sns_dsp(void)
490{
491 bool_t state;
492
493 LOG_SNS_DSP_ENTER();
494 state = disdsp;
495 LOG_SNS_DSP_LEAVE(state);
496 return(state);
497}
498
499#endif /* TOPPERS_sns_dsp */
500
501/*
502 * ディスパッチ保留状態の参照
503 */
504#ifdef TOPPERS_sns_dpn
505
506bool_t
507sns_dpn(void)
508{
509 bool_t state;
510
511 LOG_SNS_DPN_ENTER();
512 state = (sense_context() || t_sense_lock() || !dspflg) ? true : false;
513 LOG_SNS_DPN_LEAVE(state);
514 return(state);
515}
516
517#endif /* TOPPERS_sns_dpn */
518
519/*
520 * カーネル非動作状態の参照
521 */
522#ifdef TOPPERS_sns_ker
523
524bool_t
525sns_ker(void)
526{
527 bool_t state;
528
529 LOG_SNS_KER_ENTER();
530 state = kerflg ? false : true;
531 LOG_SNS_KER_LEAVE(state);
532 return(state);
533}
534
535#endif /* TOPPERS_sns_ker */
Note: See TracBrowser for help on using the repository browser.