summaryrefslogtreecommitdiffstats
path: root/c/src/lib/libbsp/powerpc/qemuppc/startup/cmain.c
blob: 5b717e2afcae705e0713276b14bbced942ac7a9b (plain) (blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
#include <bsp/bootcard.h>

static void
__outb(int port, unsigned char v)
{
  *((volatile unsigned char *)(0x80000000 + port)) = v;
}

#if 0
/* currently unused but keep just in case */

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 __sdata_load[], __sdata_start[], __sdata_end[];
extern unsigned char __sbss2_start[], __sbss2_end[];
extern unsigned char __sbss_start[], __sbss_end[];
extern unsigned char __bss_start[], __bss_end[];


void cmain (void)
{
  /*
   * init variable sections
   */
  __memcpy (__sdata2_start, __sdata2_load, __sdata2_end - __sdata2_start);
  __memcpy (__sdata_start , __sdata_load , __sdata_end  - __sdata_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( "start of BSP\n"); */
  boot_card(0);
  /* printk( "end of BSP\n"); */
  __outb (0x92, 0x01);
  while (1)
    ;
}