forked from Imagelibrary/rtems
f6821c3efb
* bsp_specs, include/bsp.h, startup/bspstart.c: Eliminate copies of the Configuration Table. Use the RTEMS provided accessor macros to obtain configuration fields.
202 lines
4.8 KiB
C
202 lines
4.8 KiB
C
/*
|
|
* This set of routines starts the application. It includes application,
|
|
* board, and monitor specific initialization and configuration.
|
|
* The generic CPU dependent initialization has been performed
|
|
* before any of these are invoked.
|
|
*
|
|
* COPYRIGHT (c) 1989-2007.
|
|
* 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.rtems.com/license/LICENSE.
|
|
*
|
|
* $Id$
|
|
*/
|
|
|
|
#include <string.h>
|
|
#include <fcntl.h>
|
|
#include <bsp.h>
|
|
#include <bsp/irq.h>
|
|
#include <rtems/libio.h>
|
|
#include <rtems/libcsupport.h>
|
|
#include <rtems/bspIo.h>
|
|
#include <rtems/powerpc/powerpc.h>
|
|
|
|
#include <libcpu/cpuIdent.h>
|
|
#include <libcpu/bat.h>
|
|
#include <libcpu/spr.h>
|
|
|
|
SPR_RW(SPRG0)
|
|
SPR_RW(SPRG1)
|
|
|
|
extern unsigned long __rtems_end[];
|
|
|
|
void initialize_exceptions(void);
|
|
|
|
/* On psim, each click of the decrementer register corresponds
|
|
* to 1 instruction. By setting this to 100, we are indicating
|
|
* that we are assuming it can execute 100 instructions per
|
|
* microsecond. This corresponds to sustaining 1 instruction
|
|
* per cycle at 100 Mhz. Whether this is a good guess or not
|
|
* is anyone's guess.
|
|
*/
|
|
|
|
extern int PSIM_INSTRUCTIONS_PER_MICROSECOND;
|
|
|
|
/*
|
|
* PCI Bus Frequency
|
|
*/
|
|
unsigned int BSP_bus_frequency;
|
|
|
|
/*
|
|
* Time base divisior (how many tick for 1 second).
|
|
*/
|
|
unsigned int BSP_time_base_divisor;
|
|
|
|
/*
|
|
* Use the shared implementations of the following routines
|
|
*/
|
|
|
|
void bsp_postdriver_hook(void);
|
|
void bsp_libc_init( void *, uint32_t, int );
|
|
|
|
/*
|
|
* system init stack
|
|
*/
|
|
#define INIT_STACK_SIZE 0x1000
|
|
|
|
void BSP_panic(char *s)
|
|
{
|
|
printk("%s PANIC %s\n",_RTEMS_version, s);
|
|
__asm__ __volatile ("sc");
|
|
}
|
|
|
|
void _BSP_Fatal_error(unsigned int v)
|
|
{
|
|
printk("%s PANIC ERROR %x\n",_RTEMS_version, v);
|
|
__asm__ __volatile ("sc");
|
|
}
|
|
|
|
/*
|
|
* bsp_pretasking_hook
|
|
*
|
|
* BSP pretasking hook. Called just before drivers are initialized.
|
|
* Used to setup libc and install any BSP extensions.
|
|
*/
|
|
|
|
void bsp_pretasking_hook(void)
|
|
{
|
|
extern int end;
|
|
uint32_t heap_start;
|
|
uint32_t heap_size;
|
|
|
|
heap_start = (uint32_t) &end;
|
|
if (heap_start & (CPU_ALIGNMENT-1))
|
|
heap_start = (heap_start + CPU_ALIGNMENT) & ~(CPU_ALIGNMENT-1);
|
|
|
|
heap_size = Configuration.work_space_start - (void *)&end;
|
|
heap_size &= 0xfffffff0; /* keep it as a multiple of 16 bytes */
|
|
|
|
bsp_libc_init((void *) heap_start, heap_size, 0);
|
|
|
|
#ifdef RTEMS_DEBUG
|
|
rtems_debug_enable( RTEMS_DEBUG_ALL_MASK );
|
|
#endif
|
|
}
|
|
|
|
/*
|
|
* bsp_start
|
|
*
|
|
* This routine does the bulk of the system initialization.
|
|
*/
|
|
|
|
void bsp_start( void )
|
|
{
|
|
unsigned char *work_space_start;
|
|
register uint32_t intrStack;
|
|
register uint32_t *intrStackPtr;
|
|
|
|
/*
|
|
* Note we can not get CPU identification dynamically, so
|
|
* force current_ppc_cpu.
|
|
*/
|
|
current_ppc_cpu = PPC_PSIM;
|
|
|
|
/*
|
|
* initialize the device driver parameters
|
|
*/
|
|
BSP_bus_frequency = (unsigned int)&PSIM_INSTRUCTIONS_PER_MICROSECOND;
|
|
BSP_time_base_divisor = 1;
|
|
|
|
/*
|
|
* The simulator likes the exception table to be at 0xfff00000.
|
|
*/
|
|
|
|
bsp_exceptions_in_RAM = FALSE;
|
|
|
|
rtems_configuration_get_work_space_size() += 1024;
|
|
|
|
work_space_start =
|
|
(unsigned char *)&RAM_END - rtems_configuration_get_work_space_size();
|
|
|
|
if ( work_space_start <= (unsigned char *)&end ) {
|
|
printk( "bspstart: Not enough RAM!!!\n" );
|
|
bsp_cleanup();
|
|
}
|
|
|
|
Configuration.work_space_start = work_space_start;
|
|
#if (BSP_DIRTY_MEMORY == 1)
|
|
{
|
|
memset(&end, 0xCF, (unsigned char *)&RAM_END - (unsigned char *)&end );
|
|
}
|
|
#endif
|
|
|
|
/*
|
|
* Initialize the interrupt related settings
|
|
* SPRG1 = software managed IRQ stack
|
|
*
|
|
* This could be done latter (e.g in IRQ_INIT) but it helps to understand
|
|
* some settings below...
|
|
*/
|
|
intrStack = ((uint32_t) __rtems_end) + INIT_STACK_SIZE +
|
|
rtems_configuration_get_interrupt_stack_size() -
|
|
PPC_MINIMUM_STACK_FRAME_SIZE;
|
|
|
|
/* make sure it's properly aligned */
|
|
intrStack &= ~(CPU_STACK_ALIGNMENT-1);
|
|
|
|
/* tag the bottom (T. Straumann 6/36/2001 <strauman@slac.stanford.edu>) */
|
|
intrStackPtr = (uint32_t*) intrStack;
|
|
*intrStackPtr = 0;
|
|
|
|
_write_SPRG1(intrStack);
|
|
|
|
/* signal them that we have fixed PR288 - eventually, this should go away */
|
|
_write_SPRG0(PPC_BSP_HAS_FIXED_PR288);
|
|
|
|
/*
|
|
* Initialize default raw exception handlers. See vectors/vectors_init.c
|
|
*/
|
|
initialize_exceptions();
|
|
|
|
/*
|
|
* Initalize RTEMS IRQ system
|
|
*/
|
|
BSP_rtems_irq_mng_init(0);
|
|
|
|
/*
|
|
* Setup BATs and enable MMU
|
|
*/
|
|
/* Memory */
|
|
setdbat(0, 0x0<<24, 0x0<<24, 1<<24, _PAGE_RW);
|
|
setibat(0, 0x0<<24, 0x0<<24, 1<<24, 0);
|
|
/* PCI */
|
|
setdbat(1, 0x8<<24, 0x8<<24, 1<<24, IO_PAGE);
|
|
setdbat(2, 0xc<<24, 0xc<<24, 1<<24, IO_PAGE);
|
|
|
|
_write_MSR(_read_MSR() | MSR_DR | MSR_IR);
|
|
asm volatile("sync; isync");
|
|
|
|
}
|