Subversion Repositories openrisc_me

//==========================================================================
//####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####
//==========================================================================
 
#include <pkgconf/hal.h>
#include <cyg/hal/hal_startup.h>
#include <cyg/hal/hal_memmap.h>
#include <cyg/hal/hal_intr.h>
#include <cyg/hal/hal_diag.h>           // hal_diag_init
#include <cyg/infra/diag.h>             // diag_printf
#include <string.h>                     // memcpy, memset
 
externC void cyg_start(void);
externC void hw_vsr_reset(void);
 
#define CYG_HAL_RESET_DEBUG_ENABLE
#ifdef CYG_HAL_RESET_DEBUG_ENABLE
#define CYG_HAL_RESET_DEBUG diag_printf
#else
#define CYG_HAL_RESET_DEBUG()
#endif // CYG_HAL_RESET_DEBUG_ENABLE
 
/*****************************************************************************
hal_vsr_init -- Initialize the vector table
 
INPUT:
 
OUTPUT:
 
RETURN VALUE:
 
     None
 
*****************************************************************************/
static void hal_vsr_init(void)
{
 
    /*   Initialize the HAL's vector table with the ROM vector table.       */
 
    memcpy((void*)cyg_hal_vsr_table, __romvec_start,
                (size_t)sizeof(cyg_hal_vsr_table));
 
}
 
/*****************************************************************************
hal_vsr_init -- Initialize the ISRs
 
INPUT:
 
OUTPUT:
 
RETURN VALUE:
 
     None
 
*****************************************************************************/
static void hal_isr_init(void)
{
    int_t i;
 
    //   Initialize all ISR entries to default.
 
    for (i = 0; i < CYGNUM_HAL_ISR_COUNT; i++)
    {
        cyg_hal_interrupt_handlers[i] = (CYG_ADDRESS) &hal_default_isr;
        cyg_hal_interrupt_data[i] = (CYG_ADDRWORD)0;
        cyg_hal_interrupt_objects[i] = (CYG_ADDRESS)0;
    }
}
 
/*****************************************************************************
hal_init_ram_sections -- Initialize the RAM sections
 
     Initialize all RAM sections that  the C  code relies  on.  data,  bss,
sbss.
 
INPUT:
 
OUTPUT:
 
RETURN VALUE:
 
     None
 
*****************************************************************************/
static void hal_init_ram_sections(void)
{
 
    //   Initialize the RAM data section  from  the  ROM  image  of  the  data
    // section.
 
    memcpy(__ram_data_start, __rom_data_start, (size_t)__ram_data_size);
 
    //   Initialize the bss and sbss sections to zero.
 
    memset(__bss_start, 0, (size_t)__bss_size);
    memset(__sbss_start, 0, (size_t)__sbss_size);
}
 
/*****************************************************************************
cyg_hal_invoke_constructors -- Call static constructors
 
INPUT:
 
OUTPUT:
 
RETURN VALUE:
 
     None
 
*****************************************************************************/
#ifdef CYGSEM_HAL_STOP_CONSTRUCTORS_ON_FLAG
cyg_bool cyg_hal_stop_constructors;
#endif
 
typedef void (*pfunc) (void);
extern pfunc __CTOR_LIST__[];
extern pfunc __CTOR_END__[];
 
static void cyg_hal_invoke_constructors(void)
{
#ifdef CYGSEM_HAL_STOP_CONSTRUCTORS_ON_FLAG
    static pfunc *p = &__CTOR_END__[-1];
 
    cyg_hal_stop_constructors = 0;
    for (; p >= __CTOR_LIST__; p--) {
        (*p) ();
        if (cyg_hal_stop_constructors) {
            p--;
            break;
        }
    }
#else
    pfunc *p;
 
    for (p = &__CTOR_END__[-1]; p >= __CTOR_LIST__; p--)
        (*p) ();
#endif
}
 
/*****************************************************************************
hal_reset -- Reset vector routine
 
     This routine must be  called with interrupts  disabled and will  never
return.
 
     Only the assembly reset vector routine should call this routine.
 
INPUT:
 
OUTPUT:
 
RETURN VALUE:
 
     None
 
*****************************************************************************/
void hal_reset(void) CYGBLD_ATTRIB_NORET;
void hal_reset(void)
{
    const char * fname;
 
    fname = __FUNCTION__;
 
    //   Initialize the RAM sections that the rest of the C code requires.
 
    hal_init_ram_sections();
 
    //   It is now safe  to call  C functions  which may  rely on  initialized
    // data.
 
    //   Initialize the ISR and VSR tables.
 
    hal_isr_init();
    hal_vsr_init();
 
    //   Do any variant-specific reset initialization.
 
    var_reset();
 
    //   Initialize the diagnostics IO.
 
    HAL_DIAG_INIT();
    CYG_HAL_RESET_DEBUG("%s: RESET\r\n", fname);
 
    //   Call C++ constructors.
 
    CYG_HAL_RESET_DEBUG("%s: calling cyg_hal_invoke_constructors\r\n", fname);
    cyg_hal_invoke_constructors();
 
    //   It should be safe to enable interrupts now.
 
    CYG_HAL_RESET_DEBUG("%s: lowering interrupt mask\r\n", fname);
    HAL_ENABLE_INTERRUPTS();
 
    //   Call cyg_start.  This routine should not return.
 
    CYG_HAL_RESET_DEBUG("%s: calling cyg_start\r\n", fname);
    cyg_start();
 
    //   If we return, loop and print out a message.
 
    HAL_DIAG_INIT();
    for (;;)
    {
        CYG_HAL_RESET_DEBUG("%s: cyg_start returned!\r\n", fname);
    }
}
 
/*****************************************************************************
hal_hw_reset -- Simulate a hardware reset
 
     This routine will never return.
 
INPUT:
 
OUTPUT:
 
RETURN VALUE:
 
     None
 
*****************************************************************************/
void hal_hw_reset(void)
{
 
    //   Give control to the reset vector handler.
 
    hw_vsr_reset();
}