source: EcnlProtoTool/trunk/asp3_dcre/arch/tracelog/tTraceLog.c@ 270

/*
 *  TOPPERS Software
 *      Toyohashi Open Platform for Embedded Real-Time Systems
 * 
 *  Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
 *                              Toyohashi Univ. of Technology, JAPAN
 *  Copyright (C) 2005-2016 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: tTraceLog.c 270 2017-02-09 04:03:47Z coas-nagasima $
 */

/*
 *              トレースログ機能
 */

#include "tTraceLog_tecsgen.h"
#include "kernel/kernel_impl.h"
#include "kernel/task.h"
#include "kernel/time_event.h"
#include <sil.h>
#include <log_output.h>
#include "target_syssvc.h"

/*
 *  トレース時刻の取り出し
 *
 *  デフォルトでは，ログ時刻として，高分解能タイマのカウント値を用いて
 *  ã„ã‚‹ï¼Žã‚¿ãƒ¼ã‚²ãƒƒãƒˆä¾å­˜ã§å¤‰æ›´ã™ã‚‹å ´åˆã«ã¯ï¼ŒSYSLOG_GET_LOGTIMに，ログ時
 *  刻を取り出すマクロを定義する．
 */
#ifndef SYSLOG_GET_LOGTIM
#define SYSLOG_GET_LOGTIM(p_logtim) \
                                (*(p_logtim) = target_hrt_get_current())
#endif /* SYSLOG_GET_TIM */

/*
 *  トレースログの開始
 */
ER
eTraceLog_start(MODE mode)
{
        if ((mode & TRACE_CLEAR) != 0U) {
                VAR_count = 0U;
                VAR_head = 0U;
                VAR_tail = 0U;
                mode &= ~TRACE_CLEAR;
        }
        VAR_mode = mode;
        return(E_OK);
}     

/* 
 *  トレースログの書込み
 */
ER
eTraceLog_write(const TRACE *p_trace)
{
        SIL_PRE_LOC;

        if ((VAR_mode & (TRACE_RINGBUF | TRACE_AUTOSTOP)) != 0U) {
                SIL_LOC_INT();

                /*
                 *  トレース時刻の設定
                 */
                SYSLOG_GET_LOGTIM(&(((SYSLOG *) p_trace)->logtim));

                /*
                 *  トレースバッファに記録
                 */
                VAR_logBuffer[VAR_tail] = *p_trace;
                VAR_tail++;
                if (VAR_tail >= ATTR_logBufferSize) {
                        VAR_tail = 0U;
                }
                if (VAR_count < ATTR_logBufferSize) {
                        VAR_count++;
                        if (VAR_count >= ATTR_logBufferSize
                                                && (VAR_mode & TRACE_AUTOSTOP) != 0U) {
                                VAR_mode = TRACE_STOP;
                        }
                }
                else {
                        VAR_head = VAR_tail;
                }

                SIL_UNL_INT();
        }
        return(E_OK);
}

/*
 *  トレースログの読出し
 */
ER
eTraceLog_read(TRACE* p_trace)
{
        ER_UINT ercd;
        SIL_PRE_LOC;

        SIL_LOC_INT();

        /*
         *  トレースログバッファからの取出し
         */
        if (VAR_count > 0U) {
                *p_trace = VAR_logBuffer[VAR_head];
                VAR_count--;
                VAR_head++;
                if (VAR_head >= ATTR_logBufferSize) {
                        VAR_head = 0U;
                }
                ercd = E_OK;
        }
        else {
                ercd = E_OBJ;
        }

        SIL_UNL_INT();
        return(ercd);
}

/*
 *  アセンブリ言語で記述されるコードからトレースログを出力するための関
 *  数
 */

void
log_dsp_enter(TCB *p_tcb)
{
        trace_1(LOG_TYPE_DSP|LOG_ENTER, p_tcb);
}

void
log_dsp_leave(TCB *p_tcb)
{
        trace_1(LOG_TYPE_DSP|LOG_LEAVE, p_tcb);
}

void
log_inh_enter(INHNO inhno)
{
        trace_1(LOG_TYPE_INH|LOG_ENTER, inhno);
}

void
log_inh_leave(INHNO inhno)
{
        trace_1(LOG_TYPE_INH|LOG_LEAVE, inhno);
}

void
log_exc_enter(EXCNO excno)
{
        trace_1(LOG_TYPE_EXC|LOG_ENTER, excno);
}

void
log_exc_leave(EXCNO excno)
{
        trace_1(LOG_TYPE_EXC|LOG_LEAVE, excno);
}

/* 
 *  カーネル情
å ±ã®å–å‡ºã—
 */
static intptr_t
get_tskid(intptr_t info)
{
        TCB             *p_tcb;
        ID              tskid;

        p_tcb = (TCB *) info;
        if (p_tcb == NULL) {
                tskid = 0;
        }
        else {
                tskid = TSKID(p_tcb);
        }
        return((intptr_t) tskid);
}

static intptr_t
get_tskstat(intptr_t info)
{
        uint_t          tstat;
        const char      *tstatstr;

        tstat = (uint_t) info;
        if (TSTAT_DORMANT(tstat)) {
                tstatstr = "DORMANT";
        }
        else {
                if (TSTAT_SUSPENDED(tstat)) {
                        if (TSTAT_WAITING(tstat)) {
                                tstatstr = "WAITING-SUSPENDED";
                        }
                        else {
                                tstatstr = "SUSPENDED";
                        }
                }
                else if (TSTAT_WAITING(tstat)) {
                        tstatstr = "WAITING";
                }
                else {
                        tstatstr = "RUNNABLE";
                }
        }
        return((intptr_t) tstatstr);
}

/* 
 *  トレースログの表示
 */
static void
trace_print(TRACE *p_trace, void (*putc)(char))
{
        intptr_t        traceinfo[TNUM_LOGPAR + 1];
        const char      *tracemsg;
        int_t           i;

        traceinfo[0] = (intptr_t)(p_trace->logtim);
        syslog_printf("[%d] ", traceinfo, putc);

        switch (p_trace->logtype) {
        case LOG_TYPE_TSKSTAT:
                traceinfo[0] = get_tskid(p_trace->logpar[0]);
                traceinfo[1] = get_tskstat(p_trace->logpar[1]);
                tracemsg = "task %d becomes %s.";
                break;
        case LOG_TYPE_DSP|LOG_LEAVE:
                traceinfo[0] = get_tskid(p_trace->logpar[0]);
                tracemsg = "dispatch to task %d.";
                break;
        case LOG_TYPE_COMMENT:
                for (i = 1; i < TNUM_LOGPAR; i++) {
                        traceinfo[i-1] = p_trace->logpar[i];
                }
                tracemsg = (const char *)(p_trace->logpar[0]);
                break;
        case LOG_TYPE_ASSERT:
                traceinfo[0] = p_trace->logpar[0];
                traceinfo[1] = p_trace->logpar[1];
                traceinfo[2] = p_trace->logpar[2];
                tracemsg = "%s:%u: Assertion `%s' failed.";
                break;
        default:
                traceinfo[0] = p_trace->logtype;
                tracemsg = "unknown trace log type: %d.";
                break;
        }
        syslog_printf(tracemsg, traceinfo, putc);
        (*putc)('\n');
}

/*
 *  低レベル出力の呼出し関数
 */
static void
low_putchar(char c)
{
        cPutLog_putChar(c);
}

/* 
 *  トレースログのダンプ
 */
void
eTraceLog_dump(void)
{
        TRACE   trace;

        while (trace_rea_log(&trace) >= 0) {
                trace_print(&trace, low_putchar);
        }
}

/*
 *  トレースログのダンプ（受け口関数）
 */
void
tTraceLog_eDump_main(uintptr_t exinf)
{
        eTraceLog_dump();
}