WebSVN – HelenOS – Diff – /trunk/boot/arch/ppc64/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"
#include "_components.h"
#include <ofw.h>
#include <align.h>
 
#define HEAP_GAP 1024000
 
bootinfo_t bootinfo;
 
 
static void check_align(const void *addr, const char *desc)
{
    if ((unsigned long) 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 long *top)
{
    if ((unsigned long) *pa + PAGE_SIZE < *top) {
        printf("Warning: %s overlaps kernel physical area\n", desc);
       
        void *new_va = (void *) (ALIGN_UP((unsigned long) 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 long) 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);
    }
}
 
char *release = RELEASE;
 
#ifdef REVISION
    char *revision = ", revision " REVISION;
#else
    char *revision = "";
#endif
 
#ifdef TIMESTAMP
    char *timestamp = "\nBuilt on " TIMESTAMP;
#else
    char *timestamp = "";
#endif
 
/** Print version information. */
static void version_print(void)
{
    printf("HelenOS PPC64 Bootloader\nRelease %s%s%s\nCopyright (c) 2006 HelenOS project\n", release, revision, timestamp);
}
 
void bootstrap(void)
{
    version_print();
   
    init_components();
   
    unsigned int i;
   
    for (i = 0; i < COMPONENTS; i++)
        check_align(components[i].start, components[i].name);
   
    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();
    }
   
    if (!ofw_keyboard(&bootinfo.keyboard)) {
        printf("Error: unable to get keyboard 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);
    printf(" keyboard at %L (size %d bytes)\n", bootinfo.keyboard.addr, bootinfo.keyboard.size);
   
    void *real_mode_pa = ofw_translate(&real_mode);
    void *trans_pa = ofw_translate(&trans);
    void *bootinfo_pa = ofw_translate(&bootinfo);
   
    printf("\nMemory statistics (total %d MB)\n", bootinfo.memmap.total >> 20);
    printf(" %L: boot info structure (physical %L)\n", &bootinfo, bootinfo_pa);
    printf(" %L: bootstrap trampoline (physical %L)\n", &real_mode, real_mode_pa);
    printf(" %L: translation table (physical %L)\n", &trans, trans_pa);
    for (i = 0; i < COMPONENTS; i++)
        printf(" %L: %s image (size %d bytes)\n", components[i].start, components[i].name, components[i].size);
   
    unsigned long top = 0;
    for (i = 0; i < COMPONENTS; i++)
        top += ALIGN_UP(components[i].size, PAGE_SIZE);
   
    unsigned long pages = ALIGN_UP(KERNEL_SIZE, PAGE_SIZE) >> PAGE_WIDTH;
   
    for (i = 0; i < pages; i++) {
        void *pa = ofw_translate(KERNEL_START + (i << PAGE_WIDTH));
        fix_overlap(KERNEL_START + (i << PAGE_WIDTH), &pa, "kernel", &top);
        trans[i] = pa;
    }
   
    bootinfo.taskmap.count = 0;
    for (i = 1; i < COMPONENTS; i++) {
        unsigned long component_pages = ALIGN_UP(components[i].size, PAGE_SIZE) >> PAGE_WIDTH;
        unsigned long j;
       
        for (j = 0; j < component_pages; j++) {
            void *pa = ofw_translate(components[i].start + (j << PAGE_WIDTH));
            fix_overlap(components[i].start + (j << PAGE_WIDTH), &pa, components[i].name, &top);
            trans[pages + j] = pa;
            if (j == 0) {
                bootinfo.taskmap.tasks[bootinfo.taskmap.count].addr = (void *) (pages << PAGE_WIDTH);
                bootinfo.taskmap.tasks[bootinfo.taskmap.count].size = components[i].size;
                bootinfo.taskmap.count++;
            }
        }
       
        pages += component_pages;
    }
   
    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, pages << PAGE_WIDTH, real_mode_pa, (void *) bootinfo.screen.addr, bootinfo.screen.scanline);
}
 

Subversion Repositories HelenOS

(root)/trunk/boot/arch/ppc64/loader/main.c – Rev 1998 → 2071

Rev 1998		Rev 2071
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	#include "_components.h"	32	#include "_components.h"
33	#include <ofw.h>	33	#include <ofw.h>
34	#include <align.h>	34	#include <align.h>
35		35
36	#define HEAP_GAP 1024000	36	#define HEAP_GAP 1024000
37		37
38	bootinfo_t bootinfo;	38	bootinfo_t bootinfo;
39		39
40		40
41	static void check_align(const void addr, const char desc)	41	static void check_align(const void addr, const char desc)
42	{	42	{
43	if ((unsigned long) addr % PAGE_SIZE != 0) {	43	if ((unsigned long) addr % PAGE_SIZE != 0) {
44	printf("Error: %s not on page boundary, halting.\n", desc);	44	printf("Error: %s not on page boundary, halting.\n", desc);
45	halt();	45	halt();
46	}	46	}
47	}	47	}
48		48
49		49
50	static void fix_overlap(void va, void pa, const char desc, unsigned long *top)	50	static void fix_overlap(void va, void pa, const char desc, unsigned long *top)
51	{	51	{
52	if ((unsigned long) pa + PAGE_SIZE < top) {	52	if ((unsigned long) pa + PAGE_SIZE < top) {
53	printf("Warning: %s overlaps kernel physical area\n", desc);	53	printf("Warning: %s overlaps kernel physical area\n", desc);
54		54
55	void new_va = (void ) (ALIGN_UP((unsigned long) KERNEL_END + HEAP_GAP, PAGE_SIZE) + *top);	55	void new_va = (void ) (ALIGN_UP((unsigned long) KERNEL_END + HEAP_GAP, PAGE_SIZE) + *top);
56	void new_pa = (void ) (HEAP_GAP + *top);	56	void new_pa = (void ) (HEAP_GAP + *top);
57	*top += PAGE_SIZE;	57	*top += PAGE_SIZE;
58		58
59	if (ofw_map(new_pa, new_va, PAGE_SIZE, 0) != 0) {	59	if (ofw_map(new_pa, new_va, PAGE_SIZE, 0) != 0) {
60	printf("Error: Unable to map page aligned memory at %L (physical %L), halting.\n", new_va, new_pa);	60	printf("Error: Unable to map page aligned memory at %L (physical %L), halting.\n", new_va, new_pa);
61	halt();	61	halt();
62	}	62	}
63		63
64	if ((unsigned long) new_pa + PAGE_SIZE < KERNEL_SIZE) {	64	if ((unsigned long) new_pa + PAGE_SIZE < KERNEL_SIZE) {
65	printf("Error: %s cannot be relocated, halting.\n", desc);	65	printf("Error: %s cannot be relocated, halting.\n", desc);
66	halt();	66	halt();
67	}	67	}
68		68
69	printf("Relocating %L -> %L (physical %L -> %L)\n", va, new_va, *pa, new_pa);	69	printf("Relocating %L -> %L (physical %L -> %L)\n", va, new_va, *pa, new_pa);
70	*pa = new_pa;	70	*pa = new_pa;
71	memcpy(new_va, va, PAGE_SIZE);	71	memcpy(new_va, va, PAGE_SIZE);
72	}	72	}
73	}	73	}
74		74
75	char *release = RELEASE;	75	char *release = RELEASE;
76		76
77	#ifdef REVISION	77	#ifdef REVISION
78	char *revision = ", revision " REVISION;	78	char *revision = ", revision " REVISION;
79	#else	79	#else
80	char *revision = "";	80	char *revision = "";
81	#endif	81	#endif
82		82
83	#ifdef TIMESTAMP	83	#ifdef TIMESTAMP
84	char *timestamp = "\nBuilt on " TIMESTAMP;	84	char *timestamp = "\nBuilt on " TIMESTAMP;
85	#else	85	#else
86	char *timestamp = "";	86	char *timestamp = "";
87	#endif	87	#endif
88		88
89	/** Print version information. */	89	/** Print version information. */
90	static void version_print(void)	90	static void version_print(void)
91	{	91	{
92	printf("HelenOS PPC64 Bootloader\nRelease %s%s%s\nCopyright (C) 2006 HelenOS project\n", release, revision, timestamp);	92	printf("HelenOS PPC64 Bootloader\nRelease %s%s%s\nCopyright (c) 2006 HelenOS project\n", release, revision, timestamp);
93	}	93	}
94		94
95	void bootstrap(void)	95	void bootstrap(void)
96	{	96	{
97	version_print();	97	version_print();
98		98
99	init_components();	99	init_components();
100		100
101	unsigned int i;	101	unsigned int i;
102		102
103	for (i = 0; i < COMPONENTS; i++)	103	for (i = 0; i < COMPONENTS; i++)
104	check_align(components[i].start, components[i].name);	104	check_align(components[i].start, components[i].name);
105		105
106	check_align(&real_mode, "bootstrap trampoline");	106	check_align(&real_mode, "bootstrap trampoline");
107	check_align(&trans, "translation table");	107	check_align(&trans, "translation table");
108		108
109	if (!ofw_memmap(&bootinfo.memmap)) {	109	if (!ofw_memmap(&bootinfo.memmap)) {
110	printf("Error: unable to get memory map, halting.\n");	110	printf("Error: unable to get memory map, halting.\n");
111	halt();	111	halt();
112	}	112	}
113		113
114	if (bootinfo.memmap.total == 0) {	114	if (bootinfo.memmap.total == 0) {
115	printf("Error: no memory detected, halting.\n");	115	printf("Error: no memory detected, halting.\n");
116	halt();	116	halt();
117	}	117	}
118		118
119	if (!ofw_screen(&bootinfo.screen)) {	119	if (!ofw_screen(&bootinfo.screen)) {
120	printf("Error: unable to get screen properties, halting.\n");	120	printf("Error: unable to get screen properties, halting.\n");
121	halt();	121	halt();
122	}	122	}
123		123
124	if (!ofw_keyboard(&bootinfo.keyboard)) {	124	if (!ofw_keyboard(&bootinfo.keyboard)) {
125	printf("Error: unable to get keyboard properties, halting.\n");	125	printf("Error: unable to get keyboard properties, halting.\n");
126	halt();	126	halt();
127	}	127	}
128		128
129	printf("\nDevice statistics\n");	129	printf("\nDevice statistics\n");
130	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);	130	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);
131	printf(" keyboard at %L (size %d bytes)\n", bootinfo.keyboard.addr, bootinfo.keyboard.size);	131	printf(" keyboard at %L (size %d bytes)\n", bootinfo.keyboard.addr, bootinfo.keyboard.size);
132		132
133	void *real_mode_pa = ofw_translate(&real_mode);	133	void *real_mode_pa = ofw_translate(&real_mode);
134	void *trans_pa = ofw_translate(&trans);	134	void *trans_pa = ofw_translate(&trans);
135	void *bootinfo_pa = ofw_translate(&bootinfo);	135	void *bootinfo_pa = ofw_translate(&bootinfo);
136		136
137	printf("\nMemory statistics (total %d MB)\n", bootinfo.memmap.total >> 20);	137	printf("\nMemory statistics (total %d MB)\n", bootinfo.memmap.total >> 20);
138	printf(" %L: boot info structure (physical %L)\n", &bootinfo, bootinfo_pa);	138	printf(" %L: boot info structure (physical %L)\n", &bootinfo, bootinfo_pa);
139	printf(" %L: bootstrap trampoline (physical %L)\n", &real_mode, real_mode_pa);	139	printf(" %L: bootstrap trampoline (physical %L)\n", &real_mode, real_mode_pa);
140	printf(" %L: translation table (physical %L)\n", &trans, trans_pa);	140	printf(" %L: translation table (physical %L)\n", &trans, trans_pa);
141	for (i = 0; i < COMPONENTS; i++)	141	for (i = 0; i < COMPONENTS; i++)
142	printf(" %L: %s image (size %d bytes)\n", components[i].start, components[i].name, components[i].size);	142	printf(" %L: %s image (size %d bytes)\n", components[i].start, components[i].name, components[i].size);
143		143
144	unsigned long top = 0;	144	unsigned long top = 0;
145	for (i = 0; i < COMPONENTS; i++)	145	for (i = 0; i < COMPONENTS; i++)
146	top += ALIGN_UP(components[i].size, PAGE_SIZE);	146	top += ALIGN_UP(components[i].size, PAGE_SIZE);
147		147
148	unsigned long pages = ALIGN_UP(KERNEL_SIZE, PAGE_SIZE) >> PAGE_WIDTH;	148	unsigned long pages = ALIGN_UP(KERNEL_SIZE, PAGE_SIZE) >> PAGE_WIDTH;
149		149
150	for (i = 0; i < pages; i++) {	150	for (i = 0; i < pages; i++) {
151	void *pa = ofw_translate(KERNEL_START + (i << PAGE_WIDTH));	151	void *pa = ofw_translate(KERNEL_START + (i << PAGE_WIDTH));
152	fix_overlap(KERNEL_START + (i << PAGE_WIDTH), &pa, "kernel", &top);	152	fix_overlap(KERNEL_START + (i << PAGE_WIDTH), &pa, "kernel", &top);
153	trans[i] = pa;	153	trans[i] = pa;
154	}	154	}
155		155
156	bootinfo.taskmap.count = 0;	156	bootinfo.taskmap.count = 0;
157	for (i = 1; i < COMPONENTS; i++) {	157	for (i = 1; i < COMPONENTS; i++) {
158	unsigned long component_pages = ALIGN_UP(components[i].size, PAGE_SIZE) >> PAGE_WIDTH;	158	unsigned long component_pages = ALIGN_UP(components[i].size, PAGE_SIZE) >> PAGE_WIDTH;
159	unsigned long j;	159	unsigned long j;
160		160
161	for (j = 0; j < component_pages; j++) {	161	for (j = 0; j < component_pages; j++) {
162	void *pa = ofw_translate(components[i].start + (j << PAGE_WIDTH));	162	void *pa = ofw_translate(components[i].start + (j << PAGE_WIDTH));
163	fix_overlap(components[i].start + (j << PAGE_WIDTH), &pa, components[i].name, &top);	163	fix_overlap(components[i].start + (j << PAGE_WIDTH), &pa, components[i].name, &top);
164	trans[pages + j] = pa;	164	trans[pages + j] = pa;
165	if (j == 0) {	165	if (j == 0) {
166	bootinfo.taskmap.tasks[bootinfo.taskmap.count].addr = (void *) (pages << PAGE_WIDTH);	166	bootinfo.taskmap.tasks[bootinfo.taskmap.count].addr = (void *) (pages << PAGE_WIDTH);
167	bootinfo.taskmap.tasks[bootinfo.taskmap.count].size = components[i].size;	167	bootinfo.taskmap.tasks[bootinfo.taskmap.count].size = components[i].size;
168	bootinfo.taskmap.count++;	168	bootinfo.taskmap.count++;
169	}	169	}
170	}	170	}
171		171
172	pages += component_pages;	172	pages += component_pages;
173	}	173	}
174		174
175	fix_overlap(&real_mode, &real_mode_pa, "bootstrap trampoline", &top);	175	fix_overlap(&real_mode, &real_mode_pa, "bootstrap trampoline", &top);
176	fix_overlap(&trans, &trans_pa, "translation table", &top);	176	fix_overlap(&trans, &trans_pa, "translation table", &top);
177	fix_overlap(&bootinfo, &bootinfo_pa, "boot info", &top);	177	fix_overlap(&bootinfo, &bootinfo_pa, "boot info", &top);
178		178
179	printf("\nBooting the kernel...\n");	179	printf("\nBooting the kernel...\n");
180	jump_to_kernel(bootinfo_pa, sizeof(bootinfo), trans_pa, pages << PAGE_WIDTH, real_mode_pa, (void *) bootinfo.screen.addr, bootinfo.screen.scanline);	180	jump_to_kernel(bootinfo_pa, sizeof(bootinfo), trans_pa, pages << PAGE_WIDTH, real_mode_pa, (void *) bootinfo.screen.addr, bootinfo.screen.scanline);
181	}	181	}
182		182