Rev 1068 | Rev 1130 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 1068 | Rev 1075 | ||
|---|---|---|---|
| Line 32... | Line 32... | ||
| 32 | 32 | ||
| 33 | #define KERNEL_START ((void *) &_binary_____________kernel_kernel_bin_start) |
33 | #define KERNEL_START ((void *) &_binary_____________kernel_kernel_bin_start) |
| 34 | #define KERNEL_END ((void *) &_binary_____________kernel_kernel_bin_end) |
34 | #define KERNEL_END ((void *) &_binary_____________kernel_kernel_bin_end) |
| 35 | #define KERNEL_SIZE ((unsigned int) KERNEL_END - (unsigned int) KERNEL_START) |
35 | #define KERNEL_SIZE ((unsigned int) KERNEL_END - (unsigned int) KERNEL_START) |
| 36 | 36 | ||
| - | 37 | #define HEAP_GAP 1024000 |
|
| - | 38 | ||
| 37 | memmap_t memmap; |
39 | memmap_t memmap; |
| 38 | 40 | ||
| 39 | 41 | ||
| 40 | static void check_align(const void *addr, const char *desc) |
42 | static void check_align(const void *addr, const char *desc) |
| 41 | { |
43 | { |
| Line 44... | Line 46... | ||
| 44 | halt(); |
46 | halt(); |
| 45 | } |
47 | } |
| 46 | } |
48 | } |
| 47 | 49 | ||
| 48 | 50 | ||
| 49 | static void check_overlap(const void *addr, const char *desc) |
51 | static void fix_overlap(void *va, void **pa, const char *desc, unsigned int *top) |
| 50 | { |
52 | { |
| 51 | if ((unsigned int) addr < KERNEL_SIZE) { |
53 | if ((unsigned int) *pa + PAGE_SIZE < *top) { |
| 52 | printf("Error: %s overlaps kernel physical area\n", desc); |
54 | printf("Warning: %s overlaps kernel physical area\n", desc); |
| - | 55 | ||
| - | 56 | void *new_va = (void *) (ALIGN_UP((unsigned int) KERNEL_END + HEAP_GAP, PAGE_SIZE) + *top); |
|
| - | 57 | void *new_pa = (void *) (HEAP_GAP + *top); |
|
| - | 58 | *top += PAGE_SIZE; |
|
| - | 59 | ||
| - | 60 | if (ofw_map(new_pa, new_va, PAGE_SIZE, 0) != 0) { |
|
| - | 61 | printf("Error: Unable to map page aligned memory at %L (physical %L)\n", new_va, new_pa); |
|
| 53 | halt(); |
62 | halt(); |
| - | 63 | } |
|
| - | 64 | ||
| - | 65 | if ((unsigned int) new_pa + PAGE_SIZE < KERNEL_SIZE) { |
|
| - | 66 | printf("Error: %s cannot be relocated\n", desc); |
|
| - | 67 | halt(); |
|
| - | 68 | } |
|
| - | 69 | ||
| - | 70 | printf("Relocating %L -> %L (physical %L -> %L)\n", va, new_va, *pa, new_pa); |
|
| - | 71 | *pa = new_pa; |
|
| - | 72 | memcpy(new_va, va, PAGE_SIZE); |
|
| 54 | } |
73 | } |
| 55 | } |
74 | } |
| 56 | 75 | ||
| 57 | 76 | ||
| 58 | void bootstrap(void) |
77 | void bootstrap(void) |
| Line 70... | Line 89... | ||
| 70 | 89 | ||
| 71 | void *real_mode_pa = ofw_translate(&real_mode); |
90 | void *real_mode_pa = ofw_translate(&real_mode); |
| 72 | void *trans_pa = ofw_translate(&trans); |
91 | void *trans_pa = ofw_translate(&trans); |
| 73 | void *memmap_pa = ofw_translate(&memmap); |
92 | void *memmap_pa = ofw_translate(&memmap); |
| 74 | 93 | ||
| 75 | check_overlap(real_mode_pa, "Bootstrap trampoline"); |
- | |
| 76 | check_overlap(trans_pa, "Translation table"); |
- | |
| 77 | check_overlap(memmap_pa, "Memory map"); |
- | |
| 78 | - | ||
| 79 | printf("Memory statistics (total %d MB)\n", memmap.total >> 20); |
94 | printf("Memory statistics (total %d MB)\n", memmap.total >> 20); |
| 80 | printf(" kernel image at %L (size %d bytes)\n", KERNEL_START, KERNEL_SIZE); |
95 | printf(" kernel image at %L (size %d bytes)\n", KERNEL_START, KERNEL_SIZE); |
| 81 | printf(" memory map at %L (physical %L)\n", &memmap, memmap_pa); |
96 | printf(" memory map at %L (physical %L)\n", &memmap, memmap_pa); |
| 82 | printf(" bootstrap trampoline at %L (physical %L)\n", &real_mode, real_mode_pa); |
97 | printf(" bootstrap trampoline at %L (physical %L)\n", &real_mode, real_mode_pa); |
| 83 | printf(" translation table at %L (physical %L)\n", &trans, trans_pa); |
98 | printf(" translation table at %L (physical %L)\n", &trans, trans_pa); |
| 84 | 99 | ||
| - | 100 | unsigned int top = ALIGN_UP(KERNEL_SIZE, PAGE_SIZE); |
|
| 85 | unsigned int addr; |
101 | unsigned int addr; |
| 86 | for (addr = 0; addr < KERNEL_SIZE; addr += PAGE_SIZE) { |
102 | for (addr = 0; addr < KERNEL_SIZE; addr += PAGE_SIZE) { |
| 87 | void *pa = ofw_translate(KERNEL_START + addr); |
103 | void *pa = ofw_translate(KERNEL_START + addr); |
| 88 | check_overlap(pa, "Kernel image"); |
104 | fix_overlap(KERNEL_START + addr, &pa, "Kernel image", &top); |
| 89 | trans[addr >> PAGE_WIDTH] = pa; |
105 | trans[addr >> PAGE_WIDTH] = pa; |
| 90 | } |
106 | } |
| 91 | 107 | ||
| - | 108 | fix_overlap(&real_mode, &real_mode_pa, "Bootstrap trampoline", &top); |
|
| - | 109 | fix_overlap(&trans, &trans_pa, "Translation table", &top); |
|
| - | 110 | fix_overlap(&memmap, &memmap_pa, "Memory map", &top); |
|
| - | 111 | ||
| 92 | printf("Booting the kernel...\n"); |
112 | printf("Booting the kernel...\n"); |
| 93 | jump_to_kernel(memmap_pa, trans_pa, KERNEL_SIZE, real_mode_pa); |
113 | jump_to_kernel(memmap_pa, trans_pa, KERNEL_SIZE, real_mode_pa); |
| 94 | } |
114 | } |