source: asp3_wo_tecs/trunk/target/nucleo_f401re_gcc/truestudio/asp3/sample1.c@ 308

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

MANIFESTの更新

File size: 17.2 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) 2004-2016 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: sample1.c 711 2016-03-29 14:45:54Z ertl-hiro $
56 */
57
58/*
59 * サンプルプログラム(1)の本体
60 *
61 * ASPカーネルの基本的な動作を確認するためのサンプルプログラム.
62 *
63 * プログラムの概要:
64 *
65 * ユーザインタフェースを受け持つメインタスク(タスクID: MAIN_TASK,優
66 * å…
67ˆåº¦: MAIN_PRIORITY)と,3つの並行実行されるタスク(タスクID:
68 * TASK1〜TASK3,初期優å…
69ˆåº¦: MID_PRIORITY)で構成される.また,起動周
70 * 期が2秒の周期ハンドラ(周期ハンドラID: CYCHDR1)を用いる.
71 *
72 * 並行実行されるタスクは,task_loop回空ループを実行する度に,タスクが
73 * 実行中であることをあらわすメッセージを表示する.空ループを実行する
74 * のは,空ループなしでメッセージを出力すると,多量のメッセージが出力
75 * され,プログラムの動作が確認しずらくなるためである.また,低速なシ
76 * リアルポートを用いてメッセージを出力する場合に,すべてのメッセージ
77 * が出力できるように,メッセージの量を制限するという理由もある.
78 *
79 * 周期ハンドラは,三つの優å…
80ˆåº¦ï¼ˆHIGH_PRIORITY,MID_PRIORITY,
81 * LOW_PRIORITY)のレディキューを回転させる.プログラムの起動直後は,
82 * 周期ハンドラは停止状æ…
83‹ã«ãªã£ã¦ã„る.
84 *
85 * メインタスクは,シリアルI/Oポートからの文字å…
86¥åŠ›ã‚’行い(文字å…
87¥åŠ›ã‚’
88 * 待
89っている間は,並行実行されるタスクが実行されている),å…
90¥åŠ›ã•ã‚ŒãŸ
91 * 文字に対応した処理を実行する.å…
92¥åŠ›ã•ã‚ŒãŸæ–‡å­—と処理の関係は次の通り.
93 * Control-Cまたは'Q'がå…
94¥åŠ›ã•ã‚Œã‚‹ã¨ï¼Œãƒ—ログラムを終了する.
95 *
96 * '1' : 対象タスクをTASK1に切り換える(初期設定).
97 * '2' : 対象タスクをTASK2に切り換える.
98 * '3' : 対象タスクをTASK3に切り換える.
99 * 'a' : 対象タスクをact_tskにより起動する.
100 * 'A' : 対象タスクに対する起動要求をcan_actによりキャンセルする.
101 * 'e' : 対象タスクにext_tskを呼び出させ,終了させる.
102 * 't' : 対象タスクをter_tskにより強制終了する.
103 * '>' : 対象タスクの優å…
104ˆåº¦ã‚’HIGH_PRIORITYにする.
105 * '=' : 対象タスクの優å…
106ˆåº¦ã‚’MID_PRIORITYにする.
107 * '<' : 対象タスクの優å…
108ˆåº¦ã‚’LOW_PRIORITYにする.
109 * 'G' : 対象タスクの優å…
110ˆåº¦ã‚’get_priで読み出す.
111 * 's' : 対象タスクにslp_tskを呼び出させ,起床待
112ちにさせる.
113 * 'S' : 対象タスクにtslp_tsk(10秒)を呼び出させ,起床待
114ちにさせる.
115 * 'w' : 対象タスクをwup_tskにより起床する.
116 * 'W' : 対象タスクに対する起床要求をcan_wupによりキャンセルする.
117 * 'l' : 対象タスクをrel_waiにより強制的に待
118ち解除にする.
119 * 'u' : 対象タスクをsus_tskにより強制待
120ち状æ…
121‹ã«ã™ã‚‹ï¼Ž
122 * 'm' : 対象タスクの強制待
123ち状æ…
124‹ã‚’rsm_tskにより解除する.
125 * 'd' : 対象タスクにdly_tsk(10秒)を呼び出させ,時間経過待
126ちにさせる.
127 * 'x' : 対象タスクにras_terにより終了要求する.
128 * 'y' : 対象タスクにdis_terを呼び出させ,タスク終了を禁止する.
129 * 'Y' : 対象タスクにena_terを呼び出させ,タスク終了を許可する.
130 * 'r' : 3つの優å…
131ˆåº¦ï¼ˆHIGH_PRIORITY,MID_PRIORITY,LOW_PRIORITY)のレ
132 * ディキューを回転させる.
133 * 'c' : 周期ハンドラを動作開始させる.
134 * 'C' : 周期ハンドラを動作停止させる.
135 * 'b' : アラームハンドラを5秒後に起動するよう動作開始させる.
136 * 'B' : アラームハンドラを動作停止させる.
137 * 'z' : 対象タスクにCPU例外を発生させる(タスクを終了させる).
138 * 'Z' : 対象タスクにCPUロック状æ…
139‹ã§CPU例外を発生させる(プログラムを
140 * 終了する).
141 * 'V' : fch_hrtで高分解能タイマを2回読む.
142 * 'v' : 発行したシステムコールを表示する(デフォルト).
143 * 'q' : 発行したシステムコールを表示しない.
144 */
145
146#include <kernel.h>
147#include <t_syslog.h>
148#include <t_stdlib.h>
149#include "syssvc/serial.h"
150#include "syssvc/syslog.h"
151#include "kernel_cfg.h"
152#include "sample1.h"
153
154/*
155 * サービスコールのエラーのログ出力
156 */
157Inline void
158svc_perror(const char *file, int_t line, const char *expr, ER ercd)
159{
160 if (ercd < 0) {
161 t_perror(LOG_ERROR, file, line, expr, ercd);
162 }
163}
164
165#define SVC_PERROR(expr) svc_perror(__FILE__, __LINE__, #expr, (expr))
166
167/*
168 * 並行実行されるタスクへのメッセージ領域
169 */
170char message[3];
171
172/*
173 * ループ回数
174 */
175ulong_t task_loop; /* タスク内
176でのループ回数 */
177
178/*
179 * 並行実行されるタスク
180 */
181void task(intptr_t exinf)
182{
183 volatile ulong_t i;
184 int_t n = 0;
185 int_t tskno = (int_t) exinf;
186 const char *graph[] = { "|", " +", " *" };
187 char c;
188
189 while (true) {
190 syslog(LOG_NOTICE, "task%d is running (%03d). %s",
191 tskno, ++n, graph[tskno-1]);
192 for (i = 0; i < task_loop; i++);
193 c = message[tskno-1];
194 message[tskno-1] = 0;
195 switch (c) {
196 case 'e':
197 syslog(LOG_INFO, "#%d#ext_tsk()", tskno);
198 SVC_PERROR(ext_tsk());
199 assert(0);
200 case 's':
201 syslog(LOG_INFO, "#%d#slp_tsk()", tskno);
202 SVC_PERROR(slp_tsk());
203 break;
204 case 'S':
205 syslog(LOG_INFO, "#%d#tslp_tsk(10000000)", tskno);
206 SVC_PERROR(tslp_tsk(10000000));
207 break;
208 case 'd':
209 syslog(LOG_INFO, "#%d#dly_tsk(10000000)", tskno);
210 SVC_PERROR(dly_tsk(10000000));
211 break;
212 case 'y':
213 syslog(LOG_INFO, "#%d#dis_ter()", tskno);
214 SVC_PERROR(dis_ter());
215 break;
216 case 'Y':
217 syslog(LOG_INFO, "#%d#ena_ter()", tskno);
218 SVC_PERROR(ena_ter());
219 break;
220#ifdef CPUEXC1
221 case 'z':
222 syslog(LOG_NOTICE, "#%d#raise CPU exception", tskno);
223 RAISE_CPU_EXCEPTION;
224 break;
225 case 'Z':
226 SVC_PERROR(loc_cpu());
227 syslog(LOG_NOTICE, "#%d#raise CPU exception", tskno);
228 RAISE_CPU_EXCEPTION;
229 SVC_PERROR(unl_cpu());
230 break;
231#endif /* CPUEXC1 */
232 default:
233 break;
234 }
235 }
236}
237
238/*
239 * 割込みハンドラ
240 */
241#ifdef INTNO1
242
243void intno1_isr(intptr_t exinf)
244{
245 intno1_clear();
246 SVC_PERROR(rot_rdq(HIGH_PRIORITY));
247 SVC_PERROR(rot_rdq(MID_PRIORITY));
248 SVC_PERROR(rot_rdq(LOW_PRIORITY));
249}
250
251#endif /* INTNO1 */
252
253/*
254 * CPU例外ハンドラ
255 */
256ID cpuexc_tskid; /* CPU例外を起こしたタスクのID */
257
258#ifdef CPUEXC1
259
260void
261cpuexc_handler(void *p_excinf)
262{
263 syslog(LOG_NOTICE, "CPU exception handler (p_excinf = %08p).", p_excinf);
264 if (sns_ctx() != true) {
265 syslog(LOG_WARNING,
266 "sns_ctx() is not true in CPU exception handler.");
267 }
268 if (sns_dpn() != true) {
269 syslog(LOG_WARNING,
270 "sns_dpn() is not true in CPU exception handler.");
271 }
272 syslog(LOG_INFO, "sns_loc = %d sns_dsp = %d xsns_dpn = %d",
273 sns_loc(), sns_dsp(), xsns_dpn(p_excinf));
274
275 if (xsns_dpn(p_excinf)) {
276 syslog(LOG_NOTICE, "Sample program ends with exception.");
277 SVC_PERROR(ext_ker());
278 assert(0);
279 }
280
281#ifdef PREPARE_RETURN_CPUEXC
282 PREPARE_RETURN_CPUEXC;
283 SVC_PERROR(get_tid(&cpuexc_tskid));
284 SVC_PERROR(act_tsk(EXC_TASK));
285#else /* PREPARE_RETURN_CPUEXC */
286 syslog(LOG_NOTICE, "Sample program ends with exception.");
287 SVC_PERROR(ext_ker());
288 assert(0);
289#endif /* PREPARE_RETURN_CPUEXC */
290}
291
292#endif /* CPUEXC1 */
293
294/*
295 * 周期ハンドラ
296 *
297 * HIGH_PRIORITY,MID_PRIORITY,LOW_PRIORITY の各優å…
298ˆåº¦ã®ãƒ¬ãƒ‡ã‚£ã‚­ãƒ¥ãƒ¼
299 * を回転させる.
300 */
301void cyclic_handler(intptr_t exinf)
302{
303 SVC_PERROR(rot_rdq(HIGH_PRIORITY));
304 SVC_PERROR(rot_rdq(MID_PRIORITY));
305 SVC_PERROR(rot_rdq(LOW_PRIORITY));
306}
307
308/*
309 * アラームハンドラ
310 *
311 * HIGH_PRIORITY,MID_PRIORITY,LOW_PRIORITY の各優å…
312ˆåº¦ã®ãƒ¬ãƒ‡ã‚£ã‚­ãƒ¥ãƒ¼
313 * を回転させる.
314 */
315void alarm_handler(intptr_t exinf)
316{
317 SVC_PERROR(rot_rdq(HIGH_PRIORITY));
318 SVC_PERROR(rot_rdq(MID_PRIORITY));
319 SVC_PERROR(rot_rdq(LOW_PRIORITY));
320}
321
322/*
323 * 例外処理タスク
324 */
325void exc_task(intptr_t exinf)
326{
327 SVC_PERROR(ras_ter(cpuexc_tskid));
328}
329
330/*
331 * メインタスク
332 */
333void main_task(intptr_t exinf)
334{
335 char c;
336 ID tskid = TASK1;
337 int_t tskno = 1;
338 ER_UINT ercd;
339 PRI tskpri;
340#ifndef TASK_LOOP
341 volatile ulong_t i;
342 SYSTIM stime1, stime2;
343#endif /* TASK_LOOP */
344 HRTCNT hrtcnt1, hrtcnt2;
345
346 SVC_PERROR(syslog_msk_log(LOG_UPTO(LOG_INFO), LOG_UPTO(LOG_EMERG)));
347 syslog(LOG_NOTICE, "Sample program starts (exinf = %d).", (int_t) exinf);
348
349 /*
350 * シリアルポートの初期化
351 *
352 * システムログタスクと同じシリアルポートを使う場合など,シリアル
353 * ポートがオープン済みの場合にはここでE_OBJエラーになるが,支障は
354 * ない.
355 */
356 ercd = serial_opn_por(TASK_PORTID);
357 if (ercd < 0 && MERCD(ercd) != E_OBJ) {
358 syslog(LOG_ERROR, "%s (%d) reported by `serial_opn_por'.",
359 itron_strerror(ercd), SERCD(ercd));
360 }
361 SVC_PERROR(serial_ctl_por(TASK_PORTID,
362 (IOCTL_CRLF | IOCTL_FCSND | IOCTL_FCRCV)));
363
364 /*
365 * ループ回数の設定
366 *
367 * 並行実行されるタスク内
368での空ループの回数(task_loop)は,空ルー
369 * プの実行時間が約0.4秒になるように設定する.この設定のために,
370 * LOOP_REF回の空ループの実行時間を,その前後でget_timを呼ぶことで
371 * 測定し,その測定結果から空ループの実行時間が0.4秒になるループ回
372 * 数を求め,task_loopに設定する.
373 *
374 * LOOP_REFは,デフォルトでは1,000,000に設定しているが,想定したよ
375 * り遅
376いプロセッサでは,サンプルプログラムの実行開始に時間がかか
377 * りすぎるという問題を生じる.逆に想定したより速いプロセッサでは,
378 * LOOP_REF回の空ループの実行時間が短くなり,task_loopに設定する値
379 * の誤差が大きくなるという問題がある.
380 *
381 * そこで,そのようなターゲットでは,target_test.hで,LOOP_REFを適
382 * 切な値に定義するのが望ましい.
383 *
384 * また,task_loopの値を固定したい場合には,その値をTASK_LOOPにマ
385 * クロ定義する.TASK_LOOPがマクロ定義されている場合,上記の測定を
386 * 行わずに,TASK_LOOPに定義された値を空ループの回数とする.
387 *
388 * ターゲットによっては,空ループの実行時間の1回目の測定で,本来よ
389 * りも長めになるものがある.このようなターゲットでは,MEASURE_TWICE
390 * をマクロ定義することで,1回目の測定結果を捨てて,2回目の測定結果
391 * を使う.
392 */
393#ifdef TASK_LOOP
394 task_loop = TASK_LOOP;
395#else /* TASK_LOOP */
396
397#ifdef MEASURE_TWICE
398 task_loop = LOOP_REF;
399 SVC_PERROR(get_tim(&stime1));
400 for (i = 0; i < task_loop; i++);
401 SVC_PERROR(get_tim(&stime2));
402#endif /* MEASURE_TWICE */
403
404 task_loop = LOOP_REF;
405 SVC_PERROR(get_tim(&stime1));
406 for (i = 0; i < task_loop; i++);
407 SVC_PERROR(get_tim(&stime2));
408 task_loop = LOOP_REF * 400LU / (ulong_t)(stime2 - stime1) * 1000LU;
409
410#endif /* TASK_LOOP */
411
412 /*
413 * タスクの起動
414 */
415 SVC_PERROR(act_tsk(TASK1));
416 SVC_PERROR(act_tsk(TASK2));
417 SVC_PERROR(act_tsk(TASK3));
418
419 /*
420 * メインループ
421 */
422 do {
423 SVC_PERROR(serial_rea_dat(TASK_PORTID, &c, 1));
424 switch (c) {
425 case 'e':
426 case 's':
427 case 'S':
428 case 'd':
429 case 'y':
430 case 'Y':
431 case 'z':
432 case 'Z':
433 message[tskno-1] = c;
434 break;
435 case '1':
436 tskno = 1;
437 tskid = TASK1;
438 break;
439 case '2':
440 tskno = 2;
441 tskid = TASK2;
442 break;
443 case '3':
444 tskno = 3;
445 tskid = TASK3;
446 break;
447 case 'a':
448 syslog(LOG_INFO, "#act_tsk(%d)", tskno);
449 SVC_PERROR(act_tsk(tskid));
450 break;
451 case 'A':
452 syslog(LOG_INFO, "#can_act(%d)", tskno);
453 SVC_PERROR(ercd = can_act(tskid));
454 if (ercd >= 0) {
455 syslog(LOG_NOTICE, "can_act(%d) returns %d", tskno, ercd);
456 }
457 break;
458 case 't':
459 syslog(LOG_INFO, "#ter_tsk(%d)", tskno);
460 SVC_PERROR(ter_tsk(tskid));
461 break;
462 case '>':
463 syslog(LOG_INFO, "#chg_pri(%d, HIGH_PRIORITY)", tskno);
464 SVC_PERROR(chg_pri(tskid, HIGH_PRIORITY));
465 break;
466 case '=':
467 syslog(LOG_INFO, "#chg_pri(%d, MID_PRIORITY)", tskno);
468 SVC_PERROR(chg_pri(tskid, MID_PRIORITY));
469 break;
470 case '<':
471 syslog(LOG_INFO, "#chg_pri(%d, LOW_PRIORITY)", tskno);
472 SVC_PERROR(chg_pri(tskid, LOW_PRIORITY));
473 break;
474 case 'G':
475 syslog(LOG_INFO, "#get_pri(%d, &tskpri)", tskno);
476 SVC_PERROR(ercd = get_pri(tskid, &tskpri));
477 if (ercd >= 0) {
478 syslog(LOG_NOTICE, "priority of task %d is %d", tskno, tskpri);
479 }
480 break;
481 case 'w':
482 syslog(LOG_INFO, "#wup_tsk(%d)", tskno);
483 SVC_PERROR(wup_tsk(tskid));
484 break;
485 case 'W':
486 syslog(LOG_INFO, "#can_wup(%d)", tskno);
487 SVC_PERROR(ercd = can_wup(tskid));
488 if (ercd >= 0) {
489 syslog(LOG_NOTICE, "can_wup(%d) returns %d", tskno, ercd);
490 }
491 break;
492 case 'l':
493 syslog(LOG_INFO, "#rel_wai(%d)", tskno);
494 SVC_PERROR(rel_wai(tskid));
495 break;
496 case 'u':
497 syslog(LOG_INFO, "#sus_tsk(%d)", tskno);
498 SVC_PERROR(sus_tsk(tskid));
499 break;
500 case 'm':
501 syslog(LOG_INFO, "#rsm_tsk(%d)", tskno);
502 SVC_PERROR(rsm_tsk(tskid));
503 break;
504 case 'x':
505 syslog(LOG_INFO, "#ras_ter(%d)", tskno);
506 SVC_PERROR(ras_ter(tskid));
507 break;
508 case 'r':
509 syslog(LOG_INFO, "#rot_rdq(three priorities)");
510 SVC_PERROR(rot_rdq(HIGH_PRIORITY));
511 SVC_PERROR(rot_rdq(MID_PRIORITY));
512 SVC_PERROR(rot_rdq(LOW_PRIORITY));
513 break;
514 case 'c':
515 syslog(LOG_INFO, "#sta_cyc(1)");
516 SVC_PERROR(sta_cyc(CYCHDR1));
517 break;
518 case 'C':
519 syslog(LOG_INFO, "#stp_cyc(1)");
520 SVC_PERROR(stp_cyc(CYCHDR1));
521 break;
522 case 'b':
523 syslog(LOG_INFO, "#sta_alm(1, 5000000)");
524 SVC_PERROR(sta_alm(ALMHDR1, 5000000));
525 break;
526 case 'B':
527 syslog(LOG_INFO, "#stp_alm(1)");
528 SVC_PERROR(stp_alm(ALMHDR1));
529 break;
530
531 case 'V':
532 hrtcnt1 = fch_hrt();
533 hrtcnt2 = fch_hrt();
534 syslog(LOG_NOTICE, "hrtcnt1 = %tu, hrtcnt2 = %tu",
535 hrtcnt1, hrtcnt2);
536 break;
537
538 case 'v':
539 SVC_PERROR(syslog_msk_log(LOG_UPTO(LOG_INFO),
540 LOG_UPTO(LOG_EMERG)));
541 break;
542 case 'q':
543 SVC_PERROR(syslog_msk_log(LOG_UPTO(LOG_NOTICE),
544 LOG_UPTO(LOG_EMERG)));
545 break;
546
547#ifdef BIT_KERNEL
548 case ' ':
549 SVC_PERROR(loc_cpu());
550 {
551 extern ER bit_kernel(void);
552
553 SVC_PERROR(ercd = bit_kernel());
554 if (ercd >= 0) {
555 syslog(LOG_NOTICE, "bit_kernel passed.");
556 }
557 }
558 SVC_PERROR(unl_cpu());
559 break;
560#endif /* BIT_KERNEL */
561
562 default:
563 break;
564 }
565 } while (c != '\003' && c != 'Q');
566
567 syslog(LOG_NOTICE, "Sample program ends.");
568 SVC_PERROR(ext_ker());
569 assert(0);
570}
Note: See TracBrowser for help on using the repository browser.