Subversion Repositories openrisc_me

//==========================================================================

//

//      buffer.cxx

//

//      Memory buffered trace and assert functions

//

//==========================================================================

//####ECOSGPLCOPYRIGHTBEGIN####

// -------------------------------------------

// This file is part of eCos, the Embedded Configurable Operating System.

// Copyright (C) 1998, 1999, 2000, 2001, 2002 Red Hat, Inc.

//

// eCos is free software; you can redistribute it and/or modify it under

// the terms of the GNU General Public License as published by the Free

// Software Foundation; either version 2 or (at your option) any later version.

//

// eCos is distributed in the hope that it will be useful, but WITHOUT ANY

// WARRANTY; without even the implied warranty of MERCHANTABILITY or

// FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License

// for more details.

//

// You should have received a copy of the GNU General Public License along

// with eCos; if not, write to the Free Software Foundation, Inc.,

// 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.

//

// As a special exception, if other files instantiate templates or use macros

// or inline functions from this file, or you compile this file and link it

// with other works to produce a work based on this file, this file does not

// by itself cause the resulting work to be covered by the GNU General Public

// License. However the source code for this file must still be made available

// in accordance with section (3) of the GNU General Public License.

//

// This exception does not invalidate any other reasons why a work based on

// this file might be covered by the GNU General Public License.

//

// Alternative licenses for eCos may be arranged by contacting Red Hat, Inc.

// at http://sources.redhat.com/ecos/ecos-license/

// -------------------------------------------

//####ECOSGPLCOPYRIGHTEND####

//==========================================================================

//#####DESCRIPTIONBEGIN####

//

// Author(s):   nickg

// Contributors:        nickg

// Date:        1998-10-16

// Purpose:     Buffered Trace and assert functions

// Description: The functions in this file are a buffered implementation

//              of the standard trace and assert functions. These store

//              trace messages in a memory buffer and emit them when an

//              assert is hit, or when requested to.

//

//####DESCRIPTIONEND####

//

//==========================================================================

#include <pkgconf/system.h>

#include <pkgconf/infra.h>

#ifdef CYGDBG_INFRA_DEBUG_TRACE_ASSERT_BUFFER

#include <cyg/infra/cyg_type.h>         // base types

#include <cyg/infra/cyg_trac.h>         // tracing macros

#include <cyg/infra/cyg_ass.h>          // assertion macros

#include <pkgconf/hal.h>                // HAL configury

#include <cyg/infra/diag.h>             // HAL polled output

#include <cyg/hal/hal_arch.h>           // architectural stuff for...

#include <cyg/hal/hal_intr.h>           // interrupt control

#ifdef CYGPKG_KERNEL

#include <pkgconf/kernel.h>             // kernel configury

#include <cyg/kernel/thread.hxx>        // thread id to print

#include <cyg/kernel/sched.hxx>         // ancillaries for above

#include <cyg/kernel/thread.inl>        // ancillaries for above

#endif

// -------------------------------------------------------------------------

// Local Configuration: hack me!

// these are generally:

//      if 0, feature is disabled

//      if 1, feature is enabled, printing is default width

//      if >1, field is padded up to that width if necessary

//              (not truncated ever)

#define CYG_FILENAME    20

#define CYG_THREADID    1

#define CYG_LINENUM     4

#define CYG_FUNCNAME    100

#define CYG_DIAG_PRINTF 1

#define CYG_FUNC_INDENT 2

#ifndef CYGPKG_KERNEL

# undef  CYG_THREADID

# define CYG_THREADID 0

#endif

#if CYG_FUNCNAME == 1

#define CYG_FBUF_SIZE   100

#else

#define CYG_FBUF_SIZE   (CYG_FUNCNAME+20)

#endif

// -------------------------------------------------------------------------

// Trace buffer

#ifdef CYGDBG_USE_TRACING

struct Cyg_TraceRecord

{

    cyg_uint32          what;

    cyg_uint32          tid;

    const char          *function;

    const char          *file;

    const char          *message;

    cyg_uint32          line;

    cyg_uint32          narg;

    CYG_ADDRWORD        arg[8];

};

Cyg_TraceRecord cyg_infra_trace_buffer[CYGDBG_INFRA_DEBUG_TRACE_BUFFER_SIZE];

static cyg_uint32 cyg_infra_trace_buffer_pos = 0;

static cyg_bool cyg_infra_trace_buffer_enable = true;

static cyg_bool cyg_infra_trace_buffer_wrap = false;

// -------------------------------------------------------------------------

// Functions to trim file names and function names down to printable lengths

// (these are shared between trace and assert functions)

#if 0

static char * tracepremsgs[] = {

    "  INFO:",

    "ENTER :",

    "ARGS  :",

    "RETURN:",

    "bad code"

};

#endif

static char * tracepremsgs[] = {

    "'",

    "{{",

    "((",

    "}}",

    "bad code"

};

static char * tracepostmsgs[] = {

    "'",

    "",

    "))",

    "",

    "bad code"

};

static void

write_whattrace( cyg_uint32 what )

{

#if CYG_FUNC_INDENT

    static cyg_int32 cyg_indent = 0;

    if ( 3 == what )

        cyg_indent -= CYG_FUNC_INDENT;

    cyg_int32 i = cyg_indent;

    for ( ; i > 0; i-- )

        diag_write_string( " " );

#endif // CYG_FUNC_INDENT

    diag_write_string( tracepremsgs[ what > 4 ? 4 : what ] );

#if CYG_FUNC_INDENT

    if ( 1 == what )

        cyg_indent += CYG_FUNC_INDENT;

#endif // CYG_FUNC_INDENT

}

static void

write_whattracepost( cyg_uint32 what )

{

    diag_write_string( tracepostmsgs[ what > 4 ? 4 : what ] );

}

#endif // CYGDBG_USE_TRACING

// -------------------------------------------------------------------------

#if defined(CYGDBG_USE_TRACING) || defined(CYGDBG_USE_ASSERTS)

static const char *trim_file(const char *file)

{

#if CYG_FILENAME

    if ( NULL == file )

        file = "<nofile>";

#if 1 == CYG_FILENAME

    const char *f = file;

    while( *f ) f++;

    while( *f != '/' && f != file ) f--;

    return f==file?f:(f+1);

#else

    static char fbuf2[100];

    const char *f = file;

    char *g = fbuf2;

    while( *f ) f++;

    while( *f != '/' && f != file ) f--;

    if ( f > file ) f++;

    while( *f ) *g++ = *f++;

    while( CYG_FILENAME > (g - fbuf2) ) *g++ = ' ';

    *g = 0;

    return fbuf2;

#endif

#else

    return "";

#endif

}

static const char *trim_func(const char *func)

{

#if CYG_FUNCNAME

    static char fbuf[CYG_FBUF_SIZE];

    cyg_count32 i;

    if ( NULL == func )

        func = "<nofunc>";

    for( i = 0; func[i] && func[i] != '(' && i < CYG_FBUF_SIZE-4 ; i++ )

        fbuf[i] = func[i];

    fbuf[i++] = '(';

    fbuf[i++] = ')';

    fbuf[i  ] = 0;

    i=0;

#if 1 == CYG_FUNCNAME

    return &fbuf[i];

#else

    char *p = &fbuf[i];

    while ( *p ) p++;

    while ( CYG_FUNCNAME > (p - (&fbuf[i])) ) *p++ = ' ';

    *p = 0;

    return &fbuf[i];

#endif

#else

    return "";

#endif

}

static void write_lnum( cyg_uint32 lnum)

{

#if CYG_LINENUM

    diag_write_char('[');

#if 1 < CYG_LINENUM

    cyg_uint32 i, j;

    for ( i = 2, j = 100; i < CYG_LINENUM ; i++, j *= 10 )

        if ( lnum < j )

            diag_write_char(' ');

#endif    

    diag_write_dec(lnum);

    diag_write_char(']');

    diag_write_char(' ');

#endif

}

#endif // defined(CYGDBG_USE_TRACING) || defined(CYGDBG_USE_ASSERTS)

// -------------------------------------------------------------------------

#if defined(CYGDBG_USE_TRACING) || defined(CYGDBG_USE_ASSERTS)

#if CYG_THREADID

static cyg_uint32 get_tid(void)

{

    Cyg_Thread *t = Cyg_Thread::self();

    cyg_uint16 tid = 0xFFFF;

    if( t != NULL ) tid = t->get_unique_id();

    return tid;

}

#else

# define get_tid() (0xFFFF)

#endif

#endif // defined(CYGDBG_USE_TRACING) || defined(CYGDBG_USE_ASSERTS)

#ifdef CYGDBG_USE_ASSERTS

static void write_thread_id()

{

#if CYG_THREADID    

    cyg_uint16 tid = get_tid();

    diag_write_char('<');

    diag_write_hex(tid);

    diag_write_char('>');

#endif

}

#endif

// -------------------------------------------------------------------------

// Trace functions:

#ifdef CYGDBG_USE_TRACING

static void print_trace_buffer(void)

{

    cyg_count32 start = cyg_infra_trace_buffer_pos;

    cyg_count32 end = start;

    cyg_count32 i;

    // If the buffer has wrapped we want to display the records from

    // the current pos and around back to the same place. If the buffer

    // has not wrapped, we want to display from the start to pos.

    if( !cyg_infra_trace_buffer_wrap )

        start = 0;

    i = start;

    do

    {

        Cyg_TraceRecord *rec = &cyg_infra_trace_buffer[i];

        cyg_uint32 old_ints;

        const char *psz_msg = rec->message;

        HAL_DISABLE_INTERRUPTS(old_ints);

        DIAG_DEVICE_START_SYNC();

        if ( NULL == psz_msg )

            psz_msg = "<nomsg>";

        diag_write_string( "TRACE: " );

#if CYG_THREADID

        diag_write_char('<');

        diag_write_hex(rec->tid);

        diag_write_char('>');

#endif        

        diag_write_string(trim_file(rec->file));

        write_lnum(rec->line);

        diag_write_string(trim_func(rec->function));

        diag_write_char(' ');

        write_whattrace( rec->what );

#if CYG_DIAG_PRINTF

        diag_printf( psz_msg,

                     rec->arg[0], rec->arg[1],

                     rec->arg[2], rec->arg[3],

                     rec->arg[4], rec->arg[5],

                     rec->arg[6], rec->arg[7] );

#else

        diag_write_string(psz_msg);

        diag_write_char(' ');

        for( cyg_count8 j = 0; j < rec->narg ; j++ )

        {

            diag_write_hex(rec->arg[j]);

            diag_write_char(' ');

        }

#endif    

        write_whattracepost( rec->what );

        diag_write_char('\n');

        DIAG_DEVICE_END_SYNC();

        HAL_RESTORE_INTERRUPTS(old_ints);

        i++;

        if( i == CYGDBG_INFRA_DEBUG_TRACE_BUFFER_SIZE )

            i = 0;

    } while( i != end );

}

static void increment_buffer_pos()

{

    cyg_infra_trace_buffer_pos++;

    if( cyg_infra_trace_buffer_pos == CYGDBG_INFRA_DEBUG_TRACE_BUFFER_SIZE )

    {

#if defined(CYGDBG_INFRA_DEBUG_TRACE_BUFFER_WRAP)

        cyg_infra_trace_buffer_pos = 0;

        cyg_infra_trace_buffer_wrap = true;

#elif defined(CYGDBG_INFRA_DEBUG_TRACE_BUFFER_HALT)

        cyg_infra_trace_buffer_enable = false;

#elif defined(CYGDBG_INFRA_DEBUG_TRACE_BUFFER_PRINT)

        cyg_infra_trace_buffer_pos = 0;

        print_trace_buffer();

#else

#error No trace buffer full mode set

#endif

    }

}

// -------------------------------------------------------------------------

externC void

cyg_tracenomsg( const char *psz_func, const char *psz_file, cyg_uint32 linenum )

{

    cyg_uint32 old_ints;

    if( !cyg_infra_trace_buffer_enable ) return;

    HAL_DISABLE_INTERRUPTS(old_ints);

    Cyg_TraceRecord *rec = &cyg_infra_trace_buffer[cyg_infra_trace_buffer_pos];

    rec->what           = 0;

    rec->tid            = get_tid();

    rec->function       = psz_func;

    rec->file           = psz_file;

    rec->line           = linenum;

    rec->message        = 0;

    rec->narg           = 0;

    increment_buffer_pos();

    HAL_RESTORE_INTERRUPTS(old_ints);

};

// provide every other one of these as a space/caller bloat compromise.

externC void

cyg_tracemsg( cyg_uint32 what,

              const char *psz_func, const char *psz_file, cyg_uint32 linenum,

              const char *psz_msg )

{

    cyg_uint32 old_ints;

    if( !cyg_infra_trace_buffer_enable ) return;

    HAL_DISABLE_INTERRUPTS(old_ints);

    Cyg_TraceRecord *rec = &cyg_infra_trace_buffer[cyg_infra_trace_buffer_pos];

    rec->what           = what;

    rec->tid            = get_tid();

    rec->function       = psz_func;

    rec->file           = psz_file;

    rec->line           = linenum;

    rec->message        = psz_msg;

    rec->narg           = 0;

    increment_buffer_pos();

    HAL_RESTORE_INTERRUPTS(old_ints);

};

externC void

cyg_tracemsg2( cyg_uint32 what,

               const char *psz_func, const char *psz_file, cyg_uint32 linenum,

               const char *psz_msg,

               CYG_ADDRWORD arg0,  CYG_ADDRWORD arg1 )

{

    cyg_uint32 old_ints;

    if( !cyg_infra_trace_buffer_enable ) return;

    HAL_DISABLE_INTERRUPTS(old_ints);

    Cyg_TraceRecord *rec = &cyg_infra_trace_buffer[cyg_infra_trace_buffer_pos];

    rec->what           = what;

    rec->tid            = get_tid();

    rec->function       = psz_func;

    rec->file           = psz_file;

    rec->line           = linenum;

    rec->message        = psz_msg;

    rec->narg           = 2;

    rec->arg[0]         = arg0;

    rec->arg[1]         = arg1;

    increment_buffer_pos();

    HAL_RESTORE_INTERRUPTS(old_ints);

};

externC void

cyg_tracemsg4( cyg_uint32 what,

               const char *psz_func, const char *psz_file, cyg_uint32 linenum,

               const char *psz_msg,

               CYG_ADDRWORD arg0,  CYG_ADDRWORD arg1,

               CYG_ADDRWORD arg2,  CYG_ADDRWORD arg3 )

{

    cyg_uint32 old_ints;

    if( !cyg_infra_trace_buffer_enable ) return;

    HAL_DISABLE_INTERRUPTS(old_ints);

    Cyg_TraceRecord *rec = &cyg_infra_trace_buffer[cyg_infra_trace_buffer_pos];

    rec->what           = what;

    rec->tid            = get_tid();

    rec->function       = psz_func;

    rec->file           = psz_file;

    rec->line           = linenum;

    rec->message        = psz_msg;

    rec->narg           = 4;

    rec->arg[0]         = arg0;

    rec->arg[1]         = arg1;

    rec->arg[2]         = arg2;

    rec->arg[3]         = arg3;

    increment_buffer_pos();

    HAL_RESTORE_INTERRUPTS(old_ints);

};

externC void

cyg_tracemsg6( cyg_uint32 what,

               const char *psz_func, const char *psz_file, cyg_uint32 linenum,

               const char *psz_msg,

               CYG_ADDRWORD arg0,  CYG_ADDRWORD arg1,

               CYG_ADDRWORD arg2,  CYG_ADDRWORD arg3,

               CYG_ADDRWORD arg4,  CYG_ADDRWORD arg5 )

{

    cyg_uint32 old_ints;

    if( !cyg_infra_trace_buffer_enable ) return;

    HAL_DISABLE_INTERRUPTS(old_ints);

    Cyg_TraceRecord *rec = &cyg_infra_trace_buffer[cyg_infra_trace_buffer_pos];

    rec->what           = what;

    rec->tid            = get_tid();

    rec->function       = psz_func;

    rec->file           = psz_file;

    rec->line           = linenum;

    rec->message        = psz_msg;

    rec->narg           = 6;

    rec->arg[0]         = arg0;

    rec->arg[1]         = arg1;

    rec->arg[2]         = arg2;

    rec->arg[3]         = arg3;

    rec->arg[4]         = arg4;

    rec->arg[5]         = arg5;

    increment_buffer_pos();

    HAL_RESTORE_INTERRUPTS(old_ints);

};

externC void

cyg_tracemsg8( cyg_uint32 what,

               const char *psz_func, const char *psz_file, cyg_uint32 linenum,

               const char *psz_msg,

               CYG_ADDRWORD arg0,  CYG_ADDRWORD arg1,

               CYG_ADDRWORD arg2,  CYG_ADDRWORD arg3,

               CYG_ADDRWORD arg4,  CYG_ADDRWORD arg5,

               CYG_ADDRWORD arg6,  CYG_ADDRWORD arg7 )

{

    cyg_uint32 old_ints;

    if( !cyg_infra_trace_buffer_enable ) return;

    HAL_DISABLE_INTERRUPTS(old_ints);

    Cyg_TraceRecord *rec = &cyg_infra_trace_buffer[cyg_infra_trace_buffer_pos];

    rec->what           = what;

    rec->tid            = get_tid();

    rec->function       = psz_func;

    rec->file           = psz_file;

    rec->line           = linenum;

    rec->message        = psz_msg;

    rec->narg           = 6;

    rec->arg[0]         = arg0;

    rec->arg[1]         = arg1;

    rec->arg[2]         = arg2;

    rec->arg[3]         = arg3;

    rec->arg[4]         = arg4;

    rec->arg[5]         = arg5;

    rec->arg[6]         = arg6;

    rec->arg[7]         = arg7;

    increment_buffer_pos();

    HAL_RESTORE_INTERRUPTS(old_ints);

};

// -------------------------------------------------------------------------

externC void

cyg_trace_print(void)

{

    cyg_bool old_enable = cyg_infra_trace_buffer_enable;

    cyg_infra_trace_buffer_enable = false;

    print_trace_buffer();

    cyg_infra_trace_buffer_pos = 0;

    cyg_infra_trace_buffer_wrap = false;

    cyg_infra_trace_buffer_enable = old_enable;

}

// -------------------------------------------------------------------------

externC void

cyg_trace_dump(void)

{

#if defined(CYGPKG_KERNEL) && defined(CYG_DIAG_PRINTF)

    {

        diag_printf("\nScheduler:\n\n");

        Cyg_Scheduler *sched = &Cyg_Scheduler::scheduler;

        diag_printf("Lock:                %d\n",sched->get_sched_lock() );

# ifdef CYGVAR_KERNEL_THREADS_NAME

        diag_printf("Current Thread:      %s\n",sched->get_current_thread()->get_name());

# else

        diag_printf("Current Thread:    %d\n",sched->get_current_thread()->get_unique_id());

# endif

    }

# ifdef CYGVAR_KERNEL_THREADS_LIST

    {

        Cyg_Thread *t = Cyg_Thread::get_list_head();

        diag_printf("\nThreads:\n\n");

        while( NULL != t )

        {

            cyg_uint32 state = t->get_state();

            char tstate[7];

            char *tstate1 = "SCUKX";

            static char *(reasons[8]) =

            {

                "NONE",                           // No recorded reason

                "WAIT",                           // Wait with no timeout

                "DELAY",                          // Simple time delay

                "TIMEOUT",                        // Wait with timeout/timeout expired

                "BREAK",                          // forced break out of sleep

                "DESTRUCT",                       // wait object destroyed[note]

                "EXIT",                           // forced termination

                "DONE"                            // Wait/delay complete

            };

            if( 0 != state )

            {

                // Knock out chars that do not correspond to set bits.

                for( int i = 0; i < 6 ; i++ )

                    if( 0 == (state & (1<<i)) )

                        tstate[i] = ' ';

                    else tstate[i] = tstate1[i];

                tstate[6] = 0;

            }

            else tstate[0] = 'R', tstate[1] = 0;

#   ifdef CYGVAR_KERNEL_THREADS_NAME

            diag_printf( "%20s pri = %3d state = %6s id = %3d\n",

                         t->get_name(),

                         t->get_priority(),

                         tstate,

                         t->get_unique_id()

                );

#   else

            diag_printf( "Thread %3d        pri = %3d state = %6s\n",

                         t->get_unique_id(),

                         t->get_priority(),

                         tstate

                );

#   endif        

            diag_printf( "%20s stack base = %08x ptr = %08x size = %08x\n",

                         "",

                         t->get_stack_base(),

#ifdef CYGDBG_KERNEL_DEBUG_GDB_THREAD_SUPPORT

                         t->get_saved_context(),

#else

                         0,

#endif

                         t->get_stack_size()

                );

            diag_printf( "%20s sleep reason %8s wake reason %8s\n",

                         "",

                         reasons[t->get_sleep_reason()],

                         reasons[t->get_wake_reason()]