diff options
Diffstat (limited to 'c/src/lib/libbsp/powerpc/motorola_powerpc/startup/cEntry.c')
| -rw-r--r-- | c/src/lib/libbsp/powerpc/motorola_powerpc/startup/cEntry.c | 121 |
1 files changed, 121 insertions, 0 deletions
diff --git a/c/src/lib/libbsp/powerpc/motorola_powerpc/startup/cEntry.c b/c/src/lib/libbsp/powerpc/motorola_powerpc/startup/cEntry.c new file mode 100644 index 0000000000..b92bff21be --- /dev/null +++ b/c/src/lib/libbsp/powerpc/motorola_powerpc/startup/cEntry.c @@ -0,0 +1,121 @@ +/* + * + */ +#include <bsp/consoleIo.h> +#include <libcpu/spr.h> +#include <bsp/residual.h> +#include <bsp/pci.h> +#include <bsp/openpic.h> +#include <bsp/irq.h> +#include <bsp.h> +#include <libcpu/bat.h> + +extern void _return_to_ppcbug(); +extern unsigned long __rtems_end; + +RESIDUAL residualCopy; +#define INIT_STACK_SIZE 0x1000 +#define INTR_STACK_SIZE 0x4000 + +void BSP_panic(char *s) +{ + printk("RTEMS 4.x PANIC %s\n", s); + _return_to_ppcbug(); +} + +void _BSP_Fatal_error(unsigned int v) +{ + printk("RTEMS 4.x PANIC ERROR %x\n", v); + _return_to_ppcbug(); +} + +void +boot_card(RESIDUAL* r3, void *r4, void* r5, char *additional_boot_options) +{ + int err; + unsigned char *stack; + unsigned l2cr; + register unsigned char* intrStack; + register unsigned int intrNestingLevel = 0; + + L1_caches_enables(); + stack = ((unsigned char*) &__rtems_end) + INIT_STACK_SIZE; + intrStack = ((unsigned char*) &__rtems_end) + INIT_STACK_SIZE + INTR_STACK_SIZE; + asm volatile ("mtspr 273, %0" : "=r" (intrStack) : "0" (intrStack)); + asm volatile ("mtspr 272, %0" : "=r" (intrNestingLevel) : "0" (intrNestingLevel)); + residualCopy = *r3; +#define NO_DYNAMIC_EXCEPTION_VECTOR_INSTALL +#undef NO_DYNAMIC_EXCEPTION_VECTOR_INSTALL +#ifndef NO_DYNAMIC_EXCEPTION_VECTOR_INSTALL + initialize_exceptions(); +#endif + select_console(CONSOLE_LOG); + + /* We check that the keyboard is present and immediately + * select the serial console if not. + */ + err = kbdreset(); + if (err) select_console(CONSOLE_SERIAL); + + + printk("Welcome to RTEMS 4.0.2 on Motorola MCP750\n\n\n"); + printk("-----------------------------------------\n"); + printk("Residuals are located at %x\n", (unsigned) r3); + printk("Additionnal boot options are %s\n", additional_boot_options); + printk("-----------------------------------------\n"); + + printk("Initial system stack at %x\n",stack); + l2cr = get_L2CR(); + printk("Initial L2CR value = %x\n", l2cr); + if (! (l2cr & 0x80000000)) + set_L2CR(0xb9A14000); +#ifdef TEST_RETURN_TO_PPCBUG + printk("Hit <Enter> to return to PPCBUG monitor\n"); + printk("When Finished hit GO. It should print <Back from monitor>\n"); + debug_getc(); + _return_to_ppcbug(); + printk("Back from monitor\n"); + _return_to_ppcbug(); +#endif /* TEST_RETURN_TO_PPCBUG */ + + /* + * Init MMU block address translation to enable hardware + * access + */ + /* + * PC legacy IO space used for inb/outb and all PC + * compatible hardware + */ + setdbat(1, 0x80000000, 0x80000000, 0x10000000, IO_PAGE); + /* + * PCI devices memory area. Needed to access OPENPIC features + * provided by the RAVEN + */ + setdbat(2, 0xc0000000, 0xc0000000, 0x08000000, IO_PAGE); + /* + * Must have acces to open pic PCI ACK registers + * provided by the RAVEN + */ + setdbat(3, 0xfeff0000, 0xfeff0000, 0x10000, IO_PAGE); + + printk("Going to start PCI buses scanning and initialization\n"); + InitializePCI(); + printk("Number of PCI buses is found : %d\n", BusCountPCI()); +#ifdef TEST_RAW_EXCEPTION_CODE + printk("Testing exception handling Part 1\n"); + /* + * Cause a software exception + */ + __asm__ __volatile ("sc"); + /* + * Check we can still catch exceptions + */ + printk("Testing exception handling Part 2\n"); + __asm__ __volatile ("sc"); +#endif + BSP_rtems_irq_mng_init(0); + printk("Init done\n"); + debug_getc(); + while(1); +} + |