Rev 2283 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed
Rev | Author | Line No. | Line |
---|---|---|---|
1 | jermar | 1 | /* |
2071 | jermar | 2 | * Copyright (c) 2001-2004 Jakub Jermar |
1 | jermar | 3 | * All rights reserved. |
4 | * |
||
5 | * Redistribution and use in source and binary forms, with or without |
||
6 | * modification, are permitted provided that the following conditions |
||
7 | * are met: |
||
8 | * |
||
9 | * - Redistributions of source code must retain the above copyright |
||
10 | * notice, this list of conditions and the following disclaimer. |
||
11 | * - Redistributions in binary form must reproduce the above copyright |
||
12 | * notice, this list of conditions and the following disclaimer in the |
||
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 |
||
15 | * derived from this software without specific prior written permission. |
||
16 | * |
||
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 |
||
19 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
||
20 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
||
21 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
||
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 |
||
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 |
||
26 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
||
27 | */ |
||
28 | |||
1729 | decky | 29 | /** @addtogroup main |
1702 | cejka | 30 | * @{ |
31 | */ |
||
32 | |||
1248 | jermar | 33 | /** |
1702 | cejka | 34 | * @file |
1248 | jermar | 35 | * @brief Main initialization kernel function for all processors. |
36 | * |
||
37 | * During kernel boot, all processors, after architecture dependent |
||
38 | * initialization, start executing code found in this file. After |
||
39 | * bringing up all subsystems, control is passed to scheduler(). |
||
40 | * |
||
41 | * The bootstrap processor starts executing main_bsp() while |
||
42 | * the application processors start executing main_ap(). |
||
43 | * |
||
44 | * @see scheduler() |
||
45 | * @see main_bsp() |
||
46 | * @see main_ap() |
||
47 | */ |
||
48 | |||
1 | jermar | 49 | #include <arch/asm.h> |
97 | jermar | 50 | #include <context.h> |
1 | jermar | 51 | #include <print.h> |
68 | decky | 52 | #include <panic.h> |
561 | decky | 53 | #include <debug.h> |
1 | jermar | 54 | #include <config.h> |
55 | #include <time/clock.h> |
||
2089 | decky | 56 | #include <time/timeout.h> |
1 | jermar | 57 | #include <proc/scheduler.h> |
58 | #include <proc/thread.h> |
||
59 | #include <proc/task.h> |
||
60 | #include <main/kinit.h> |
||
675 | jermar | 61 | #include <main/version.h> |
518 | jermar | 62 | #include <console/kconsole.h> |
1 | jermar | 63 | #include <cpu.h> |
402 | jermar | 64 | #include <align.h> |
578 | palkovsky | 65 | #include <interrupt.h> |
146 | cejka | 66 | #include <arch/mm/memory_init.h> |
1 | jermar | 67 | #include <mm/frame.h> |
68 | #include <mm/page.h> |
||
684 | jermar | 69 | #include <genarch/mm/page_pt.h> |
5 | jermar | 70 | #include <mm/tlb.h> |
703 | jermar | 71 | #include <mm/as.h> |
759 | palkovsky | 72 | #include <mm/slab.h> |
1 | jermar | 73 | #include <synch/waitq.h> |
1109 | jermar | 74 | #include <synch/futex.h> |
210 | decky | 75 | #include <arch/arch.h> |
1 | jermar | 76 | #include <arch.h> |
76 | jermar | 77 | #include <arch/faddr.h> |
955 | palkovsky | 78 | #include <ipc/ipc.h> |
1063 | palkovsky | 79 | #include <macros.h> |
1164 | jermar | 80 | #include <adt/btree.h> |
1595 | palkovsky | 81 | #include <console/klog.h> |
675 | jermar | 82 | #include <smp/smp.h> |
2015 | jermar | 83 | #include <ddi/ddi.h> |
2265 | hudecek | 84 | #include <proc/tasklet.h> |
675 | jermar | 85 | |
1315 | jermar | 86 | /** Global configuration structure. */ |
1757 | jermar | 87 | config_t config; |
675 | jermar | 88 | |
1315 | jermar | 89 | /** Initial user-space tasks */ |
90 | init_t init = { |
||
91 | |||
92 | }; |
||
93 | |||
1894 | jermar | 94 | /** Boot allocations. */ |
95 | ballocs_t ballocs = { |
||
96 | .base = NULL, |
||
97 | .size = 0 |
||
98 | }; |
||
99 | |||
1 | jermar | 100 | context_t ctx; |
101 | |||
1757 | jermar | 102 | /* |
523 | jermar | 103 | * These 'hardcoded' variables will be intialized by |
105 | jermar | 104 | * the linker or the low level assembler code with |
105 | * appropriate sizes and addresses. |
||
1 | jermar | 106 | */ |
2015 | jermar | 107 | uintptr_t hardcoded_load_address = 0; /**< Virtual address of where the kernel |
108 | * is loaded. */ |
||
109 | size_t hardcoded_ktext_size = 0; /**< Size of the kernel code in bytes. |
||
110 | */ |
||
111 | size_t hardcoded_kdata_size = 0; /**< Size of the kernel data in bytes. |
||
112 | */ |
||
113 | uintptr_t stack_safe = 0; /**< Lowest safe stack virtual address. |
||
114 | */ |
||
1 | jermar | 115 | |
116 | void main_bsp(void); |
||
117 | void main_ap(void); |
||
118 | |||
119 | /* |
||
120 | * These two functions prevent stack from underflowing during the |
||
121 | * kernel boot phase when SP is set to the very top of the reserved |
||
122 | * space. The stack could get corrupted by a fooled compiler-generated |
||
123 | * pop sequence otherwise. |
||
124 | */ |
||
125 | static void main_bsp_separated_stack(void); |
||
625 | palkovsky | 126 | #ifdef CONFIG_SMP |
1 | jermar | 127 | static void main_ap_separated_stack(void); |
625 | palkovsky | 128 | #endif |
1 | jermar | 129 | |
2048 | jermar | 130 | #define CONFIG_STACK_SIZE ((1 << STACK_FRAMES) * STACK_SIZE) |
1138 | jermar | 131 | |
1229 | jermar | 132 | /** Main kernel routine for bootstrap CPU. |
108 | decky | 133 | * |
134 | * Initializes the kernel by bootstrap CPU. |
||
675 | jermar | 135 | * This function passes control directly to |
136 | * main_bsp_separated_stack(). |
||
108 | decky | 137 | * |
413 | jermar | 138 | * Assuming interrupts_disable(). |
108 | decky | 139 | * |
1 | jermar | 140 | */ |
141 | void main_bsp(void) |
||
142 | { |
||
143 | config.cpu_count = 1; |
||
144 | config.cpu_active = 1; |
||
651 | decky | 145 | |
369 | jermar | 146 | config.base = hardcoded_load_address; |
147 | config.memory_size = get_memory_size(); |
||
210 | decky | 148 | |
2015 | jermar | 149 | config.kernel_size = ALIGN_UP(hardcoded_ktext_size + |
2087 | jermar | 150 | hardcoded_kdata_size, PAGE_SIZE); |
1833 | decky | 151 | config.stack_size = CONFIG_STACK_SIZE; |
1037 | decky | 152 | |
1833 | decky | 153 | /* Initialy the stack is placed just after the kernel */ |
154 | config.stack_base = config.base + config.kernel_size; |
||
155 | |||
156 | /* Avoid placing stack on top of init */ |
||
1037 | decky | 157 | count_t i; |
1833 | decky | 158 | for (i = 0; i < init.cnt; i++) { |
2015 | jermar | 159 | if (PA_overlaps(config.stack_base, config.stack_size, |
2087 | jermar | 160 | init.tasks[i].addr, init.tasks[i].size)) |
2015 | jermar | 161 | config.stack_base = ALIGN_UP(init.tasks[i].addr + |
2087 | jermar | 162 | init.tasks[i].size, config.stack_size); |
1833 | decky | 163 | } |
1894 | jermar | 164 | |
165 | /* Avoid placing stack on top of boot allocations. */ |
||
166 | if (ballocs.size) { |
||
2015 | jermar | 167 | if (PA_overlaps(config.stack_base, config.stack_size, |
2087 | jermar | 168 | ballocs.base, ballocs.size)) |
2015 | jermar | 169 | config.stack_base = ALIGN_UP(ballocs.base + |
2087 | jermar | 170 | ballocs.size, PAGE_SIZE); |
1894 | jermar | 171 | } |
1037 | decky | 172 | |
1833 | decky | 173 | if (config.stack_base < stack_safe) |
174 | config.stack_base = ALIGN_UP(stack_safe, PAGE_SIZE); |
||
210 | decky | 175 | |
47 | jermar | 176 | context_save(&ctx); |
2015 | jermar | 177 | context_set(&ctx, FADDR(main_bsp_separated_stack), config.stack_base, |
2087 | jermar | 178 | THREAD_STACK_SIZE); |
47 | jermar | 179 | context_restore(&ctx); |
1 | jermar | 180 | /* not reached */ |
181 | } |
||
182 | |||
108 | decky | 183 | |
1229 | jermar | 184 | /** Main kernel routine for bootstrap CPU using new stack. |
108 | decky | 185 | * |
186 | * Second part of main_bsp(). |
||
187 | * |
||
188 | */ |
||
174 | jermar | 189 | void main_bsp_separated_stack(void) |
190 | { |
||
1 | jermar | 191 | task_t *k; |
192 | thread_t *t; |
||
1109 | jermar | 193 | count_t i; |
207 | decky | 194 | |
184 | jermar | 195 | the_initialize(THE); |
1109 | jermar | 196 | |
517 | jermar | 197 | /* |
198 | * kconsole data structures must be initialized very early |
||
199 | * because other subsystems will register their respective |
||
200 | * commands. |
||
201 | */ |
||
202 | kconsole_init(); |
||
1037 | decky | 203 | |
756 | jermar | 204 | /* |
205 | * Exception handler initialization, before architecture |
||
673 | jermar | 206 | * starts adding its own handlers |
578 | palkovsky | 207 | */ |
208 | exc_init(); |
||
755 | jermar | 209 | |
210 | /* |
||
211 | * Memory management subsystems initialization. |
||
212 | */ |
||
26 | jermar | 213 | arch_pre_mm_init(); |
2015 | jermar | 214 | frame_init(); |
215 | /* Initialize at least 1 memory segment big enough for slab to work. */ |
||
789 | palkovsky | 216 | slab_cache_init(); |
1164 | jermar | 217 | btree_init(); |
756 | jermar | 218 | as_init(); |
23 | jermar | 219 | page_init(); |
220 | tlb_init(); |
||
2015 | jermar | 221 | ddi_init(); |
2260 | hudecek | 222 | tasklet_init(); |
1434 | palkovsky | 223 | arch_post_mm_init(); |
1101 | jermar | 224 | |
673 | jermar | 225 | version_print(); |
2015 | jermar | 226 | printf("kernel: %.*p hardcoded_ktext_size=%zdK, " |
2087 | jermar | 227 | "hardcoded_kdata_size=%zdK\n", sizeof(uintptr_t) * 2, |
228 | config.base, hardcoded_ktext_size >> 10, |
||
229 | hardcoded_kdata_size >> 10); |
||
2015 | jermar | 230 | printf("stack: %.*p size=%zdK\n", sizeof(uintptr_t) * 2, |
2087 | jermar | 231 | config.stack_base, config.stack_size >> 10); |
1 | jermar | 232 | |
503 | jermar | 233 | arch_pre_smp_init(); |
34 | jermar | 234 | smp_init(); |
2015 | jermar | 235 | /* Slab must be initialized after we know the number of processors. */ |
236 | slab_enable_cpucache(); |
||
773 | palkovsky | 237 | |
1389 | decky | 238 | printf("config.memory_size=%zdM\n", config.memory_size >> 20); |
1196 | cejka | 239 | printf("config.cpu_count=%zd\n", config.cpu_count); |
1 | jermar | 240 | cpu_init(); |
2292 | hudecek | 241 | |
1 | jermar | 242 | calibrate_delay_loop(); |
1434 | palkovsky | 243 | clock_counter_init(); |
1 | jermar | 244 | timeout_init(); |
245 | scheduler_init(); |
||
246 | task_init(); |
||
247 | thread_init(); |
||
1109 | jermar | 248 | futex_init(); |
1595 | palkovsky | 249 | klog_init(); |
628 | decky | 250 | |
1826 | decky | 251 | if (init.cnt > 0) { |
252 | for (i = 0; i < init.cnt; i++) |
||
2015 | jermar | 253 | printf("init[%zd].addr=%.*p, init[%zd].size=%zd\n", i, |
2087 | jermar | 254 | sizeof(uintptr_t) * 2, init.tasks[i].addr, i, |
255 | init.tasks[i].size); |
||
1826 | decky | 256 | } else |
1999 | decky | 257 | printf("No init binaries found\n"); |
2292 | hudecek | 258 | |
955 | palkovsky | 259 | ipc_init(); |
1109 | jermar | 260 | |
1 | jermar | 261 | /* |
262 | * Create kernel task. |
||
263 | */ |
||
2039 | decky | 264 | k = task_create(AS_KERNEL, "kernel"); |
210 | decky | 265 | if (!k) |
266 | panic("can't create kernel task\n"); |
||
860 | decky | 267 | |
1 | jermar | 268 | /* |
269 | * Create the first thread. |
||
270 | */ |
||
2042 | decky | 271 | t = thread_create(kinit, NULL, k, 0, "kinit", true); |
210 | decky | 272 | if (!t) |
273 | panic("can't create kinit thread\n"); |
||
1 | jermar | 274 | thread_ready(t); |
2292 | hudecek | 275 | |
276 | tasklet_run_tasklet_thread(k); |
||
2260 | hudecek | 277 | |
1 | jermar | 278 | /* |
279 | * This call to scheduler() will return to kinit, |
||
280 | * starting the thread of kernel threads. |
||
281 | */ |
||
282 | scheduler(); |
||
283 | /* not reached */ |
||
284 | } |
||
285 | |||
108 | decky | 286 | |
458 | decky | 287 | #ifdef CONFIG_SMP |
1229 | jermar | 288 | /** Main kernel routine for application CPUs. |
108 | decky | 289 | * |
290 | * Executed by application processors, temporary stack |
||
1901 | jermar | 291 | * is at ctx.sp which was set during BSP boot. |
675 | jermar | 292 | * This function passes control directly to |
293 | * main_ap_separated_stack(). |
||
108 | decky | 294 | * |
413 | jermar | 295 | * Assuming interrupts_disable()'d. |
108 | decky | 296 | * |
1 | jermar | 297 | */ |
298 | void main_ap(void) |
||
299 | { |
||
300 | /* |
||
301 | * Incrementing the active CPU counter will guarantee that the |
||
1901 | jermar | 302 | * *_init() functions can find out that they need to |
303 | * do initialization for AP only. |
||
1 | jermar | 304 | */ |
305 | config.cpu_active++; |
||
306 | |||
192 | jermar | 307 | /* |
308 | * The THE structure is well defined because ctx.sp is used as stack. |
||
309 | */ |
||
310 | the_initialize(THE); |
||
298 | decky | 311 | |
26 | jermar | 312 | arch_pre_mm_init(); |
1 | jermar | 313 | frame_init(); |
314 | page_init(); |
||
389 | jermar | 315 | tlb_init(); |
26 | jermar | 316 | arch_post_mm_init(); |
298 | decky | 317 | |
1 | jermar | 318 | cpu_init(); |
319 | calibrate_delay_loop(); |
||
1901 | jermar | 320 | arch_post_cpu_init(); |
1 | jermar | 321 | |
192 | jermar | 322 | the_copy(THE, (the_t *) CPU->stack); |
1 | jermar | 323 | |
324 | /* |
||
325 | * If we woke kmp up before we left the kernel stack, we could |
||
326 | * collide with another CPU coming up. To prevent this, we |
||
327 | * switch to this cpu's private stack prior to waking kmp up. |
||
328 | */ |
||
2015 | jermar | 329 | context_set(&CPU->saved_context, FADDR(main_ap_separated_stack), |
2087 | jermar | 330 | (uintptr_t) CPU->stack, CPU_STACK_SIZE); |
47 | jermar | 331 | context_restore(&CPU->saved_context); |
1 | jermar | 332 | /* not reached */ |
333 | } |
||
334 | |||
108 | decky | 335 | |
1229 | jermar | 336 | /** Main kernel routine for application CPUs using new stack. |
108 | decky | 337 | * |
338 | * Second part of main_ap(). |
||
339 | * |
||
340 | */ |
||
1 | jermar | 341 | void main_ap_separated_stack(void) |
342 | { |
||
343 | /* |
||
344 | * Configure timeouts for this cpu. |
||
345 | */ |
||
346 | timeout_init(); |
||
347 | |||
348 | waitq_wakeup(&ap_completion_wq, WAKEUP_FIRST); |
||
349 | scheduler(); |
||
350 | /* not reached */ |
||
351 | } |
||
458 | decky | 352 | #endif /* CONFIG_SMP */ |
1702 | cejka | 353 | |
1729 | decky | 354 | /** @} |
1702 | cejka | 355 | */ |