diff options
Diffstat (limited to 'c/src/lib/libbsp/powerpc/qemuppc/startup/cmain.c')
-rw-r--r-- | c/src/lib/libbsp/powerpc/qemuppc/startup/cmain.c | 53 |
1 files changed, 53 insertions, 0 deletions
diff --git a/c/src/lib/libbsp/powerpc/qemuppc/startup/cmain.c b/c/src/lib/libbsp/powerpc/qemuppc/startup/cmain.c new file mode 100644 index 0000000000..b470028eff --- /dev/null +++ b/c/src/lib/libbsp/powerpc/qemuppc/startup/cmain.c @@ -0,0 +1,53 @@ + +#if 1 +static void +__outb(int port, unsigned char v) +{ + *((volatile unsigned char *)(0x80000000 + port)) = v; +} + +static unsigned char +__inb(int port) +{ + return *((volatile unsigned char *)(0x80000000 + port)); +} +#endif + +static void +__memcpy (unsigned char *d, unsigned char *s, int len) +{ + while (len--) + *d++ = *s++; +} + +static void +__bzero (unsigned char *d, int len) +{ + while (len--) + *d++ = 0; +} + +extern unsigned char __sdata2_load[], __sdata2_start[], __sdata2_end[]; +extern unsigned char __data_load[], __data_start[], __data_end[]; +extern unsigned char __sbss2_start[], __sbss2_end[]; +extern unsigned char __sbss_start[], __sbss_end[]; +extern unsigned char __bss_start[], __bss_end[]; + +extern void boot_card(void *); + + +void cmain (void) +{ + printk( "hello #1\n"); + __memcpy (__sdata2_start, __sdata2_load, __sdata2_end - __sdata2_start); + __memcpy (__data_start, __data_load, __data_end - __data_start); + __bzero (__sbss2_start, __sbss2_end - __sbss2_start); + __bzero (__sbss_start, __sbss_end - __sbss_start); + __bzero (__bss_start, __bss_end - __bss_start); + printk( "hello #2\n"); + boot_card(0); + printk( "end of BSP\n"); + __outb (0x92, 0x01); + while (1) + ; +} |