diff options
Diffstat (limited to 'c/src/lib/libbsp/arm/csb336/startup/bspstart.c')
| -rw-r--r-- | c/src/lib/libbsp/arm/csb336/startup/bspstart.c | 233 |
1 files changed, 233 insertions, 0 deletions
diff --git a/c/src/lib/libbsp/arm/csb336/startup/bspstart.c b/c/src/lib/libbsp/arm/csb336/startup/bspstart.c new file mode 100644 index 0000000000..991c54177b --- /dev/null +++ b/c/src/lib/libbsp/arm/csb336/startup/bspstart.c @@ -0,0 +1,233 @@ +/* + * 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.OARcorp.com/rtems/license.html. + * + * $Id$ + */ +#include <bsp.h> +#include <rtems/libcsupport.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 *, unsigned32, 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) +{ + unsigned32 heap_start; + unsigned32 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 bsp_start_default( void ) +{ + + /* 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 = ((unsigned32)&_bss_free_start + + BSP_Configuration.work_space_size); + + free_mem_end = ((unsigned32)&_sdram_base + (unsigned32)&_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) +{ + int fin; + int fpll; + int pd; + int mfd; + int mfi; + 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("(fin * mfi) / (pd + 1) = %d\n", (fin * mfi) / (pd + 1)); + printk("(fin * mfn) / ((pd + 1) * (mfd + 1)) = %d\n", + (fin * mfn) / ((pd + 1) * (mfd + 1))); +#endif + + fpll = 2 * ( ((fin * mfi) / (pd + 1)) + + ((fin * mfn) / ((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); +} |