//==========================================================================
//
//      buffer.cxx
//
//      Memory buffered trace and assert functions
//
//==========================================================================
//####COPYRIGHTBEGIN####
//
// -------------------------------------------
// The contents of this file are subject to the Cygnus eCos Public License
// Version 1.0 (the "License"); you may not use this file except in
// compliance with the License.  You may obtain a copy of the License at
// http://sourceware.cygnus.com/ecos
// 
// Software distributed under the License is distributed on an "AS IS"
// basis, WITHOUT WARRANTY OF ANY KIND, either express or implied.  See the
// License for the specific language governing rights and limitations under
// the License.
// 
// The Original Code is eCos - Embedded Cygnus Operating System, released
// September 30, 1998.
// 
// The Initial Developer of the Original Code is Cygnus.  Portions created
// by Cygnus are Copyright (C) 1998,1999 Cygnus Solutions.  All Rights Reserved.
// -------------------------------------------
//
//####COPYRIGHTEND####
//==========================================================================
//#####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;
    char                *function;
    char                *file;
    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

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

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
}

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

#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

#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;

        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)
        print_trace_buffer();
        cyg_infra_trace_buffer_pos = 0;
        cyg_infra_trace_buffer_wrap = false;
#else        
#error No trace buffer full mode set        
#endif
    }

}

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

externC void
cyg_tracenomsg( char *psz_func, 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, 
              char *psz_func, char *psz_file, cyg_uint32 linenum,
              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, 
               char *psz_func, char *psz_file, cyg_uint32 linenum,
               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, 
               char *psz_func, char *psz_file, cyg_uint32 linenum,
               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, 
               char *psz_func, char *psz_file, cyg_uint32 linenum,
               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, 
               char *psz_func, char *psz_file, cyg_uint32 linenum,
               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 )
{
    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
    
    for(;;);
    
//    DIAG_DEVICE_END_SYNC();
//    HAL_RESTORE_INTERRUPTS(old_ints);
};

extern "C"
{
extern unsigned long CYG_LABEL_NAME(stext);
extern unsigned long CYG_LABEL_NAME(etext);

unsigned long stext_addr = (unsigned long)&CYG_LABEL_NAME(stext);
unsigned long etext_addr = (unsigned long)&CYG_LABEL_NAME(etext);
};

externC cyg_bool cyg_check_data_ptr(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(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
