X-Git-Url: https://scm.lunaixsky.com/lunaix-os.git/blobdiff_plain/c50b9a23b03c677efa3842536c363d368542e30b..45e1f8b055043e54be35462852ab6649d634da7c:/lunaix-os/kernel/asm/x86/pfault.c

diff --git a/lunaix-os/kernel/asm/x86/pfault.c b/lunaix-os/kernel/asm/x86/pfault.c
index 6498619..0d5a6fa 100644
--- a/lunaix-os/kernel/asm/x86/pfault.c
+++ b/lunaix-os/kernel/asm/x86/pfault.c
@@ -1,14 +1,16 @@
 #include <arch/x86/interrupts.h>
 #include <lunaix/common.h>
-#include <lunaix/lxsignal.h>
 #include <lunaix/mm/mm.h>
 #include <lunaix/mm/pmm.h>
 #include <lunaix/mm/region.h>
 #include <lunaix/mm/vmm.h>
 #include <lunaix/sched.h>
+#include <lunaix/signal.h>
 #include <lunaix/status.h>
 #include <lunaix/syslog.h>
 
+#include <klibc/string.h>
+
 static void
 kprintf(const char* fmt, ...)
 {
@@ -26,7 +28,7 @@ __print_panic_msg(const char* msg, const isr_param* param);
 void
 intr_routine_page_fault(const isr_param* param)
 {
-    uintptr_t ptr = cpu_rcr2();
+    ptr_t ptr = cpu_rcr2();
     if (!ptr) {
         goto segv_term;
     }
@@ -36,79 +38,90 @@ intr_routine_page_fault(const isr_param* param)
         goto segv_term;
     }
 
-    if (!SEL_RPL(param->cs)) {
-        // 如果是内核页错误……
-        if (do_kernel(&mapping)) {
-            return;
-        }
-        // 如果不是，那么看看内核是不是需要用户页。
+    if (!SEL_RPL(param->execp->cs)) {
+        // TODO if kernel pfault
     }
 
-    struct mm_region* hit_region = region_get(&__current->mm.regions, ptr);
+    vm_regions_t* vmr = (vm_regions_t*)&__current->mm.regions;
+    struct mm_region* hit_region = region_get(vmr, ptr);
 
     if (!hit_region) {
         // 当你凝视深渊时……
         goto segv_term;
     }
 
-    volatile x86_pte_t* pte = &PTE_MOUNTED(PD_REFERENCED, ptr >> 12);
-    if ((*pte & PG_PRESENT)) {
+    volatile x86_pte_t* pte = &PTE_MOUNTED(VMS_SELF, ptr >> 12);
+    if (PG_IS_PRESENT(*pte)) {
         if ((hit_region->attr & COW_MASK) == COW_MASK) {
             // normal page fault, do COW
-            cpu_invplg(pte);
-            uintptr_t pa =
-              (uintptr_t)vmm_dup_page(__current->pid, PG_ENTRY_ADDR(*pte));
+            cpu_invplg((ptr_t)pte);
+
+            ptr_t pa = (ptr_t)vmm_dup_page(__current->pid, PG_ENTRY_ADDR(*pte));
+
             pmm_free_page(__current->pid, *pte & ~0xFFF);
-            *pte = (*pte & 0xFFF) | pa | PG_WRITE;
+            *pte = (*pte & 0xFFF & ~PG_DIRTY) | pa | PG_WRITE;
+
             goto resolved;
         }
         // impossible cases or accessing privileged page
         goto segv_term;
     }
 
-    // if (!(*pte)) {
-    //     // Invalid location
-    //     goto segv_term;
-    // }
+    // an anonymous page and not present
+    //   -> a new page need to be alloc
+    if ((hit_region->attr & REGION_ANON)) {
+        if (!PG_IS_PRESENT(*pte)) {
+            cpu_invplg((ptr_t)pte);
 
-    uintptr_t loc = *pte & ~0xfff;
+            ptr_t pa = pmm_alloc_page(__current->pid, 0);
+            if (!pa) {
+                goto oom;
+            }
 
-    // a writable page, not present, not cached, pte attr is not null
-    //   -> a new page need to be alloc
-    if ((hit_region->attr & REGION_WRITE) && (*pte & 0xfff) && !loc) {
-        cpu_invplg(pte);
-        uintptr_t pa = pmm_alloc_page(__current->pid, 0);
-        if (!pa) {
-            goto oom;
+            *pte = *pte | pa | PG_PRESENT;
+            memset((void*)PG_ALIGN(ptr), 0, PG_SIZE);
+            goto resolved;
         }
-
-        *pte = *pte | pa | PG_PRESENT;
-        goto resolved;
+        // permission denied on anon page (e.g., write on readonly page)
+        goto segv_term;
     }
 
-    // if mfile is set, then it is a mem map
-    if (hit_region->mfile) {
+    // if mfile is set (Non-anonymous), then it is a mem map
+    if (hit_region->mfile && !PG_IS_PRESENT(*pte)) {
         struct v_file* file = hit_region->mfile;
-        u32_t offset =
-          (ptr - hit_region->start) & (PG_SIZE - 1) + hit_region->offset;
-        uintptr_t pa = pmm_alloc_page(__current->pid, 0);
+
+        ptr = PG_ALIGN(ptr);
+
+        u32_t mseg_off = (ptr - hit_region->start);
+        u32_t mfile_off = mseg_off + hit_region->foff;
+        ptr_t pa = pmm_alloc_page(__current->pid, 0);
 
         if (!pa) {
             goto oom;
         }
 
-        cpu_invplg(pte);
-        *pte = *pte | pa | PG_PRESENT;
-        int errno = file->ops->read_page(
-          file->inode, ptr & (PG_SIZE - 1), PG_SIZE, offset);
+        cpu_invplg((ptr_t)pte);
+        *pte = (*pte & 0xFFF) | pa | PG_PRESENT;
+
+        memset((void*)ptr, 0, PG_SIZE);
+
+        int errno = 0;
+        if (mseg_off < hit_region->flen) {
+            errno =
+              file->ops->read_page(file->inode, (void*)ptr, PG_SIZE, mfile_off);
+        }
+
         if (errno < 0) {
-            kprintf(KERROR "fail to read page (%d)\n", errno);
+            kprintf(KERROR "fail to populate page (%d)\n", errno);
             goto segv_term;
         }
+
+        *pte &= ~PG_DIRTY;
+
         goto resolved;
     }
 
-    // page not present, bring it from disk or somewhere else
+    // page not present, might be a chance to introduce swap file?
     __print_panic_msg("WIP page fault route", param);
     while (1)
         ;
@@ -119,8 +132,8 @@ segv_term:
     kprintf(KERROR "(pid: %d) Segmentation fault on %p (%p:%p)\n",
             __current->pid,
             ptr,
-            param->cs,
-            param->eip);
+            param->execp->cs,
+            param->execp->eip);
     __SIGSET(__current->sig_pending, _SIGSEGV);
     schedule();
     // should not reach
@@ -130,16 +143,4 @@ segv_term:
 resolved:
     cpu_invplg(ptr);
     return;
-}
-
-int
-do_kernel(v_mapping* mapping)
-{
-    uintptr_t addr = mapping->va;
-
-    // TODO
-
-    return 0;
-done:
-    return 1;
 }
\ No newline at end of file