Subversion Repositories openrisc_2011-10-31

/*

 *  This routine starts the application.  It includes application,

 *  board, and monitor specific initialization and configuration.

 *  The generic CPU dependent initialization has been performed

 *  before this routine is invoked.

 *

 *  COPYRIGHT (c) 1989-1999.

 *  On-Line Applications Research Corporation (OAR).

 *

 *  The license and distribution terms for this file may be

 *  found in the file LICENSE in this distribution or at

 *  http://www.OARcorp.com/rtems/license.html.

 *

 *  Modifications of respective RTEMS file: COPYRIGHT (c) 1994.

 *  EISCAT Scientific Association. M.Savitski

 *

 *  This material is a part of the MVME162 Board Support Package

 *  for the RTEMS executive. Its licensing policies are those of the

 *  RTEMS above.

 *

 *  $Id: bspstart.c,v 1.2 2001-09-27 12:00:18 chris Exp $

 */

#include <bsp.h>

#include <rtems/libio.h>

#include <page_table.h>

#include <libcsupport.h>

#include <string.h>

/*

 *  The original table from the application and our copy of it with

 *  some changes.

 */

extern rtems_configuration_table  Configuration;

rtems_configuration_table  BSP_Configuration;

rtems_cpu_table Cpu_table;

char *rtems_progname;

/*

 *  Use the shared implementations of the following routines

 */

void bsp_postdriver_hook(void);

void bsp_libc_init( void *, unsigned32, int );

void bsp_pretasking_hook(void);               /* m68k version */

/*

 *  bsp_start

 *

 *  This routine does the bulk of the system initialization.

 */

void bsp_start( void )

{

  m68k_isr_entry       *monitors_vector_table;

  int                   index;

  extern void          *_WorkspaceBase;

  extern void          *_RamSize;

  extern unsigned long  _M68k_Ramsize;

  _M68k_Ramsize = (unsigned long)&_RamSize;             /* RAM size set in linker script */

  /*

   *  162Bug Vectors are at 0xFFE00000

   *  162Bug Vectors on LX are at 0x00000000

   */

#if defined(mvme162lx)

  monitors_vector_table = (m68k_isr_entry *)0x00000000;

#else

  monitors_vector_table = (m68k_isr_entry *)0xFFE00000;

#endif

  m68k_set_vbr( monitors_vector_table );

  for ( index=2 ; index<=255 ; index++ )

    M68Kvec[ index ] = monitors_vector_table[ 32 ];

  M68Kvec[  2 ] = monitors_vector_table[  2 ];   /* bus error vector */

  M68Kvec[  4 ] = monitors_vector_table[  4 ];   /* breakpoints vector */

  M68Kvec[  9 ] = monitors_vector_table[  9 ];   /* trace vector */

  M68Kvec[ 47 ] = monitors_vector_table[ 47 ];   /* system call vector */

  m68k_set_vbr( &M68Kvec );

  /*

   *  You may wish to make the VME arbitration round-robin here, currently

   *  we leave it as it is.

   */

  /* set the Interrupt Base Vectors */

  lcsr->vector_base = (VBR0 << 28) | (VBR1 << 24);

  page_table_init();

  /*

   *  we only use a hook to get the C library initialized.

   */

  Cpu_table.pretasking_hook = bsp_pretasking_hook;  /* init libc, etc. */

  Cpu_table.postdriver_hook = bsp_postdriver_hook;

  Cpu_table.interrupt_vector_table = (m68k_isr_entry *) &M68Kvec;

  Cpu_table.interrupt_stack_size = CONFIGURE_INTERRUPT_STACK_MEMORY;

  BSP_Configuration.work_space_start = (void *) &_WorkspaceBase;

}