forked from Imagelibrary/rtems
132 lines
3.7 KiB
C
132 lines
3.7 KiB
C
/* SPDX-License-Identifier: BSD-2-Clause */
|
|
|
|
/*
|
|
* 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-2008.
|
|
* On-Line Applications Research Corporation (OAR).
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
|
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
|
|
* LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
|
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
|
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
|
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
|
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
|
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
|
* POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
|
|
#include <string.h>
|
|
#include <fcntl.h>
|
|
|
|
#include <rtems/counter.h>
|
|
|
|
#include <libcpu/bat.h>
|
|
#include <libcpu/spr.h>
|
|
#include <libcpu/powerpc-utility.h>
|
|
|
|
#include <bsp.h>
|
|
#include <bsp/irq.h>
|
|
#include <bsp/vectors.h>
|
|
#include <bsp/bootcard.h>
|
|
#include <bsp/irq-generic.h>
|
|
|
|
/*
|
|
* CPU Bus Frequency
|
|
*/
|
|
unsigned int BSP_bus_frequency;
|
|
|
|
/* Configuration parameter for clock driver */
|
|
uint32_t bsp_time_base_frequency;
|
|
|
|
/* Legacy */
|
|
uint32_t bsp_clicks_per_usec;
|
|
|
|
/*
|
|
* Memory on this board.
|
|
*/
|
|
extern char RamSize[];
|
|
uint32_t BSP_mem_size = (uint32_t)RamSize;
|
|
|
|
/* Default decrementer exception handler */
|
|
static int default_decrementer_exception_handler( BSP_Exception_frame *frame, unsigned number)
|
|
{
|
|
ppc_set_decrementer_register(UINT32_MAX);
|
|
|
|
return 0;
|
|
}
|
|
|
|
uint32_t _CPU_Counter_frequency(void)
|
|
{
|
|
return bsp_time_base_frequency;
|
|
}
|
|
|
|
/*
|
|
* bsp_start
|
|
*
|
|
* This routine does the bulk of the system initialization.
|
|
*/
|
|
|
|
void bsp_start( void )
|
|
{
|
|
rtems_status_code sc = RTEMS_SUCCESSFUL;
|
|
|
|
/*
|
|
* Note we can not get CPU identification dynamically, so
|
|
* force current_ppc_cpu.
|
|
*/
|
|
current_ppc_cpu = PPC_PSIM;
|
|
|
|
/*
|
|
* initialize the device driver parameters
|
|
* assume we are running with 20MHz bus
|
|
* this should speed up some tests :-)
|
|
*/
|
|
BSP_bus_frequency = 20;
|
|
bsp_time_base_frequency = 20000000;
|
|
bsp_clicks_per_usec = BSP_bus_frequency;
|
|
|
|
BSP_mem_size = (uint32_t )RamSize;
|
|
|
|
ppc_exc_initialize();
|
|
|
|
/* Install default handler for the decrementer exception */
|
|
sc = ppc_exc_set_handler( ASM_DEC_VECTOR, default_decrementer_exception_handler);
|
|
if (sc != RTEMS_SUCCESSFUL) {
|
|
rtems_panic("cannot install decrementer exception handler");
|
|
}
|
|
|
|
/* Initalize interrupt support */
|
|
bsp_interrupt_initialize();
|
|
|
|
#if 0
|
|
/*
|
|
* Setup BATs and enable MMU
|
|
*/
|
|
/* Memory */
|
|
setdbat(0, 0x0<<24, 0x0<<24, 2<<24, _PAGE_RW);
|
|
setibat(0, 0x0<<24, 0x0<<24, 2<<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");
|
|
#endif
|
|
}
|