WebSVN – HelenOS-historic – Diff – /kernel/trunk/generic/src/main/kinit.c


/*
 * Copyright (C) 2001-2004 Jakub Jermar
 * 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/kinit.h>
#include <main/uinit.h>
#include <config.h>
#include <arch.h>
#include <proc/scheduler.h>
#include <proc/task.h>
#include <proc/thread.h>
#include <panic.h>
#include <func.h>
#include <cpu.h>
#include <arch/asm.h>
#include <mm/page.h>
#include <arch/mm/page.h>
#include <mm/as.h>
#include <mm/frame.h>
#include <print.h>
#include <memstr.h>
#include <console/console.h>
#include <interrupt.h>
#include <console/kconsole.h>
 
#ifdef CONFIG_SMP
#include <arch/smp/mps.h>
#endif /* CONFIG_SMP */
 
#include <synch/waitq.h>
#include <synch/spinlock.h>
 
#ifdef CONFIG_TEST
#include <test.h>
#endif /* CONFIG_TEST */
 
/** Kernel initialization thread.
 *
 * kinit takes care of higher level kernel
 * initialization (i.e. thread creation,
 * userspace initialization etc.).
 *
 * @param arg Not used.
 */
void kinit(void *arg)
{
    thread_t *t;
    as_t *as;
    as_area_t *a;
    index_t frame, frames;
    index_t pfn;
    task_t *u;
 
    interrupts_disable();
 
#ifdef CONFIG_SMP           
    if (config.cpu_count > 1) {
        /*
         * Create the kmp thread and wait for its completion.
         * cpu1 through cpuN-1 will come up consecutively and
         * not mess together with kcpulb threads.
         * Just a beautification.
         */
        if ((t = thread_create(kmp, NULL, TASK, 0))) {
            spinlock_lock(&t->lock);
            t->flags |= X_WIRED;
            t->cpu = &cpus[0];
            spinlock_unlock(&t->lock);
            thread_ready(t);
            waitq_sleep(&kmp_completion_wq);
        }
        else panic("thread_create/kmp\n");
    }
#endif /* CONFIG_SMP */
    /*
     * Now that all CPUs are up, we can report what we've found.
     */
    cpu_list();
 
#ifdef CONFIG_SMP
    if (config.cpu_count > 1) {
        int i;
       
        /*
         * For each CPU, create its load balancing thread.
         */
        for (i = 0; i < config.cpu_count; i++) {
 
            if ((t = thread_create(kcpulb, NULL, TASK, 0))) {
                spinlock_lock(&t->lock);           
                t->flags |= X_WIRED;
                t->cpu = &cpus[i];
                spinlock_unlock(&t->lock);
                thread_ready(t);
            }
            else panic("thread_create/kcpulb\n");
 
        }
    }
#endif /* CONFIG_SMP */
 
    /*
     * At this point SMP, if present, is configured.
     */
    arch_post_smp_init();
 
    /*
     * Create kernel console.
     */
    if ((t = thread_create(kconsole, "kconsole", TASK, 0)))
        thread_ready(t);
    else
        panic("thread_create/kconsole\n");
 
    interrupts_enable();
 
    if (config.init_size > 0) {
        /*
         * Create the first user task.
         */
       
        if (KA2PA(config.init_addr) % FRAME_SIZE)
            panic("config.init_addr is not frame aligned");
       
        as = as_create(NULL);
        if (!as)
            panic("as_create\n");
        u = task_create(as);
        if (!u)
            panic("task_create\n");
        t = thread_create(uinit, NULL, u, THREAD_USER_STACK);
        if (!t)
            panic("thread_create\n");
       
        /*
         * Create the text as_area and copy the userspace code there.
         */
       
        frame = KA2PA(config.init_addr) / FRAME_SIZE;
        frames = config.init_size / FRAME_SIZE;
        if (config.init_size % FRAME_SIZE > 0)
            frames++;
       
        a = as_area_create(as, AS_AREA_TEXT, frames, UTEXT_ADDRESS);
        if (!a)
            panic("as_area_create: text\n");
       
 
 
 
 
        for (pfn = 0; pfn < frames; pfn++)
            as_area_set_mapping(a, pfn, frame + pfn);
   
        /*
         * Create the data as_area.
         */
        a = as_area_create(as, AS_AREA_STACK, 1, USTACK_ADDRESS);
        if (!a)
            panic("as_area_create: stack\n");
   
        thread_ready(t);
    }
 
#ifdef CONFIG_TEST
    test();
#endif /* CONFIG_TEST */
 
    if (!stdin) {
        while (1) {
            thread_sleep(1);
            printf("kinit... ");
        }
    }
 
}
 

Rev 717	Rev 718
1	/*	1	/*
2	* Copyright (C) 2001-2004 Jakub Jermar	2	* Copyright (C) 2001-2004 Jakub Jermar
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/kinit.h>	29	#include <main/kinit.h>
30	#include <main/uinit.h>	30	#include <main/uinit.h>
31	#include <config.h>	31	#include <config.h>
32	#include <arch.h>	32	#include <arch.h>
33	#include <proc/scheduler.h>	33	#include <proc/scheduler.h>
34	#include <proc/task.h>	34	#include <proc/task.h>
35	#include <proc/thread.h>	35	#include <proc/thread.h>
36	#include <panic.h>	36	#include <panic.h>
37	#include <func.h>	37	#include <func.h>
38	#include <cpu.h>	38	#include <cpu.h>
39	#include <arch/asm.h>	39	#include <arch/asm.h>
40	#include <mm/page.h>	40	#include <mm/page.h>
41	#include <arch/mm/page.h>	41	#include <arch/mm/page.h>
42	#include <mm/as.h>	42	#include <mm/as.h>
43	#include <mm/frame.h>	43	#include <mm/frame.h>
44	#include <print.h>	44	#include <print.h>
45	#include <memstr.h>	45	#include <memstr.h>
46	#include <console/console.h>	46	#include <console/console.h>
47	#include <interrupt.h>	47	#include <interrupt.h>
48	#include <console/kconsole.h>	48	#include <console/kconsole.h>
49		49
50	#ifdef CONFIG_SMP	50	#ifdef CONFIG_SMP
51	#include <arch/smp/mps.h>	51	#include <arch/smp/mps.h>
52	#endif /* CONFIG_SMP */	52	#endif /* CONFIG_SMP */
53		53
54	#include <synch/waitq.h>	54	#include <synch/waitq.h>
55	#include <synch/spinlock.h>	55	#include <synch/spinlock.h>
56		56
57	#ifdef CONFIG_TEST	57	#ifdef CONFIG_TEST
58	#include <test.h>	58	#include <test.h>
59	#endif /* CONFIG_TEST */	59	#endif /* CONFIG_TEST */
60		60
61	/** Kernel initialization thread.	61	/** Kernel initialization thread.
62	*	62	*
63	* kinit takes care of higher level kernel	63	* kinit takes care of higher level kernel
64	* initialization (i.e. thread creation,	64	* initialization (i.e. thread creation,
65	* userspace initialization etc.).	65	* userspace initialization etc.).
66	*	66	*
67	* @param arg Not used.	67	* @param arg Not used.
68	*/	68	*/
69	void kinit(void *arg)	69	void kinit(void *arg)
70	{	70	{
71	thread_t *t;	71	thread_t *t;
72	as_t *as;	72	as_t *as;
73	as_area_t *a;	73	as_area_t *a;
74	__address frame;	74	index_t frame, frames;
75	index_t pfn[1];	75	index_t pfn;
76	task_t *u;	76	task_t *u;
77		77
78	interrupts_disable();	78	interrupts_disable();
79		79
80	#ifdef CONFIG_SMP	80	#ifdef CONFIG_SMP
81	if (config.cpu_count > 1) {	81	if (config.cpu_count > 1) {
82	/*	82	/*
83	* Create the kmp thread and wait for its completion.	83	* Create the kmp thread and wait for its completion.
84	* cpu1 through cpuN-1 will come up consecutively and	84	* cpu1 through cpuN-1 will come up consecutively and
85	* not mess together with kcpulb threads.	85	* not mess together with kcpulb threads.
86	* Just a beautification.	86	* Just a beautification.
87	*/	87	*/
88	if ((t = thread_create(kmp, NULL, TASK, 0))) {	88	if ((t = thread_create(kmp, NULL, TASK, 0))) {
89	spinlock_lock(&t->lock);	89	spinlock_lock(&t->lock);
90	t->flags \|= X_WIRED;	90	t->flags \|= X_WIRED;
91	t->cpu = &cpus[0];	91	t->cpu = &cpus[0];
92	spinlock_unlock(&t->lock);	92	spinlock_unlock(&t->lock);
93	thread_ready(t);	93	thread_ready(t);
94	waitq_sleep(&kmp_completion_wq);	94	waitq_sleep(&kmp_completion_wq);
95	}	95	}
96	else panic("thread_create/kmp\n");	96	else panic("thread_create/kmp\n");
97	}	97	}
98	#endif /* CONFIG_SMP */	98	#endif /* CONFIG_SMP */
99	/*	99	/*
100	* Now that all CPUs are up, we can report what we've found.	100	* Now that all CPUs are up, we can report what we've found.
101	*/	101	*/
102	cpu_list();	102	cpu_list();
103		103
104	#ifdef CONFIG_SMP	104	#ifdef CONFIG_SMP
105	if (config.cpu_count > 1) {	105	if (config.cpu_count > 1) {
106	int i;	106	int i;
107		107
108	/*	108	/*
109	* For each CPU, create its load balancing thread.	109	* For each CPU, create its load balancing thread.
110	*/	110	*/
111	for (i = 0; i < config.cpu_count; i++) {	111	for (i = 0; i < config.cpu_count; i++) {
112		112
113	if ((t = thread_create(kcpulb, NULL, TASK, 0))) {	113	if ((t = thread_create(kcpulb, NULL, TASK, 0))) {
114	spinlock_lock(&t->lock);	114	spinlock_lock(&t->lock);
115	t->flags \|= X_WIRED;	115	t->flags \|= X_WIRED;
116	t->cpu = &cpus[i];	116	t->cpu = &cpus[i];
117	spinlock_unlock(&t->lock);	117	spinlock_unlock(&t->lock);
118	thread_ready(t);	118	thread_ready(t);
119	}	119	}
120	else panic("thread_create/kcpulb\n");	120	else panic("thread_create/kcpulb\n");
121		121
122	}	122	}
123	}	123	}
124	#endif /* CONFIG_SMP */	124	#endif /* CONFIG_SMP */
125		125
126	/*	126	/*
127	* At this point SMP, if present, is configured.	127	* At this point SMP, if present, is configured.
128	*/	128	*/
129	arch_post_smp_init();	129	arch_post_smp_init();
130		130
131	/*	131	/*
132	* Create kernel console.	132	* Create kernel console.
133	*/	133	*/
134	if ((t = thread_create(kconsole, "kconsole", TASK, 0)))	134	if ((t = thread_create(kconsole, "kconsole", TASK, 0)))
135	thread_ready(t);	135	thread_ready(t);
-		136	else
136	else panic("thread_create/kconsole\n");	137	panic("thread_create/kconsole\n");
137		138
138	interrupts_enable();	139	interrupts_enable();
139		140
140	if (config.init_size > 0) {	141	if (config.init_size > 0) {
141	/*	142	/*
142	* Create the first user task.	143	* Create the first user task.
143	*/	144	*/
-		145
-		146	if (KA2PA(config.init_addr) % FRAME_SIZE)
-		147	panic("config.init_addr is not frame aligned");
-		148
144	as = as_create(NULL);	149	as = as_create(NULL);
145	if (!as)	150	if (!as)
146	panic("as_create\n");	151	panic("as_create\n");
147	u = task_create(as);	152	u = task_create(as);
148	if (!u)	153	if (!u)
149	panic("task_create\n");	154	panic("task_create\n");
150	t = thread_create(uinit, NULL, u, THREAD_USER_STACK);	155	t = thread_create(uinit, NULL, u, THREAD_USER_STACK);
151	if (!t)	156	if (!t)
152	panic("thread_create\n");	157	panic("thread_create\n");
153		158
154	/*	159	/*
155	* Create the text as_area and copy the userspace code there.	160	* Create the text as_area and copy the userspace code there.
156	*/	161	*/
-		162
-		163	frame = KA2PA(config.init_addr) / FRAME_SIZE;
-		164	frames = config.init_size / FRAME_SIZE;
-		165	if (config.init_size % FRAME_SIZE > 0)
-		166	frames++;
-		167
157	a = as_area_create(as, AS_AREA_TEXT, 1, UTEXT_ADDRESS);	168	a = as_area_create(as, AS_AREA_TEXT, frames, UTEXT_ADDRESS);
158	if (!a)	169	if (!a)
159	panic("as_area_create: text\n");	170	panic("as_area_create: text\n");
160		171
161	// FIXME: Better way to initialize static code/data	-
162	frame = frame_alloc(0, ONE_FRAME, NULL);	-
163	memcpy((void ) PA2KA(frame), (void ) config.init_addr, config.init_size < PAGE_SIZE ? config.init_size : PAGE_SIZE);	-
164		-
165	pfn[0] = frame / FRAME_SIZE;	172	for (pfn = 0; pfn < frames; pfn++)
166	as_area_load_mapping(a, pfn);	173	as_area_set_mapping(a, pfn, frame + pfn);
167		174
168	/*	175	/*
169	* Create the data as_area.	176	* Create the data as_area.
170	*/	177	*/
171	a = as_area_create(as, AS_AREA_STACK, 1, USTACK_ADDRESS);	178	a = as_area_create(as, AS_AREA_STACK, 1, USTACK_ADDRESS);
172	if (!a)	179	if (!a)
173	panic("as_area_create: stack\n");	180	panic("as_area_create: stack\n");
174		181
175	thread_ready(t);	182	thread_ready(t);
176	}	183	}
177		184
178	#ifdef CONFIG_TEST	185	#ifdef CONFIG_TEST
179	test();	186	test();
180	#endif /* CONFIG_TEST */	187	#endif /* CONFIG_TEST */
181		188
182	if (!stdin) {	189	if (!stdin) {
183	while (1) {	190	while (1) {
184	thread_sleep(1);	191	thread_sleep(1);
185	printf("kinit... ");	192	printf("kinit... ");
186	}	193	}
187	}	194	}
188		195
189	}	196	}
190		197

Subversion Repositories HelenOS-historic

(root)/kernel/trunk/generic/src/main/kinit.c – Rev 717 → 718