WebSVN – HelenOS-historic – Diff – /boot/trunk/arch/ppc32/loader/main.c


/*
 * Copyright (C) 2005 Martin Decky
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */
 
#include "main.h" 
#include "printf.h"
#include "asm.h"
 
#define KERNEL_START ((void *) &_binary_____________kernel_kernel_bin_start)
#define KERNEL_END ((void *) &_binary_____________kernel_kernel_bin_end)
#define KERNEL_SIZE ((unsigned int) KERNEL_END - (unsigned int) KERNEL_START)
 
#define INIT_START ((void *) &_binary_____________uspace_init_init_start)
#define INIT_END ((void *) &_binary_____________uspace_init_init_end)
#define INIT_SIZE ((unsigned int) INIT_END - (unsigned int) INIT_START)
 
#define HEAP_GAP 1024000
 
bootinfo_t bootinfo;
 
 
static void check_align(const void *addr, const char *desc)
{
    if ((unsigned int) addr % PAGE_SIZE != 0) {
        printf("Error: %s not on page boundary, halting.\n", desc);
        halt();
    }
}
 
 
static void fix_overlap(void *va, void **pa, const char *desc, unsigned int *top)
{
    if ((unsigned int) *pa + PAGE_SIZE < *top) {
        printf("Warning: %s overlaps kernel physical area\n", desc);
       
        void *new_va = (void *) (ALIGN_UP((unsigned int) KERNEL_END + HEAP_GAP, PAGE_SIZE) + *top);
        void *new_pa = (void *) (HEAP_GAP + *top);
        *top += PAGE_SIZE;
       
        if (ofw_map(new_pa, new_va, PAGE_SIZE, 0) != 0) {
            printf("Error: Unable to map page aligned memory at %L (physical %L), halting.\n", new_va, new_pa);
            halt();
        }
       
        if ((unsigned int) new_pa + PAGE_SIZE < KERNEL_SIZE) {
            printf("Error: %s cannot be relocated, halting.\n", desc);
            halt();
        }
       
        printf("Relocating %L -> %L (physical %L -> %L)\n", va, new_va, *pa, new_pa);
        *pa = new_pa;
        memcpy(new_va, va, PAGE_SIZE);
    }
}
 
 
void bootstrap(void)
{
    printf("\nHelenOS PPC Bootloader\n");
   
    check_align(KERNEL_START, "Kernel image");
    check_align(INIT_START, "Init image");
    check_align(&real_mode, "Bootstrap trampoline");
    check_align(&trans, "Translation table");
   
    if (!ofw_memmap(&bootinfo.memmap)) {
        printf("Error: Unable to get memory map, halting.\n");
        halt();
    }
   
    if (bootinfo.memmap.total == 0) {
        printf("Error: No memory detected, halting.\n");
        halt();
    }
   
    if (!ofw_screen(&bootinfo.screen)) {
        printf("Error: Unable to get screen properties, halting.\n");
        halt();
    }
   
    printf("\nDevice statistics\n");
    printf(" screen at %L, resolution %dx%d, %d bpp (scanline %d bytes)\n", bootinfo.screen.addr, bootinfo.screen.width, bootinfo.screen.height, bootinfo.screen.bpp, bootinfo.screen.scanline);
   
    void *real_mode_pa = ofw_translate(&real_mode);
    void *trans_pa = ofw_translate(&trans);
    void *bootinfo_pa = ofw_translate(&bootinfo);
    void *fb = (void *) (((unsigned int) bootinfo.screen.addr) & ((unsigned int) ~0 << 17));
   
    printf("\nMemory statistics (total %d MB)\n", bootinfo.memmap.total >> 20);
    printf(" kernel image         at %L (size %d bytes)\n", KERNEL_START, KERNEL_SIZE);
    printf(" init image           at %L (size %d bytes)\n", INIT_START, INIT_SIZE);
    printf(" boot info structure  at %L (physical %L)\n", &bootinfo, bootinfo_pa);
    printf(" bootstrap trampoline at %L (physical %L)\n", &real_mode, real_mode_pa);
    printf(" translation table    at %L (physical %L)\n", &trans, trans_pa);
   
    unsigned int top = ALIGN_UP(KERNEL_SIZE, PAGE_SIZE) + ALIGN_UP(INIT_SIZE, PAGE_SIZE);
    unsigned int kernel_pages = ALIGN_UP(KERNEL_SIZE, PAGE_SIZE) >> PAGE_WIDTH;
    unsigned int init_pages = ALIGN_UP(INIT_SIZE, PAGE_SIZE) >> PAGE_WIDTH;
   
    unsigned int i;
   
    for (i = 0; i < kernel_pages; i++) {
        void *pa = ofw_translate(KERNEL_START + (i << PAGE_WIDTH));
        fix_overlap(KERNEL_START + (i << PAGE_WIDTH), &pa, "Kernel image", &top);
        trans[i] = pa;
    }
   
    for (i = 0; i < init_pages; i++) {
        void *pa = ofw_translate(INIT_START + (i << PAGE_WIDTH));
        fix_overlap(INIT_START + (i << PAGE_WIDTH), &pa, "Init image", &top);
        trans[kernel_pages + i] = pa;
        if (i == 0) {
            bootinfo.init.addr = (void *) ((kernel_pages + i) << PAGE_WIDTH);
            bootinfo.init.size = INIT_SIZE;
        }
    }
   
    fix_overlap(&real_mode, &real_mode_pa, "Bootstrap trampoline", &top);
    fix_overlap(&trans, &trans_pa, "Translation table", &top);
    fix_overlap(&bootinfo, &bootinfo_pa, "Boot info", &top);
   
    printf("\nBooting the kernel...\n");
    jump_to_kernel(bootinfo_pa, sizeof(bootinfo), trans_pa, (kernel_pages + init_pages) << PAGE_WIDTH, fb, real_mode_pa);
}
 

Subversion Repositories HelenOS-historic

(root)/boot/trunk/arch/ppc32/loader/main.c – Rev 1146 → 1219

Rev 1146		Rev 1219
1	/*	1	/*
2	* Copyright (C) 2005 Martin Decky	2	* Copyright (C) 2005 Martin Decky
3	* All rights reserved.	3	* All rights reserved.
4	*	4	*
5	* Redistribution and use in source and binary forms, with or without	5	* Redistribution and use in source and binary forms, with or without
6	* modification, are permitted provided that the following conditions	6	* modification, are permitted provided that the following conditions
7	* are met:	7	* are met:
8	*	8	*
9	* - Redistributions of source code must retain the above copyright	9	* - Redistributions of source code must retain the above copyright
10	* notice, this list of conditions and the following disclaimer.	10	* notice, this list of conditions and the following disclaimer.
11	* - Redistributions in binary form must reproduce the above copyright	11	* - Redistributions in binary form must reproduce the above copyright
12	* notice, this list of conditions and the following disclaimer in the	12	* notice, this list of conditions and the following disclaimer in the
13	* documentation and/or other materials provided with the distribution.	13	* documentation and/or other materials provided with the distribution.
14	* - The name of the author may not be used to endorse or promote products	14	* - The name of the author may not be used to endorse or promote products
15	* derived from this software without specific prior written permission.	15	* derived from this software without specific prior written permission.
16	*	16	*
17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27	*/	27	*/
28		28
29	#include "main.h"	29	#include "main.h"
30	#include "printf.h"	30	#include "printf.h"
31	#include "asm.h"	31	#include "asm.h"
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 INIT_START ((void *) &_binary_____________uspace_init_init_start)
-		38	#define INIT_END ((void *) &_binary_____________uspace_init_init_end)
-		39	#define INIT_SIZE ((unsigned int) INIT_END - (unsigned int) INIT_START)
-		40
37	#define HEAP_GAP 1024000	41	#define HEAP_GAP 1024000
38		42
39	bootinfo_t bootinfo;	43	bootinfo_t bootinfo;
40		44
41		45
42	static void check_align(const void addr, const char desc)	46	static void check_align(const void addr, const char desc)
43	{	47	{
44	if ((unsigned int) addr % PAGE_SIZE != 0) {	48	if ((unsigned int) addr % PAGE_SIZE != 0) {
45	printf("Error: %s not on page boundary, halting.\n", desc);	49	printf("Error: %s not on page boundary, halting.\n", desc);
46	halt();	50	halt();
47	}	51	}
48	}	52	}
49		53
50		54
51	static void fix_overlap(void va, void pa, const char desc, unsigned int *top)	55	static void fix_overlap(void va, void pa, const char desc, unsigned int *top)
52	{	56	{
53	if ((unsigned int) pa + PAGE_SIZE < top) {	57	if ((unsigned int) pa + PAGE_SIZE < top) {
54	printf("Warning: %s overlaps kernel physical area\n", desc);	58	printf("Warning: %s overlaps kernel physical area\n", desc);
55		59
56	void new_va = (void ) (ALIGN_UP((unsigned int) KERNEL_END + HEAP_GAP, PAGE_SIZE) + *top);	60	void new_va = (void ) (ALIGN_UP((unsigned int) KERNEL_END + HEAP_GAP, PAGE_SIZE) + *top);
57	void new_pa = (void ) (HEAP_GAP + *top);	61	void new_pa = (void ) (HEAP_GAP + *top);
58	*top += PAGE_SIZE;	62	*top += PAGE_SIZE;
59		63
60	if (ofw_map(new_pa, new_va, PAGE_SIZE, 0) != 0) {	64	if (ofw_map(new_pa, new_va, PAGE_SIZE, 0) != 0) {
61	printf("Error: Unable to map page aligned memory at %L (physical %L), halting.\n", new_va, new_pa);	65	printf("Error: Unable to map page aligned memory at %L (physical %L), halting.\n", new_va, new_pa);
62	halt();	66	halt();
63	}	67	}
64		68
65	if ((unsigned int) new_pa + PAGE_SIZE < KERNEL_SIZE) {	69	if ((unsigned int) new_pa + PAGE_SIZE < KERNEL_SIZE) {
66	printf("Error: %s cannot be relocated, halting.\n", desc);	70	printf("Error: %s cannot be relocated, halting.\n", desc);
67	halt();	71	halt();
68	}	72	}
69		73
70	printf("Relocating %L -> %L (physical %L -> %L)\n", va, new_va, *pa, new_pa);	74	printf("Relocating %L -> %L (physical %L -> %L)\n", va, new_va, *pa, new_pa);
71	*pa = new_pa;	75	*pa = new_pa;
72	memcpy(new_va, va, PAGE_SIZE);	76	memcpy(new_va, va, PAGE_SIZE);
73	}	77	}
74	}	78	}
75		79
76		80
77	void bootstrap(void)	81	void bootstrap(void)
78	{	82	{
79	printf("\nHelenOS PPC Bootloader\n");	83	printf("\nHelenOS PPC Bootloader\n");
80		84
81	check_align(KERNEL_START, "Kernel image");	85	check_align(KERNEL_START, "Kernel image");
-		86	check_align(INIT_START, "Init image");
82	check_align(&real_mode, "Bootstrap trampoline");	87	check_align(&real_mode, "Bootstrap trampoline");
83	check_align(&trans, "Translation table");	88	check_align(&trans, "Translation table");
84		89
85	if (!ofw_memmap(&bootinfo.memmap)) {	90	if (!ofw_memmap(&bootinfo.memmap)) {
86	printf("Error: Unable to get memory map, halting.\n");	91	printf("Error: Unable to get memory map, halting.\n");
87	halt();	92	halt();
88	}	93	}
89		94
90	if (bootinfo.memmap.total == 0) {	95	if (bootinfo.memmap.total == 0) {
91	printf("Error: No memory detected, halting.\n");	96	printf("Error: No memory detected, halting.\n");
92	halt();	97	halt();
93	}	98	}
94		99
95	if (!ofw_screen(&bootinfo.screen)) {	100	if (!ofw_screen(&bootinfo.screen)) {
96	printf("Error: Unable to get screen properties, halting.\n");	101	printf("Error: Unable to get screen properties, halting.\n");
97	halt();	102	halt();
98	}	103	}
99		104
100	printf("\nDevice statistics\n");	105	printf("\nDevice statistics\n");
101	printf(" screen at %L, resolution %dx%d, %d bpp (scanline %d bytes)\n", bootinfo.screen.addr, bootinfo.screen.width, bootinfo.screen.height, bootinfo.screen.bpp, bootinfo.screen.scanline);	106	printf(" screen at %L, resolution %dx%d, %d bpp (scanline %d bytes)\n", bootinfo.screen.addr, bootinfo.screen.width, bootinfo.screen.height, bootinfo.screen.bpp, bootinfo.screen.scanline);
102		107
103	void *real_mode_pa = ofw_translate(&real_mode);	108	void *real_mode_pa = ofw_translate(&real_mode);
104	void *trans_pa = ofw_translate(&trans);	109	void *trans_pa = ofw_translate(&trans);
105	void *bootinfo_pa = ofw_translate(&bootinfo);	110	void *bootinfo_pa = ofw_translate(&bootinfo);
106	void fb = (void ) (((unsigned int) bootinfo.screen.addr) & ((unsigned int) ~0 << 17));	111	void fb = (void ) (((unsigned int) bootinfo.screen.addr) & ((unsigned int) ~0 << 17));
107		112
108	printf("\nMemory statistics (total %d MB)\n", bootinfo.memmap.total >> 20);	113	printf("\nMemory statistics (total %d MB)\n", bootinfo.memmap.total >> 20);
109	printf(" kernel image at %L (size %d bytes)\n", KERNEL_START, KERNEL_SIZE);	114	printf(" kernel image at %L (size %d bytes)\n", KERNEL_START, KERNEL_SIZE);
-		115	printf(" init image at %L (size %d bytes)\n", INIT_START, INIT_SIZE);
110	printf(" boot info at %L (physical %L)\n", &bootinfo, bootinfo_pa);	116	printf(" boot info structure at %L (physical %L)\n", &bootinfo, bootinfo_pa);
111	printf(" bootstrap trampoline at %L (physical %L)\n", &real_mode, real_mode_pa);	117	printf(" bootstrap trampoline at %L (physical %L)\n", &real_mode, real_mode_pa);
112	printf(" translation table at %L (physical %L)\n", &trans, trans_pa);	118	printf(" translation table at %L (physical %L)\n", &trans, trans_pa);
113		119
-		120	unsigned int top = ALIGN_UP(KERNEL_SIZE, PAGE_SIZE) + ALIGN_UP(INIT_SIZE, PAGE_SIZE);
114	unsigned int top = ALIGN_UP(KERNEL_SIZE, PAGE_SIZE);	121	unsigned int kernel_pages = ALIGN_UP(KERNEL_SIZE, PAGE_SIZE) >> PAGE_WIDTH;
-		122	unsigned int init_pages = ALIGN_UP(INIT_SIZE, PAGE_SIZE) >> PAGE_WIDTH;
-		123
115	unsigned int addr;	124	unsigned int i;
-		125
116	for (addr = 0; addr < KERNEL_SIZE; addr += PAGE_SIZE) {	126	for (i = 0; i < kernel_pages; i++) {
117	void *pa = ofw_translate(KERNEL_START + addr);	127	void *pa = ofw_translate(KERNEL_START + (i << PAGE_WIDTH));
118	fix_overlap(KERNEL_START + addr, &pa, "Kernel image", &top);	128	fix_overlap(KERNEL_START + (i << PAGE_WIDTH), &pa, "Kernel image", &top);
-		129	trans[i] = pa;
-		130	}
-		131
-		132	for (i = 0; i < init_pages; i++) {
-		133	void *pa = ofw_translate(INIT_START + (i << PAGE_WIDTH));
-		134	fix_overlap(INIT_START + (i << PAGE_WIDTH), &pa, "Init image", &top);
119	trans[addr >> PAGE_WIDTH] = pa;	135	trans[kernel_pages + i] = pa;
-		136	if (i == 0) {
-		137	bootinfo.init.addr = (void *) ((kernel_pages + i) << PAGE_WIDTH);
-		138	bootinfo.init.size = INIT_SIZE;
-		139	}
120	}	140	}
121		141
122	fix_overlap(&real_mode, &real_mode_pa, "Bootstrap trampoline", &top);	142	fix_overlap(&real_mode, &real_mode_pa, "Bootstrap trampoline", &top);
123	fix_overlap(&trans, &trans_pa, "Translation table", &top);	143	fix_overlap(&trans, &trans_pa, "Translation table", &top);
124	fix_overlap(&bootinfo, &bootinfo_pa, "Boot info", &top);	144	fix_overlap(&bootinfo, &bootinfo_pa, "Boot info", &top);
125		145
126	printf("\nBooting the kernel...\n");	146	printf("\nBooting the kernel...\n");
127	jump_to_kernel(bootinfo_pa, sizeof(bootinfo), trans_pa, KERNEL_SIZE, fb, real_mode_pa);	147	jump_to_kernel(bootinfo_pa, sizeof(bootinfo), trans_pa, (kernel_pages + init_pages) << PAGE_WIDTH, fb, real_mode_pa);
128	}	148	}
129		149