Files
rtems/c/src/lib/libbsp/arm/csb336/startup/bspstart.c
Joel Sherrill 861e756a76 2007-03-12 Joel Sherrill <joel@OARcorp.com>
* include/bsp.h, network/lan91c11x.c, network/lan91c11x.h,
	network/network.c, start/start.S, startup/bspstart.c, startup/exit.c,
	startup/linkcmds, startup/memmap.c: Correct license URL and/or fix
	mistake in copyright notice. Both of these mistakes appear to be from
	code submitted after these changes were made previously.
2007-03-12 11:22:32 +00:00

252 lines
8.0 KiB
C

/*
* Cogent CSB336 - MC9328MXL SBC startup code
*
* Copyright (c) 2004 by Cogent Computer Systems
* Written by Jay Monkman <jtm@lopingdog.com>
*
* 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 <bsp.h>
#include <rtems/libcsupport.h>
#include <rtems/bspIo.h>
#include <rtems/libio.h>
#include <mc9328mxl.h>
/* Global Variables */
extern void *_flash_size;
extern void *_flash_base;
extern void *_sdram_size;
extern void *_sdram_base;
extern void *_bss_free_start;
unsigned long free_mem_start;
unsigned long free_mem_end;
rtems_configuration_table BSP_Configuration;
rtems_cpu_table Cpu_table;
char *rtems_progname = "RTEMS";
extern void rtems_irq_mngt_init(void);
void bsp_libc_init( void *, uint32_t, int );
void bsp_postdriver_hook(void);
/**************************************************************************/
/* */
/* NAME: bsp_pretasking_hook - Function to setup system before startup */
/* */
/* DESCRIPTION: */
/* This function is called before drivers are initialized and used */
/* to setup libc and BSP extensions. */
/* */
/* RESTRICTIONS/LIMITATIONS: */
/* Since this function is setting up libc, it cannot use and libc */
/* functions. */
/* */
/**************************************************************************/
void bsp_pretasking_hook(void)
{
uint32_t heap_start;
uint32_t heap_size;
/*
* Set up the heap.
*/
heap_start = free_mem_start;
heap_size = free_mem_end - free_mem_start;
/* call rtems lib init - malloc stuff */
bsp_libc_init((void *)heap_start, heap_size, 0);
#ifdef RTEMS_DEBUG
rtems_debug_enable(RTEMS_DEBUG_ALL_MASK);
#endif /* RTEMS_DEBUG */
}
/**************************************************************************/
/* */
/* NAME: bsp_start_default - BSP initialization function */
/* */
/* DESCRIPTION: */
/* This function is called before RTEMS is initialized and used */
/* adjust the kernel's configuration. */
/* */
/* This function also configures the CPU's memory protection unit. */
/* */
/* RESTRICTIONS/LIMITATIONS: */
/* Since RTEMS is not configured, no RTEMS functions can be called. */
/* */
/**************************************************************************/
void mmu_set_cpu_async_mode(void);
void bsp_start_default( void )
{
int i;
/* Set the MCU prescaler to divide by 1 */
MC9328MXL_PLL_CSCR &= ~MC9328MXL_PLL_CSCR_PRESC;
/* Enable the MCU PLL */
MC9328MXL_PLL_CSCR |= MC9328MXL_PLL_CSCR_MPEN;
/* Delay to allow time for PLL to get going */
for (i = 0; i < 100; i++) {
asm volatile ("nop\n");
}
/* Set the CPU to asynchrous clock mode, so it uses its fastest clock */
mmu_set_cpu_async_mode();
/* disable interrupts */
MC9328MXL_AITC_INTENABLEL = 0;
MC9328MXL_AITC_INTENABLEH = 0;
/* Set interrupt priority to -1 (allow all priorities) */
MC9328MXL_AITC_NIMASK = 0x1f;
/* tell rtems about the hooks we are using */
Cpu_table.pretasking_hook = bsp_pretasking_hook;
Cpu_table.postdriver_hook = bsp_postdriver_hook;
/* tell rtems to clear the workspace by default */
Cpu_table.do_zero_of_workspace = TRUE;
/* Place RTEMS workspace at beginning of free memory. */
BSP_Configuration.work_space_start = (void *)&_bss_free_start;
free_mem_start = ((uint32_t)&_bss_free_start +
BSP_Configuration.work_space_size);
free_mem_end = ((uint32_t)&_sdram_base + (uint32_t)&_sdram_size);
/*
* Init rtems exceptions management
*/
rtems_exception_init_mngt();
/*
* Init rtems interrupt management
*/
rtems_irq_mngt_init();
/*
* The following information is very useful when debugging.
*/
#if 0
printk( "work_space_size = 0x%x\n",
BSP_Configuration.work_space_size );
printk( "maximum_extensions = 0x%x\n",
BSP_Configuration.maximum_extensions );
printk( "microseconds_per_tick = 0x%x\n",
BSP_Configuration.microseconds_per_tick );
printk( "ticks_per_timeslice = 0x%x\n",
BSP_Configuration.ticks_per_timeslice );
printk( "maximum_devices = 0x%x\n",
BSP_Configuration.maximum_devices );
printk( "number_of_device_drivers = 0x%x\n",
BSP_Configuration.number_of_device_drivers );
printk( "Device_driver_table = 0x%x\n",
BSP_Configuration.Device_driver_table );
printk( "work_space_start = 0x%x\n",
BSP_Configuration.work_space_start );
printk( "work_space_size = 0x%x\n",
BSP_Configuration.work_space_size );
#endif
} /* bsp_start */
/* Calcuate the frequency for perclk1 */
int get_perclk1_freq(void)
{
unsigned int fin;
unsigned int fpll;
unsigned int pd;
unsigned int mfd;
unsigned int mfi;
unsigned int mfn;
uint32_t reg;
int perclk1;
if (MC9328MXL_PLL_CSCR & MC9328MXL_PLL_CSCR_SYSSEL) {
/* Use external oscillator */
fin = BSP_OSC_FREQ;
} else {
/* Use scaled xtal freq */
fin = BSP_XTAL_FREQ * 512;
}
/* calculate the output of the system PLL */
reg = MC9328MXL_PLL_SPCTL0;
pd = ((reg & MC9328MXL_PLL_SPCTL_PD_MASK) >>
MC9328MXL_PLL_SPCTL_PD_SHIFT);
mfd = ((reg & MC9328MXL_PLL_SPCTL_MFD_MASK) >>
MC9328MXL_PLL_SPCTL_MFD_SHIFT);
mfi = ((reg & MC9328MXL_PLL_SPCTL_MFI_MASK) >>
MC9328MXL_PLL_SPCTL_MFI_SHIFT);
mfn = ((reg & MC9328MXL_PLL_SPCTL_MFN_MASK) >>
MC9328MXL_PLL_SPCTL_MFN_SHIFT);
#if 0
printk("fin = %d\n", fin);
printk("pd = %d\n", pd);
printk("mfd = %d\n", mfd);
printk("mfi = %d\n", mfi);
printk("mfn = %d\n", mfn);
printk("rounded (fin * mfi) / (pd + 1) = %d\n", (fin * mfi) / (pd + 1));
printk("rounded (fin * mfn) / ((pd + 1) * (mfd + 1)) = %d\n",
((long long)fin * mfn) / ((pd + 1) * (mfd + 1)));
#endif
fpll = 2 * ( ((fin * mfi + (pd + 1) / 2) / (pd + 1)) +
(((long long)fin * mfn + ((pd + 1) * (mfd + 1)) / 2) /
((pd + 1) * (mfd + 1))) );
/* calculate the output of the PERCLK1 divider */
reg = MC9328MXL_PLL_PCDR;
perclk1 = fpll / (1 + ((reg & MC9328MXL_PLL_PCDR_PCLK1_MASK) >>
MC9328MXL_PLL_PCDR_PCLK1_SHIFT));
return perclk1;
}
/*
* By making this a weak alias for bsp_start_default, a brave soul
* can override the actual bsp_start routine used.
*/
void bsp_start (void) __attribute__ ((weak, alias("bsp_start_default")));
/**
* Reset the system.
*
* This functions enables the watchdog and waits for it to
* fire, thus resetting the system.
*/
/**
* Reset the system.
*
* This functions enables the watchdog and waits for it to
* fire, thus resetting the system.
*/
void bsp_reset(void)
{
rtems_interrupt_level level;
_CPU_ISR_Disable(level);
printk("\n\rI should reset here.\n\r");
while(1);
}