Diff markup
001 001
>> 002
002 003
003 004
004 005
005 006
006 007
007 008
008 009
009 010
010 011
011 012
012 013
013 014
014 015
015 016
016 017
017 018
018 019
019 #include <sos/errno.h> <<
020 <<
021 020
022 #include <bootstrap/multiboot.h> 021 #include <bootstrap/multiboot.h>
023 #include <hwcore/idt.h> 022 #include <hwcore/idt.h>
024 #include <hwcore/gdt.h> 023 #include <hwcore/gdt.h>
025 #include <hwcore/irq.h> 024 #include <hwcore/irq.h>
026 #include <hwcore/exception.h> 025 #include <hwcore/exception.h>
027 #include <hwcore/i8254.h> 026 #include <hwcore/i8254.h>
028 #include <sos/list.h> 027 #include <sos/list.h>
029 #include <sos/physmem.h> 028 #include <sos/physmem.h>
030 #include <hwcore/paging.h> <<
031 #include <hwcore/mm_context.h> <<
032 #include <hwcore/swintr.h> <<
033 #include <sos/kmem_vmm.h> <<
034 #include <sos/kmalloc.h> <<
035 #include <sos/time.h> <<
036 #include <sos/thread.h> <<
037 #include <sos/process.h> <<
038 #include <sos/umem_vmm.h> <<
039 #include <sos/klibc.h> 029 #include <sos/klibc.h>
040 #include <sos/assert.h> 030 #include <sos/assert.h>
041 #include <drivers/x86_videomem.h> 031 #include <drivers/x86_videomem.h>
042 #include <drivers/bochs.h> 032 #include <drivers/bochs.h>
043 #include <sos/calcload.h> !! 033
044 #include <sos/umem_vmm.h> <<
045 #include <sos/binfmt_elf32.h> <<
046 #include <drivers/zero.h> <<
047 #include <sos/fs.h> <<
048 #include <drivers/fs_virtfs.h> <<
049 034
050 035
051 036
052 void display_bits(unsigned char row, unsigned !! 037 static void display_bits(unsigned char row, unsigned char col,
053 unsigned char attribute, !! 038 unsigned char attribute,
054 sos_ui32_t integer) !! 039 sos_ui32_t integer)
055 { 040 {
056 int i; 041 int i;
057 042
058 for (i = 31 ; i >= 0 ; i--) 043 for (i = 31 ; i >= 0 ; i--)
059 { 044 {
060 045
061 int bit_i = (integer & (1 << i)); 046 int bit_i = (integer & (1 << i));
062 047
063 unsigned char ascii_code = bit_i?219:177 048 unsigned char ascii_code = bit_i?219:177;
064 sos_x86_videomem_putchar(row, col++, 049 sos_x86_videomem_putchar(row, col++,
065 attribute, 050 attribute,
066 ascii_code); 051 ascii_code);
067 } 052 }
068 } 053 }
069 054
>> 055
070 056
071 static void clk_it(int intid) 057 static void clk_it(int intid)
072 { 058 {
073 static sos_ui32_t clock_count = 0; 059 static sos_ui32_t clock_count = 0;
074 060
075 display_bits(0, 48, 061 display_bits(0, 48,
076 SOS_X86_VIDEO_FG_LTGREEN | SOS_ 062 SOS_X86_VIDEO_FG_LTGREEN | SOS_X86_VIDEO_BG_BLUE,
077 clock_count); 063 clock_count);
078 clock_count++; 064 clock_count++;
079 065
080 <<
081 sos_time_do_tick(); <<
082 <<
083 <<
084 sos_sched_do_timer_tick(); <<
085 } 066 }
086 067
087 !! 068 #define MY_PPAGE_NUM_INT 511
088 !! 069 struct my_ppage
089 <<
090 <<
091 <<
092 <<
093 <<
094 static void pgflt_ex(int intid, struct sos_cpu <<
095 { 070 {
096 static sos_ui32_t demand_paging_count = 0; !! 071 sos_ui32_t before[MY_PPAGE_NUM_INT];
097 struct sos_thread * cur_thr = sos_thread_get !! 072 struct my_ppage *prev, *next;
098 sos_vaddr_t faulting_vaddr = sos_cpu_contex !! 073 sos_ui32_t after[MY_PPAGE_NUM_INT];
099 sos_paddr_t ppage_paddr; !! 074 };
100 !! 075
101 if (sos_cpu_context_is_in_user_mode(ctxt) !! 076 static void test_physmem()
102 || (cur_thr->fixup_uaccess.return_vaddr) !! 077 {
>> 078
>> 079 struct my_ppage *ppage_list, *my_ppage;
>> 080 sos_count_t num_alloc_ppages = 0, num_free_ppages = 0;
>> 081
>> 082 ppage_list = NULL;
>> 083 while ((my_ppage = (struct my_ppage*)sos_physmem_ref_physpage_new(FALSE))
>> 084 != NULL)
103 { 085 {
104 __label__ unforce_address_space; !! 086 int i;
105 sos_bool_t need_to_setup_mmu; !! 087 num_alloc_ppages++;
106 sos_ui32_t errcode = sos_cpu_context_get !! 088
107 !! 089
108 !! 090 sos_x86_videomem_printf(2, 0,
109 !! 091 SOS_X86_VIDEO_FG_YELLOW
110 need_to_setup_mmu = (cur_thr->squatted_m !! 092 | SOS_X86_VIDEO_BG_BLUE,
111 != sos_process_get_ !! 093 "Could allocate %d pages ",
112 if (need_to_setup_mmu) !! 094 num_alloc_ppages);
113 sos_thread_prepare_user_space_access(N !! 095
114 !! 096
115 if (SOS_OK == !! 097 for (i = 0 ; i < MY_PPAGE_NUM_INT ; i++)
116 sos_umem_vmm_try_resolve_page_fault( !! 098 my_ppage->before[i] = my_ppage->after[i] = (sos_ui32_t)my_ppage;
117 !! 099
118 !! 100
119 goto unforce_address_space; !! 101 list_add_tail(ppage_list, my_ppage);
120 !! 102 }
121 !! 103
122 !! 104
123 if (! sos_cpu_context_is_in_user_mode(ct !! 105 while ((my_ppage = list_pop_head(ppage_list)) != NULL)
>> 106 {
>> 107
>> 108
>> 109 int i;
>> 110 for (i = 0 ; i < MY_PPAGE_NUM_INT ; i++)
124 { 111 {
125 cur_thr->fixup_uaccess.faulted_uaddr !! 112
126 sos_cpu_context_set_EX_return_addres !! 113 if ((my_ppage->before[i] != (sos_ui32_t)my_ppage)
127 !! 114 || (my_ppage->after[i] != (sos_ui32_t)my_ppage))
128 goto unforce_address_space; !! 115 {
>> 116
>> 117 sos_x86_videomem_putstring(20, 0,
>> 118 SOS_X86_VIDEO_FG_LTRED
>> 119 | SOS_X86_VIDEO_BG_BLUE,
>> 120 "Page overwritten");
>> 121 return;
>> 122 }
129 } 123 }
130 124
131 if (need_to_setup_mmu) !! 125
132 sos_thread_end_user_space_access(); !! 126 if (sos_physmem_unref_physpage((sos_paddr_t)my_ppage) < 0)
133 !! 127 {
134 sos_bochs_printf("Unresolved USER page F !! 128
135 sos_cpu_context_get_PC( !! 129 sos_x86_videomem_putstring(20, 0,
136 (unsigned)faulting_vadd !! 130 SOS_X86_VIDEO_FG_LTRED
137 (unsigned)sos_cpu_conte !! 131 | SOS_X86_VIDEO_BG_BLUE,
138 sos_bochs_printf("Terminating User threa !! 132 "Cannot release page");
139 sos_thread_exit(); !! 133 return;
140 !! 134 }
141 unforce_address_space: <<
142 if (need_to_setup_mmu) <<
143 sos_thread_end_user_space_access(); <<
144 return; <<
145 } <<
146 <<
147 <<
148 if (! sos_kmem_vmm_is_valid_vaddr(faulting_v <<
149 { <<
150 <<
151 <<
152 sos_display_fatal_error("Unresolved page <<
153 sos_cpu_context_ <<
154 (unsigned)faulti <<
155 (unsigned)sos_cp <<
156 SOS_ASSERT_FATAL(! "Got page fault (note <<
157 } <<
158 <<
159 <<
160 <<
161 <<
162 <<
163 <<
164 <<
165 demand_paging_count ++; <<
166 display_bits(0, 0, <<
167 SOS_X86_VIDEO_FG_LTRED | SOS_X8 <<
168 demand_paging_count); <<
169 <<
170 <<
171 ppage_paddr = sos_physmem_ref_physpage_new(F <<
172 if (! ppage_paddr) <<
173 SOS_ASSERT_FATAL(! "TODO: implement swap. <<
174 SOS_ASSERT_FATAL(SOS_OK == sos_paging_map(pp <<
175 SO <<
176 FA <<
177 SO <<
178 | <<
179 | <<
180 sos_physmem_unref_physpage(ppage_paddr); <<
181 <<
182 <<
183 } <<
184 <<
185 <<
186 <<
187 <<
188 <<
189 <<
190 <<
191 static void idle_thread() <<
192 { <<
193 sos_ui32_t idle_twiddle = 0; <<
194 <<
195 while (1) <<
196 { <<
197 <<
198 <<
199 asm("hlt\n"); <<
200 <<
201 idle_twiddle ++; <<
202 display_bits(0, 0, SOS_X86_VIDEO_FG_GREE <<
203 idle_twiddle); <<
204 <<
205 <<
206 sos_thread_yield(); <<
207 } <<
208 } <<
209 <<
210 <<
211 <<
212 <<
213 <<
214 static void stat_thread() <<
215 { <<
216 while (1) <<
217 { <<
218 sos_ui32_t flags; <<
219 sos_ui32_t load1, load5, load15; <<
220 char str1[11], str5[11], str15[11]; <<
221 struct sos_time t; <<
222 t.sec = 1; <<
223 t.nanosec = 0; <<
224 <<
225 sos_thread_sleep(& t); <<
226 <<
227 sos_disable_IRQs(flags); <<
228 <<
229 <<
230 sos_load_get_sload(&load1, &load5, &load <<
231 sos_load_to_string(str1, load1); <<
232 sos_load_to_string(str5, load5); <<
233 sos_load_to_string(str15, load15); <<
234 sos_x86_videomem_printf(16, 34, <<
235 SOS_X86_VIDEO_FG <<
236 "Kernel (- Idle) <<
237 str1, str5, str1 <<
238 <<
239 sos_load_get_uload(&load1, &load5, &load <<
240 sos_load_to_string(str1, load1); <<
241 sos_load_to_string(str5, load5); <<
242 sos_load_to_string(str15, load15); <<
243 sos_x86_videomem_printf(17, 34, <<
244 SOS_X86_VIDEO_FG <<
245 "User: %s %s %s <<
246 str1, str5, str1 <<
247 <<
248 sos_load_get_uratio(&load1, &load5, &loa <<
249 sos_load_to_string(str1, load1); <<
250 sos_load_to_string(str5, load5); <<
251 sos_load_to_string(str15, load15); <<
252 sos_x86_videomem_printf(18, 34, <<
253 SOS_X86_VIDEO_FG <<
254 "User CPU %%: %s <<
255 str1, str5, str1 <<
256 <<
257 <<
258 sos_load_get_sratio(&load1, &load5, &loa <<
259 sos_load_to_string(str1, load1); <<
260 sos_load_to_string(str5, load5); <<
261 sos_load_to_string(str15, load15); <<
262 sos_x86_videomem_printf(19, 34, <<
263 SOS_X86_VIDEO_FG <<
264 "Kernel CPU %% ( <<
265 str1, str5, str1 <<
266 sos_restore_IRQs(flags); <<
267 } <<
268 } <<
269 <<
270 <<
271 <<
272 <<
273 <<
274 static sos_ret_t <<
275 start_init(struct sos_fs_manager_instance * ro <<
276 { <<
277 sos_ret_t retval; <<
278 struct sos_umem_vmm_as *as_init; <<
279 struct sos_process *proc_init; <<
280 struct sos_thread *new_thr; <<
281 sos_uaddr_t ustack, start_uaddr; <<
282 struct sos_fs_opened_file * init_root, * ini <<
283 <<
284 <<
285 proc_init = sos_process_create("init", FALSE <<
286 if (! proc_init) <<
287 return -SOS_ENOMEM; <<
288 as_init = sos_process_get_address_space(proc <<
289 <<
290 <<
291 <<
292 <<
293 <<
294 <<
295 <<
296 retval = sos_fs_new_opened_file(proc_init, r <<
297 SOS_FS_OPEN_ <<
298 & init_root) <<
299 if (SOS_OK != retval) <<
300 { <<
301 sos_process_unref(proc_init); <<
302 return -SOS_ENOENT; <<
303 } <<
304 <<
305 <<
306 <<
307 retval = sos_fs_duplicate_opened_file(init_r <<
308 & init <<
309 if (SOS_OK != retval) <<
310 { <<
311 sos_fs_close(init_root); <<
312 sos_process_unref(proc_init); <<
313 return -SOS_ENOENT; <<
314 } <<
315 <<
316 <<
317 if ( ( SOS_OK != sos_process_chroot(proc_ini <<
318 || ( SOS_OK != sos_process_chdir(proc_i <<
319 { <<
320 sos_fs_close(init_root); <<
321 sos_fs_close(init_cwd); <<
322 sos_process_chroot(proc_init, NULL, & un <<
323 sos_process_chdir(proc_init, NULL, & unu <<
324 sos_process_unref(proc_init); <<
325 return -SOS_ENOENT; <<
326 } <<
327 <<
328 <<
329 start_uaddr = sos_binfmt_elf32_map(as_init, <<
330 if (0 == start_uaddr) <<
331 { <<
332 sos_process_unref(proc_init); <<
333 return -SOS_ENOENT; <<
334 } <<
335 135
336 !! 136
337 ustack = (SOS_PAGING_TOP_USER_ADDRESS - SOS_ !! 137 num_free_ppages ++;
338 retval = sos_dev_zero_map(as_init, &ustack, !! 138 sos_x86_videomem_printf(2, 0,
339 SOS_VM_MAP_PROT_RE !! 139 SOS_X86_VIDEO_FG_YELLOW
340 0); !! 140 | SOS_X86_VIDEO_BG_BLUE,
341 if (SOS_OK != retval) !! 141 "Could free %d pages ",
342 { !! 142 num_free_ppages);
343 sos_process_unref(proc_init); <<
344 return -SOS_ENOMEM; <<
345 } 143 }
346 144
347 !! 145
348 new_thr = sos_create_user_thread(NULL, !! 146 sos_x86_videomem_printf(2, 0,
349 proc_init, !! 147 SOS_X86_VIDEO_FG_LTGREEN
350 start_uaddr !! 148 | SOS_X86_VIDEO_BG_BLUE,
351 0, 0, !! 149 "Could allocate %d bytes, could free %d bytes ",
352 ustack + SO !! 150 num_alloc_ppages << SOS_PAGE_SHIFT,
353 SOS_SCHED_P !! 151 num_free_ppages << SOS_PAGE_SHIFT);
354 if (! new_thr) <<
355 { <<
356 sos_process_unref(proc_init); <<
357 return -SOS_ENOMEM; <<
358 } <<
359 152
360 sos_process_unref(proc_init); !! 153 SOS_ASSERT_FATAL(num_alloc_ppages == num_free_ppages);
361 return SOS_OK; <<
362 } 154 }
363 155
364 156
365 !! 157
366 !! 158 void sos_main(unsigned long magic, unsigned long addr)
367 <<
368 void sos_main(unsigned long magic, unsigned lo <<
369 { 159 {
370 unsigned i; 160 unsigned i;
371 sos_paddr_t sos_kernel_core_base_paddr, sos_ 161 sos_paddr_t sos_kernel_core_base_paddr, sos_kernel_core_top_paddr;
372 struct sos_time tick_resolution; <<
373 struct sos_fs_manager_instance * rootfs; <<
374 162
375 !! 163
376 unsigned long int upper_mem = 0; !! 164
>> 165
>> 166 multiboot_info_t *mbi;
>> 167 mbi = (multiboot_info_t *) addr;
377 168
378 169
379 sos_bochs_setup(); 170 sos_bochs_setup();
380 171
381 sos_x86_videomem_setup(); 172 sos_x86_videomem_setup();
382 sos_x86_videomem_cls(SOS_X86_VIDEO_BG_BLUE); 173 sos_x86_videomem_cls(SOS_X86_VIDEO_BG_BLUE);
383 174
384 175
385 if (magic == MULTIBOOT_BOOTLOADER_MAGIC) 176 if (magic == MULTIBOOT_BOOTLOADER_MAGIC)
386 { !! 177
387 !! 178 sos_x86_videomem_printf(1, 0,
388 !! 179 SOS_X86_VIDEO_FG_YELLOW | SOS_X86_VIDEO_BG_BLUE,
389 !! 180 "Welcome From GRUB to %s%c RAM is %dMB (upper mem = 0x%x kB)",
390 multiboot_info_t *mbi = (multiboot_info_ !! 181 "SOS", ',',
391 !! 182 (unsigned)(mbi->mem_upper >> 10) + 1,
392 !! 183 (unsigned)mbi->mem_upper);
393 <<
394 <<
395 <<
396 upper_mem = mbi->mem_upper; <<
397 sos_x86_videomem_printf(1, 0, <<
398 SOS_X86_VIDEO_FG <<
399 "Welcome From GR <<
400 "SOS article 8", <<
401 (unsigned)(upper <<
402 (unsigned)upper_ <<
403 } <<
404 else if (magic == 0x42244224) <<
405 { <<
406 <<
407 upper_mem = arg; <<
408 sos_x86_videomem_printf(1, 0, <<
409 SOS_X86_VIDEO_FG <<
410 "Welcome to %s%c <<
411 "SOS article 8", <<
412 (unsigned)(upper <<
413 (unsigned)upper_ <<
414 } <<
415 else 184 else
416 !! 185
417 sos_x86_videomem_printf(1, 0, 186 sos_x86_videomem_printf(1, 0,
418 SOS_X86_VIDEO_FG_Y 187 SOS_X86_VIDEO_FG_YELLOW | SOS_X86_VIDEO_BG_BLUE,
419 "Welcome to SOS ar !! 188 "Welcome to SOS");
420 189
421 sos_bochs_putstring("Message in a bochs: Thi !! 190 sos_bochs_putstring("Message in a bochs\n");
422 191
423 192
424 sos_gdt_subsystem_setup(); !! 193 sos_gdt_setup();
425 sos_idt_subsystem_setup(); !! 194 sos_idt_setup();
426 195
427 196
428 sos_exception_subsystem_setup(); !! 197 sos_exceptions_setup();
429 sos_irq_subsystem_setup(); !! 198 sos_irq_setup();
430 199
431 200
432 sos_i8254_set_frequency(100); 201 sos_i8254_set_frequency(100);
433 202
434 <<
435 <<
436 tick_resolution = (struct sos_time) { .sec=0 <<
437 sos_time_subsysem_setup(& tick_resolution); <<
438 203
439 !! 204
440 if (upper_mem == 0) !! 205 if (magic != MULTIBOOT_BOOTLOADER_MAGIC)
441 { 206 {
442 sos_x86_videomem_putstring(20, 0, 207 sos_x86_videomem_putstring(20, 0,
443 SOS_X86_VIDEO 208 SOS_X86_VIDEO_FG_LTRED
444 | SOS_X86_V 209 | SOS_X86_VIDEO_BG_BLUE
445 | SOS_X86_V 210 | SOS_X86_VIDEO_FG_BLINKING,
446 "I don't know !! 211 "I'm not loaded with Grub !");
447 212
448 for (;;) 213 for (;;)
449 continue; 214 continue;
450 } 215 }
451 216
452 <<
453 <<
454 <<
455 <<
456 217
457 sos_irq_set_routine(SOS_IRQ_TIMER, 218 sos_irq_set_routine(SOS_IRQ_TIMER,
458 clk_it); !! 219 clk_it);
459 <<
460 <<
461 <<
462 <<
463 <<
464 SOS_ASSERT_FATAL(SOS_OK <<
465 == sos_physmem_subsystem_se <<
466 <<
467 <<
468 <<
469 <<
470 <<
471 <<
472 <<
473 <<
474 <<
475 SOS_ASSERT_FATAL(SOS_OK == <<
476 sos_paging_subsystem_setup( <<
477 <<
478 <<
479 <<
480 sos_exception_set_routine(SOS_EXCEPT_PAGE_FA <<
481 pgflt_ex); <<
482 <<
483 <<
484 <<
485 <<
486 <<
487 if (sos_kmem_vmm_subsystem_setup(sos_kernel_ <<
488 sos_kernel_ <<
489 bootstrap_s <<
490 bootstrap_s <<
491 + bootstrap <<
492 sos_bochs_printf("Could not setup the Kern <<
493 <<
494 if (sos_kmalloc_subsystem_setup()) <<
495 sos_bochs_printf("Could not setup the Kmal <<
496 <<
497 <<
498 <<
499 <<
500 sos_mm_context_subsystem_setup(); <<
501 <<
502 <<
503 <<
504 <<
505 sos_cpu_context_subsystem_setup(); <<
506 <<
507 <<
508 <<
509 <<
510 sos_swintr_subsystem_setup(); <<
511 <<
512 <<
513 <<
514 <<
515 <<
516 <<
517 <<
518 sos_thread_subsystem_setup(bootstrap_stack_b <<
519 bootstrap_stack_s <<
520 <<
521 <<
522 sos_sched_subsystem_setup(); <<
523 <<
524 <<
525 SOS_ASSERT_FATAL(sos_create_kernel_thread("i <<
526 SO <<
527 <<
528 <<
529 sos_load_subsystem_setup(); <<
530 <<
531 <<
532 SOS_ASSERT_FATAL(sos_create_kernel_thread("s <<
533 NU <<
534 SO <<
535 <<
536 <<
537 <<
538 <<
539 <<
540 sos_umem_vmm_subsystem_setup(); <<
541 sos_dev_zero_subsystem_setup(); <<
542 <<
543 <<
544 <<
545 <<
546 sos_process_subsystem_setup(); <<
547 <<
548 <<
549 220
550 !! 221
551 asm volatile ("sti\n"); 222 asm volatile ("sti\n");
>> 223
>> 224
>> 225
>> 226 sos_physmem_setup((mbi->mem_upper<<10) + (1<<20),
>> 227 & sos_kernel_core_base_paddr,
>> 228 & sos_kernel_core_top_paddr);
>> 229 test_physmem();
>> 230
>> 231
>> 232 for (;;)
>> 233 continue;
552 234
553 !! 235 return;
554 SOS_ASSERT_FATAL(SOS_OK == sos_fs_virtfs_sub <<
555 SOS_ASSERT_FATAL(SOS_OK == sos_fs_subsystem_ <<
556 <<
557 <<
558 <<
559 <<
560 <<
561 <<
562 <<
563 start_init(rootfs); <<
564 <<
565 <<
566 <<
567 <<
568 <<
569 <<
570 <<
571 <<
572 <<
573 <<
574 <<
575 <<
576 sos_bochs_printf("Bye from primary thread !\ <<
577 sos_thread_exit(); <<
578 SOS_FATAL_ERROR("No trespassing !"); <<
579 } 236 }