lunaix-os/kernel/asm/x86/pfault.c

   1 #include <arch/x86/interrupts.h>
   2 #include <lunaix/common.h>
   3 #include <lunaix/mm/mm.h>
   4 #include <lunaix/mm/pmm.h>
   5 #include <lunaix/mm/region.h>
   6 #include <lunaix/mm/vmm.h>
   7 #include <lunaix/sched.h>
   8 #include <lunaix/status.h>
   9 #include <lunaix/syslog.h>
  10
  11 static void
  12 kprintf(const char* fmt, ...)
  13 {
  14     va_list args;
  15     va_start(args, fmt);
  16     __kprintf("PFAULT", fmt, args);
  17     va_end(args);
  18 }
  19
  20 #define COW_MASK (REGION_RSHARED | REGION_READ | REGION_WRITE)
  21
  22 extern void
  23 __print_panic_msg(const char* msg, const isr_param* param);
  24
  25 void
  26 intr_routine_page_fault(const isr_param* param)
  27 {
  28     uintptr_t ptr = cpu_rcr2();
  29     if (!ptr) {
  30         goto segv_term;
  31     }
  32
  33     v_mapping mapping;
  34     if (!vmm_lookup(ptr, &mapping)) {
  35         goto segv_term;
  36     }
  37
  38     if (!SEL_RPL(param->cs)) {
  39         // 如果是内核页错误……
  40         if (do_kernel(&mapping)) {
  41             return;
  42         }
  43         goto segv_term;
  44     }
  45
  46     struct mm_region* hit_region = region_get(&__current->mm.regions, ptr);
  47
  48     if (!hit_region) {
  49         // Into the void...
  50         goto segv_term;
  51     }
  52
  53     x86_pte_t* pte = &PTE_MOUNTED(PD_REFERENCED, ptr >> 12);
  54     if ((*pte & PG_PRESENT)) {
  55         if ((hit_region->attr & COW_MASK) == COW_MASK) {
  56             // normal page fault, do COW
  57             cpu_invplg(pte);
  58             uintptr_t pa =
  59               (uintptr_t)vmm_dup_page(__current->pid, PG_ENTRY_ADDR(*pte));
  60             pmm_free_page(__current->pid, *pte & ~0xFFF);
  61             *pte = (*pte & 0xFFF) | pa | PG_WRITE;
  62             goto resolved;
  63         }
  64         // impossible cases or accessing privileged page
  65         goto segv_term;
  66     }
  67
  68     if (!(*pte)) {
  69         // Invalid location
  70         goto segv_term;
  71     }
  72
  73     uintptr_t loc = *pte & ~0xfff;
  74
  75     // a writable page, not present, not cached, pte attr is not null
  76     //   -> a new page need to be alloc
  77     if ((hit_region->attr & REGION_WRITE) && (*pte & 0xfff) && !loc) {
  78         cpu_invplg(pte);
  79         uintptr_t pa = pmm_alloc_page(__current->pid, 0);
  80         *pte = *pte | pa | PG_PRESENT;
  81         goto resolved;
  82     }
  83
  84     // page not present, bring it from disk or somewhere else
  85     __print_panic_msg("WIP page fault route", param);
  86     while (1)
  87         ;
  88
  89 segv_term:
  90     kprintf(KERROR "(pid: %d) Segmentation fault on %p (%p:%p)\n",
  91             __current->pid,
  92             ptr,
  93             param->cs,
  94             param->eip);
  95     terminate_proc(LXSEGFAULT);
  96     // should not reach
  97     while (1)
  98         ;
  99
 100 resolved:
 101     cpu_invplg(ptr);
 102     return;
 103 }
 104
 105 int
 106 do_kernel(v_mapping* mapping)
 107 {
 108     uintptr_t addr = mapping->va;
 109     if (addr >= KHEAP_START && addr < PROC_START) {
 110         // This is kernel heap page
 111         uintptr_t pa = pmm_alloc_page(KERNEL_PID, 0);
 112         *mapping->pte = (*mapping->pte & 0xfff) | pa | PG_PRESENT;
 113         cpu_invplg(mapping->pte);
 114         cpu_invplg(addr);
 115         goto done;
 116     }
 117
 118     return 0;
 119 done:
 120     return 1;
 121 }