X-Git-Url: https://scm.lunaixsky.com/lunaix-os.git/blobdiff_plain/c166bd62fbb907f95f79f621e2a2fb4fdde08e01..35a7d633d3f16c1e0539af6ca5d8e7482926cd93:/lunaix-os/kernel/mm/mmio.c

diff --git a/lunaix-os/kernel/mm/mmio.c b/lunaix-os/kernel/mm/mmio.c
index b91ab0e..dbb1870 100644
--- a/lunaix-os/kernel/mm/mmio.c
+++ b/lunaix-os/kernel/mm/mmio.c
@@ -2,7 +2,7 @@
 #include <lunaix/mm/page.h>
 #include <lunaix/spike.h>
 
-void*
+ptr_t
 ioremap(ptr_t paddr, u32_t size)
 {
     // FIXME implement a page policy interface allow to decouple the 
@@ -14,21 +14,13 @@ ioremap(ptr_t paddr, u32_t size)
     // Ensure the range is reservable (not already in use)
     assert(pmm_onhold_range(start, npages));
 
-    return (void*)vmap_range(start, npages, KERNEL_DATA);
+    ptr_t addr = vmap_range(start, npages, KERNEL_DATA);
+    return addr + va_offset(paddr);
 }
 
 void
 iounmap(ptr_t vaddr, u32_t size)
 {
-    // FIXME
-    fail("need fix");
-
-    // pte_t* ptep = mkptep_va(VMS_SELF, vaddr);
-    // for (size_t i = 0; i < size; i += PAGE_SIZE, ptep++) {
-    //     pte_t pte = pte_at(ptep);
-
-    //     set_pte(ptep, null_pte);
-    //     if (pte_isloaded(pte))
-    //         return_page(ppage_pa(pte_paddr(pte)));
-    // }
+    assert(vaddr >= VMAP && vaddr < VMAP_END);
+    vunmap_range(pfn(vaddr), leaf_count(size));
 }
\ No newline at end of file