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