source: asp3_wo_tecs/trunk/sample/sample1.c@ 302

/*
 *  TOPPERS/ASP Kernel
 *      Toyohashi Open Platform for Embedded Real-Time Systems/
 *      Advanced Standard Profile Kernel
 * 
 *  Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
 *                              Toyohashi Univ. of Technology, JAPAN
 *  Copyright (C) 2004-2015 by Embedded and Real-Time Systems Laboratory
 *              Graduate School of Information Science, Nagoya Univ., JAPAN
 * 
 *  上記著作権者
は，以下の(1)〜(4)ã®æ¡ä»¶ã‚’æº€ãŸã™å ´åˆã«é™ã‚Šï¼Œæœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§
 *  ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
 *  変・再é…
å¸ƒï¼ˆä»¥ä¸‹ï¼Œåˆ©ç”¨ã¨å‘¼ã¶ï¼‰ã™ã‚‹ã“とを無償で許諾する．
 *  (1) æœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§ã‚¢ã‚’ã‚½ãƒ¼ã‚¹ã‚³ãƒ¼ãƒ‰ã®å½¢ã§åˆ©ç”¨ã™ã‚‹å ´åˆã«ã¯ï¼Œä¸Šè¨˜ã®è‘—ä½œ
 *      権表示，この利用条件および下記の無保証規定が，そのままの形でソー
 *      スコード中に含まれていること．
 *  (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
 *      用できる形で再é…
å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œå†é…
å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨
 *      者
マニュアルなど）に，上記の著作権表示，この利用条件および下記
 *      の無保証規定を掲載すること．
 *  (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
 *      用できない形で再é…
å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œæ¬¡ã®ã„ずれかの条件を満たすこ
 *      と．
 *    (a) 再é…
å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨è€…
マニュアルなど）に，上記の著
 *        作権表示，この利用条件および下記の無保証規定を掲載すること．
 *    (b) 再é…
å¸ƒã®å½¢æ…
‹ã‚’，別に定める方法によって，TOPPERSプロジェクトに
 *        å ±å‘Šã™ã‚‹ã“ã¨ï¼Ž
 *  (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
 *      害からも，上記著作権者
およびTOPPERSプロジェクトをå…
è²¬ã™ã‚‹ã“と．
 *      また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
 *      由に基づく請求からも，上記著作権者
およびTOPPERSプロジェクトを
 *      å…
è²¬ã™ã‚‹ã“と．
 * 
 *  本ソフトウェアは，無保証で提供されているものである．上記著作権者
お
 *  よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
 *  に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
 *  アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
 *  ã®è²¬ä»»ã‚’è² ã‚ãªã„ï¼Ž
 * 
 *  $Id: sample1.c 346 2015-07-18 02:12:08Z ertl-hiro $
 */

/* 
 *  サンプルプログラム(1)の本体
 *
 *  ASPカーネルの基本的な動作を確認するためのサンプルプログラム．
 *
 *  プログラムの概要:
 *
 *  ユーザインタフェースを受け持つメインタスク（タスクID: MAIN_TASK，優
 *  å…
ˆåº¦: MAIN_PRIORITY）と，3つの並行実行されるタスク（タスクID:
 *  TASK1〜TASK3，初期優å…
ˆåº¦: MID_PRIORITY）で構成される．また，起動周
 *  期が2秒の周期ハンドラ（周期ハンドラID: CYCHDR1）を用いる．
 *
 *  並行実行されるタスクは，task_loop回空ループを実行する度に，タスクが
 *  実行中であることをあらわすメッセージを表示する．空ループを実行する
 *  のは，空ループなしでメッセージを出力すると，多量のメッセージが出力
 *  され，プログラムの動作が確認しずらくなるためである．また，低速なシ
 *  ãƒªã‚¢ãƒ«ãƒãƒ¼ãƒˆã‚’ç”¨ã„ã¦ãƒ¡ãƒƒã‚»ãƒ¼ã‚¸ã‚’å‡ºåŠ›ã™ã‚‹å ´åˆã«ï¼Œã™ã¹ã¦ã®ãƒ¡ãƒƒã‚»ãƒ¼ã‚¸
 *  が出力できるように，メッセージの量を制限するという理由もある．
 *
 *  周期ハンドラは，三つの優å…
ˆåº¦ï¼ˆHIGH_PRIORITY，MID_PRIORITY，
 *  LOW_PRIORITY）のレディキューを回転させる．プログラムの起動直後は，
 *  周期ハンドラは停止状æ…
‹ã«ãªã£ã¦ã„る．
 *
 *  メインタスクは，シリアルI/Oポートからの文字å…
¥åŠ›ã‚’行い（文字å…
¥åŠ›ã‚’
 *  待
っている間は，並行実行されるタスクが実行されている），å…
¥åŠ›ã•ã‚ŒãŸ
 *  文字に対応した処理を実行する．å…
¥åŠ›ã•ã‚ŒãŸæ–‡å­—と処理の関係は次の通り．
 *  Control-Cまたは'Q'がå…
¥åŠ›ã•ã‚Œã‚‹ã¨ï¼Œãƒ—ログラムを終了する．
 *
 *  '1' : 対象タスクをTASK1に切り換える（初期設定）．
 *  '2' : 対象タスクをTASK2に切り換える．
 *  '3' : 対象タスクをTASK3に切り換える．
 *  'a' : 対象タスクをact_tskにより起動する．
 *  'A' : 対象タスクに対する起動要求をcan_actによりキャンセルする．
 *  'e' : 対象タスクにext_tskを呼び出させ，終了させる．
 *  't' : 対象タスクをter_tskにより強制終了する．
 *  '>' : 対象タスクの優å…
ˆåº¦ã‚’HIGH_PRIORITYにする．
 *  '=' : 対象タスクの優å…
ˆåº¦ã‚’MID_PRIORITYにする．
 *  '<' : 対象タスクの優å…
ˆåº¦ã‚’LOW_PRIORITYにする．
 *  'G' : 対象タスクの優å…
ˆåº¦ã‚’get_priで読み出す．
 *  's' : 対象タスクにslp_tskを呼び出させ，起床待
ちにさせる．
 *  'S' : 対象タスクにtslp_tsk(10秒)を呼び出させ，起床待
ちにさせる．
 *  'w' : 対象タスクをwup_tskにより起床する．
 *  'W' : 対象タスクに対する起床要求をcan_wupによりキャンセルする．
 *  'l' : 対象タスクをrel_waiにより強制的に待
ち解除にする．
 *  'u' : 対象タスクをsus_tskにより強制待
ち状æ…
‹ã«ã™ã‚‹ï¼Ž
 *  'm' : 対象タスクの強制待
ち状æ…
‹ã‚’rsm_tskにより解除する．
 *  'd' : 対象タスクにdly_tsk(10秒)を呼び出させ，時間経過待
ちにさせる．
 *  'x' : 対象タスクにras_terにより終了要求する．
 *  'y' : 対象タスクにdis_terを呼び出させ，タスク終了を禁止する．
 *  'Y' : 対象タスクにena_terを呼び出させ，タスク終了を許可する．
 *  'r' : 3つの優å…
ˆåº¦ï¼ˆHIGH_PRIORITY，MID_PRIORITY，LOW_PRIORITY）のレ
 *        ディキューを回転させる．
 *  'c' : 周期ハンドラを動作開始させる．
 *  'C' : 周期ハンドラを動作停止させる．
 *  'b' : アラームハンドラを5秒後に起動するよう動作開始させる．
 *  'B' : アラームハンドラを動作停止させる．
 *  'z' : 対象タスクにCPU例外を発生させる（タスクを終了させる）．
 *  'Z' : 対象タスクにCPUロック状æ…
‹ã§CPU例外を発生させる（プログラムを
 *        終了する）．
 *  'V' : fch_hrtで高分解能タイマを2回読む．
 *  'v' : 発行したシステムコールを表示する（デフォルト）．
 *  'q' : 発行したシステムコールを表示しない．
 */

#include <kernel.h>
#include <t_syslog.h>
#include <t_stdlib.h>
#include "syssvc/serial.h"
#include "syssvc/syslog.h"
#include "kernel_cfg.h"
#include "sample1.h"

/*
 *  サービスコールのエラーのログ出力
 */
Inline void
svc_perror(const char *file, int_t line, const char *expr, ER ercd)
{
        if (ercd < 0) {
                t_perror(LOG_ERROR, file, line, expr, ercd);
        }
}

#define SVC_PERROR(expr)        svc_perror(__FILE__, __LINE__, #expr, (expr))

/*
 *  ä¸¦è¡Œå®Ÿè¡Œã•ã‚Œã‚‹ã‚¿ã‚¹ã‚¯ã¸ã®ãƒ¡ãƒƒã‚»ãƒ¼ã‚¸é ˜åŸŸ
 */
char    message[3];

/*
 *  ループ回数
 */
ulong_t task_loop;              /* タスク内
でのループ回数 */

/*
 *  並行実行されるタスク
 */
void task(intptr_t exinf)
{
        volatile ulong_t        i;
        int_t           n = 0;
        int_t           tskno = (int_t) exinf;
        const char      *graph[] = { "|", "  +", "    *" };
        char            c;

        while (true) {
                syslog(LOG_NOTICE, "task%d is running (%03d).   %s",
                                                                                tskno, ++n, graph[tskno-1]);
                for (i = 0; i < task_loop; i++);
                c = message[tskno-1];
                message[tskno-1] = 0;
                switch (c) {
                case 'e':
                        syslog(LOG_INFO, "#%d#ext_tsk()", tskno);
                        SVC_PERROR(ext_tsk());
                        assert(0);
                case 's':
                        syslog(LOG_INFO, "#%d#slp_tsk()", tskno);
                        SVC_PERROR(slp_tsk());
                        break;
                case 'S':
                        syslog(LOG_INFO, "#%d#tslp_tsk(10000000)", tskno);
                        SVC_PERROR(tslp_tsk(10000000));
                        break;
                case 'd':
                        syslog(LOG_INFO, "#%d#dly_tsk(10000000)", tskno);
                        SVC_PERROR(dly_tsk(10000000));
                        break;
                case 'y':
                        syslog(LOG_INFO, "#%d#dis_ter()", tskno);
                        SVC_PERROR(dis_ter());
                        break;
                case 'Y':
                        syslog(LOG_INFO, "#%d#ena_ter()", tskno);
                        SVC_PERROR(ena_ter());
                        break;
#ifdef CPUEXC1
                case 'z':
                        syslog(LOG_NOTICE, "#%d#raise CPU exception", tskno);
                        RAISE_CPU_EXCEPTION;
                        break;
                case 'Z':
                        SVC_PERROR(loc_cpu());
                        syslog(LOG_NOTICE, "#%d#raise CPU exception", tskno);
                        RAISE_CPU_EXCEPTION;
                        SVC_PERROR(unl_cpu());
                        break;
#endif /* CPUEXC1 */
                default:
                        break;
                }
        }
}

/*
 *  CPU例外ハンドラ
 */
ID      cpuexc_tskid;           /* CPU例外を起こしたタスクのID */

#ifdef CPUEXC1

void
cpuexc_handler(void *p_excinf)
{
        syslog(LOG_NOTICE, "CPU exception handler (p_excinf = %08p).", p_excinf);
        if (sns_ctx() != true) {
                syslog(LOG_WARNING,
                                        "sns_ctx() is not true in CPU exception handler.");
        }
        if (sns_dpn() != true) {
                syslog(LOG_WARNING,
                                        "sns_dpn() is not true in CPU exception handler.");
        }
        syslog(LOG_INFO, "sns_loc = %d sns_dsp = %d xsns_dpn = %d",
                                                                sns_loc(), sns_dsp(), xsns_dpn(p_excinf));

        if (xsns_dpn(p_excinf)) {
                syslog(LOG_NOTICE, "Sample program ends with exception.");
                SVC_PERROR(ext_ker());
                assert(0);
        }

#ifdef PREPARE_RETURN_CPUEXC
        PREPARE_RETURN_CPUEXC;
        SVC_PERROR(get_tid(&cpuexc_tskid));
        SVC_PERROR(act_tsk(EXC_TASK));
#else /* PREPARE_RETURN_CPUEXC */
        syslog(LOG_NOTICE, "Sample program ends with exception.");
        SVC_PERROR(ext_ker());
        assert(0);
#endif /* PREPARE_RETURN_CPUEXC */
}

#endif /* CPUEXC1 */

/*
 *  周期ハンドラ
 *
 *  HIGH_PRIORITY，MID_PRIORITY，LOW_PRIORITY の各優å…
ˆåº¦ã®ãƒ¬ãƒ‡ã‚£ã‚­ãƒ¥ãƒ¼
 *  を回転させる．
 */
void cyclic_handler(intptr_t exinf)
{
        SVC_PERROR(rot_rdq(HIGH_PRIORITY));
        SVC_PERROR(rot_rdq(MID_PRIORITY));
        SVC_PERROR(rot_rdq(LOW_PRIORITY));
}

/*
 *  アラームハンドラ
 *
 *  HIGH_PRIORITY，MID_PRIORITY，LOW_PRIORITY の各優å…
ˆåº¦ã®ãƒ¬ãƒ‡ã‚£ã‚­ãƒ¥ãƒ¼
 *  を回転させる．
 */
void alarm_handler(intptr_t exinf)
{
        SVC_PERROR(rot_rdq(HIGH_PRIORITY));
        SVC_PERROR(rot_rdq(MID_PRIORITY));
        SVC_PERROR(rot_rdq(LOW_PRIORITY));
}

/*
 *  例外処理タスク
 */
void exc_task(intptr_t exinf)
{
        SVC_PERROR(ras_ter(cpuexc_tskid));
}

/*
 *  メインタスク
 */
void main_task(intptr_t exinf)
{
        char    c;
        ID              tskid = TASK1;
        int_t   tskno = 1;
        ER_UINT ercd;
        PRI             tskpri;
#ifndef TASK_LOOP
        volatile ulong_t        i;
        SYSTIM  stime1, stime2;
#endif /* TASK_LOOP */
        HRTCNT  hrtcnt1, hrtcnt2;

        SVC_PERROR(syslog_msk_log(LOG_UPTO(LOG_INFO), LOG_UPTO(LOG_EMERG)));
        syslog(LOG_NOTICE, "Sample program starts (exinf = %d).", (int_t) exinf);

        /*
         *  シリアルポートの初期化
         *
         *  ã‚·ã‚¹ãƒ†ãƒ ãƒ­ã‚°ã‚¿ã‚¹ã‚¯ã¨åŒã˜ã‚·ãƒªã‚¢ãƒ«ãƒãƒ¼ãƒˆã‚’ä½¿ã†å ´åˆãªã©ï¼Œã‚·ãƒªã‚¢ãƒ«
         *  ãƒãƒ¼ãƒˆãŒã‚ªãƒ¼ãƒ—ãƒ³æ¸ˆã¿ã®å ´åˆã«ã¯ã“ã“ã§E_OBJエラーになるが，支障は
         *  ない．
         */
        ercd = serial_opn_por(TASK_PORTID);
        if (ercd < 0 && MERCD(ercd) != E_OBJ) {
                syslog(LOG_ERROR, "%s (%d) reported by `serial_opn_por'.",
                                                                        itron_strerror(ercd), SERCD(ercd));
        }
        SVC_PERROR(serial_ctl_por(TASK_PORTID,
                                                        (IOCTL_CRLF | IOCTL_FCSND | IOCTL_FCRCV)));

        /*
         *  ループ回数の設定
         *
         *  並行実行されるタスク内
での空ループの回数（task_loop）は，空ルー
         *  プの実行時間が約0.4秒になるように設定する．この設定のために，
         *  LOOP_REF回の空ループの実行時間を，その前後でget_timを呼ぶことで
         *  測定し，その測定結果から空ループの実行時間が0.4秒になるループ回
         *  数を求め，task_loopに設定する．
         *
         *  LOOP_REFは，デフォルトでは1,000,000に設定しているが，想定したよ
         *  り遅
いプロセッサでは，サンプルプログラムの実行開始に時間がかか
         *  りすぎるという問題を生じる．逆に想定したより速いプロセッサでは，
         *  LOOP_REF回の空ループの実行時間が短くなり，task_loopに設定する値
         *  の誤差が大きくなるという問題がある．
         *
         *  そこで，そのようなターゲットでは，target_test.hで，LOOP_REFを適
         *  切な値に定義するのが望ましい．
         *
         *  また，task_loopã®å€¤ã‚’å›ºå®šã—ãŸã„å ´åˆã«ã¯ï¼Œãã®å€¤ã‚’TASK_LOOPにマ
         *  クロ定義する．TASK_LOOPãŒãƒžã‚¯ãƒ­å®šç¾©ã•ã‚Œã¦ã„ã‚‹å ´åˆï¼Œä¸Šè¨˜ã®æ¸¬å®šã‚’
         *  行わずに，TASK_LOOPに定義された値を空ループの回数とする．
         *
         * ターゲットによっては，空ループの実行時間の1回目の測定で，本来よ
         * りも長めになるものがある．このようなターゲットでは，MEASURE_TWICE
         * をマクロ定義することで，1回目の測定結果を捨てて，2回目の測定結果
         * を使う．
         */
#ifdef TASK_LOOP
        task_loop = TASK_LOOP;
#else /* TASK_LOOP */

#ifdef MEASURE_TWICE
        task_loop = LOOP_REF;
        SVC_PERROR(get_tim(&stime1));
        for (i = 0; i < task_loop; i++);
        SVC_PERROR(get_tim(&stime2));
#endif /* MEASURE_TWICE */

        task_loop = LOOP_REF;
        SVC_PERROR(get_tim(&stime1));
        for (i = 0; i < task_loop; i++);
        SVC_PERROR(get_tim(&stime2));
        task_loop = LOOP_REF * 400LU / (ulong_t)(stime2 - stime1) * 1000LU;

#endif /* TASK_LOOP */

        /*
         *  タスクの起動
         */
        SVC_PERROR(act_tsk(TASK1));
        SVC_PERROR(act_tsk(TASK2));
        SVC_PERROR(act_tsk(TASK3));

        /*
         *  メインループ
         */
        do {
                SVC_PERROR(serial_rea_dat(TASK_PORTID, &c, 1));
                switch (c) {
                case 'e':
                case 's':
                case 'S':
                case 'd':
                case 'y':
                case 'Y':
                case 'z':
                case 'Z':
                        message[tskno-1] = c;
                        break;
                case '1':
                        tskno = 1;
                        tskid = TASK1;
                        break;
                case '2':
                        tskno = 2;
                        tskid = TASK2;
                        break;
                case '3':
                        tskno = 3;
                        tskid = TASK3;
                        break;
                case 'a':
                        syslog(LOG_INFO, "#act_tsk(%d)", tskno);
                        SVC_PERROR(act_tsk(tskid));
                        break;
                case 'A':
                        syslog(LOG_INFO, "#can_act(%d)", tskno);
                        SVC_PERROR(ercd = can_act(tskid));
                        if (ercd >= 0) {
                                syslog(LOG_NOTICE, "can_act(%d) returns %d", tskno, ercd);
                        }
                        break;
                case 't':
                        syslog(LOG_INFO, "#ter_tsk(%d)", tskno);
                        SVC_PERROR(ter_tsk(tskid));
                        break;
                case '>':
                        syslog(LOG_INFO, "#chg_pri(%d, HIGH_PRIORITY)", tskno);
                        SVC_PERROR(chg_pri(tskid, HIGH_PRIORITY));
                        break;
                case '=':
                        syslog(LOG_INFO, "#chg_pri(%d, MID_PRIORITY)", tskno);
                        SVC_PERROR(chg_pri(tskid, MID_PRIORITY));
                        break;
                case '<':
                        syslog(LOG_INFO, "#chg_pri(%d, LOW_PRIORITY)", tskno);
                        SVC_PERROR(chg_pri(tskid, LOW_PRIORITY));
                        break;
                case 'G':
                        syslog(LOG_INFO, "#get_pri(%d, &tskpri)", tskno);
                        SVC_PERROR(ercd = get_pri(tskid, &tskpri));
                        if (ercd >= 0) {
                                syslog(LOG_NOTICE, "priority of task %d is %d", tskno, tskpri);
                        }
                        break;
                case 'w':
                        syslog(LOG_INFO, "#wup_tsk(%d)", tskno);
                        SVC_PERROR(wup_tsk(tskid));
                        break;
                case 'W':
                        syslog(LOG_INFO, "#can_wup(%d)", tskno);
                        SVC_PERROR(ercd = can_wup(tskid));
                        if (ercd >= 0) {
                                syslog(LOG_NOTICE, "can_wup(%d) returns %d", tskno, ercd);
                        }
                        break;
                case 'l':
                        syslog(LOG_INFO, "#rel_wai(%d)", tskno);
                        SVC_PERROR(rel_wai(tskid));
                        break;
                case 'u':
                        syslog(LOG_INFO, "#sus_tsk(%d)", tskno);
                        SVC_PERROR(sus_tsk(tskid));
                        break;
                case 'm':
                        syslog(LOG_INFO, "#rsm_tsk(%d)", tskno);
                        SVC_PERROR(rsm_tsk(tskid));
                        break;
                case 'x':
                        syslog(LOG_INFO, "#ras_ter(%d)", tskno);
                        SVC_PERROR(ras_ter(tskid));
                        break;
                case 'r':
                        syslog(LOG_INFO, "#rot_rdq(three priorities)");
                        SVC_PERROR(rot_rdq(HIGH_PRIORITY));
                        SVC_PERROR(rot_rdq(MID_PRIORITY));
                        SVC_PERROR(rot_rdq(LOW_PRIORITY));
                        break;
                case 'c':
                        syslog(LOG_INFO, "#sta_cyc(1)");
                        SVC_PERROR(sta_cyc(CYCHDR1));
                        break;
                case 'C':
                        syslog(LOG_INFO, "#stp_cyc(1)");
                        SVC_PERROR(stp_cyc(CYCHDR1));
                        break;
                case 'b':
                        syslog(LOG_INFO, "#sta_alm(1, 5000000)");
                        SVC_PERROR(sta_alm(ALMHDR1, 5000000));
                        break;
                case 'B':
                        syslog(LOG_INFO, "#stp_alm(1)");
                        SVC_PERROR(stp_alm(ALMHDR1));
                        break;

                case 'V':
                        hrtcnt1 = fch_hrt();
                        hrtcnt2 = fch_hrt();
                        syslog(LOG_NOTICE, "hrtcnt1 = %tu, hrtcnt2 = %tu",
                                                                                hrtcnt1, hrtcnt2);
                        break;

                case 'v':
                        SVC_PERROR(syslog_msk_log(LOG_UPTO(LOG_INFO),
                                                                                LOG_UPTO(LOG_EMERG)));
                        break;
                case 'q':
                        SVC_PERROR(syslog_msk_log(LOG_UPTO(LOG_NOTICE),
                                                                                LOG_UPTO(LOG_EMERG)));
                        break;

#ifdef BIT_KERNEL
                case ' ':
                        SVC_PERROR(loc_cpu());
                        {
                                extern ER       bit_kernel(void);

                                SVC_PERROR(ercd = bit_kernel());
                                if (ercd >= 0) {
                                        syslog(LOG_NOTICE, "bit_kernel passed.");
                                }
                        }
                        SVC_PERROR(unl_cpu());
                        break;
#endif /* BIT_KERNEL */

                default:
                        break;
                }
        } while (c != '\003' && c != 'Q');

        syslog(LOG_NOTICE, "Sample program ends.");
        SVC_PERROR(ext_ker());
        assert(0);
}