URL
https://opencores.org/ocsvn/or1k/or1k/trunk
Subversion Repositories or1k
[/] [or1k/] [trunk/] [ecos-2.0/] [packages/] [infra/] [v2_0/] [src/] [buffer.cxx] - Rev 1765
Compare with Previous | Blame | View Log
//========================================================================== // // 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()] ); diag_printf( "%20s queue = %08x wait info = %08x\n", "", t->get_current_queue(), t->get_wait_info() ); diag_printf("\n"); t = t->get_list_next(); } } # endif // CYGVAR_KERNEL_THREADS_LIST #endif // CYG_DIAG_PRINTF } #endif // CYGDBG_USE_TRACING // ------------------------------------------------------------------------- // Assert functions: #ifdef CYGDBG_USE_ASSERTS externC void cyg_assert_fail( const char *psz_func, const char *psz_file, cyg_uint32 linenum, const char *psz_msg ) __THROW { cyg_uint32 old_ints; HAL_DISABLE_INTERRUPTS(old_ints); DIAG_DEVICE_START_SYNC(); diag_write_string("ASSERT FAIL: "); write_thread_id(); diag_write_string(trim_file(psz_file)); write_lnum(linenum); diag_write_string(trim_func(psz_func)); diag_write_char(' '); diag_write_string(psz_msg); diag_write_char('\n'); #ifdef CYGDBG_INFRA_DEBUG_TRACE_BUFFER_PRINT_ON_ASSERT cyg_trace_print(); cyg_trace_dump(); #endif #ifdef CYGHWR_TEST_PROGRAM_EXIT CYGHWR_TEST_PROGRAM_EXIT(); #endif for(;;); // DIAG_DEVICE_END_SYNC(); // HAL_RESTORE_INTERRUPTS(old_ints); }; extern "C" { extern unsigned long _stext; extern unsigned long _etext; unsigned long stext_addr = (unsigned long)&_stext; unsigned long etext_addr = (unsigned long)&_etext; }; externC cyg_bool cyg_check_data_ptr(const void *ptr) { unsigned long p = (unsigned long)ptr; if( p == 0 ) return false; if( p > stext_addr && p < etext_addr ) return false; return true; } externC cyg_bool cyg_check_func_ptr(const void (*ptr)(void)) { unsigned long p = (unsigned long)ptr; if( p == 0 ) return false; if( p < stext_addr && p > etext_addr ) return false; return true; } #endif // CYGDBG_USE_ASSERTS #endif // CYGDBG_INFRA_DEBUG_TRACE_ASSERT_BUFFER // ------------------------------------------------------------------------- // EOF buffer.cxx