Subversion Repositories HelenOS

Rev

Rev 1411 | Rev 1702 | Go to most recent revision | Blame | Compare with Previous | Last modification | View Log | Download | RSS feed

  1. /*
  2.  * Copyright (C) 2001-2004 Jakub Jermar
  3.  * All rights reserved.
  4.  *
  5.  * Redistribution and use in source and binary forms, with or without
  6.  * modification, are permitted provided that the following conditions
  7.  * are met:
  8.  *
  9.  * - Redistributions of source code must retain the above copyright
  10.  *   notice, this list of conditions and the following disclaimer.
  11.  * - Redistributions in binary form must reproduce the above copyright
  12.  *   notice, this list of conditions and the following disclaimer in the
  13.  *   documentation and/or other materials provided with the distribution.
  14.  * - The name of the author may not be used to endorse or promote products
  15.  *   derived from this software without specific prior written permission.
  16.  *
  17.  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  18.  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  19.  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  20.  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  21.  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  22.  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  23.  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  24.  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  25.  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  26.  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  27.  */
  28.  
  29. #include <arch/mm/page.h>
  30. #include <genarch/mm/page_pt.h>
  31. #include <arch/mm/frame.h>
  32. #include <mm/page.h>
  33. #include <mm/frame.h>
  34. #include <mm/as.h>
  35. #include <arch/interrupt.h>
  36. #include <arch/asm.h>
  37. #include <config.h>
  38. #include <memstr.h>
  39. #include <interrupt.h>
  40. #include <print.h>
  41. #include <panic.h>
  42. #include <align.h>
  43.  
  44. /* Definitions for identity page mapper */
  45. pte_t helper_ptl1[512] __attribute__((aligned (PAGE_SIZE)));
  46. pte_t helper_ptl2[512] __attribute__((aligned (PAGE_SIZE)));
  47. pte_t helper_ptl3[512] __attribute__((aligned (PAGE_SIZE)));
  48. extern pte_t ptl_0; /* From boot.S */
  49.  
  50. #define PTL1_PRESENT(ptl0, page) (!(GET_PTL1_FLAGS_ARCH(ptl0, PTL0_INDEX_ARCH(page)) & PAGE_NOT_PRESENT))
  51. #define PTL2_PRESENT(ptl1, page) (!(GET_PTL2_FLAGS_ARCH(ptl1, PTL1_INDEX_ARCH(page)) & PAGE_NOT_PRESENT))
  52. #define PTL3_PRESENT(ptl2, page) (!(GET_PTL3_FLAGS_ARCH(ptl2, PTL2_INDEX_ARCH(page)) & PAGE_NOT_PRESENT))
  53.  
  54. #define PTL1_ADDR(ptl0, page) ((pte_t *)PA2KA(GET_PTL1_ADDRESS_ARCH(ptl0, PTL0_INDEX_ARCH(page))))
  55. #define PTL2_ADDR(ptl1, page) ((pte_t *)PA2KA(GET_PTL2_ADDRESS_ARCH(ptl1, PTL1_INDEX_ARCH(page))))
  56. #define PTL3_ADDR(ptl2, page) ((pte_t *)PA2KA(GET_PTL3_ADDRESS_ARCH(ptl2, PTL2_INDEX_ARCH(page))))
  57.  
  58. #define SETUP_PTL1(ptl0, page, tgt)  {  \
  59.     SET_PTL1_ADDRESS_ARCH(ptl0, PTL0_INDEX_ARCH(page), (__address)KA2PA(tgt)); \
  60.         SET_PTL1_FLAGS_ARCH(ptl0, PTL0_INDEX_ARCH(page), PAGE_WRITE | PAGE_EXEC); \
  61.     }
  62. #define SETUP_PTL2(ptl1, page, tgt)  {  \
  63.     SET_PTL2_ADDRESS_ARCH(ptl1, PTL1_INDEX_ARCH(page), (__address)KA2PA(tgt)); \
  64.         SET_PTL2_FLAGS_ARCH(ptl1, PTL1_INDEX_ARCH(page), PAGE_WRITE | PAGE_EXEC); \
  65.     }
  66. #define SETUP_PTL3(ptl2, page, tgt)  {  \
  67.     SET_PTL3_ADDRESS_ARCH(ptl2, PTL2_INDEX_ARCH(page), (__address)KA2PA(tgt)); \
  68.         SET_PTL3_FLAGS_ARCH(ptl2, PTL2_INDEX_ARCH(page), PAGE_WRITE | PAGE_EXEC); \
  69.     }
  70. #define SETUP_FRAME(ptl3, page, tgt)  { \
  71.     SET_FRAME_ADDRESS_ARCH(ptl3, PTL3_INDEX_ARCH(page), (__address)KA2PA(tgt)); \
  72.         SET_FRAME_FLAGS_ARCH(ptl3, PTL3_INDEX_ARCH(page), PAGE_WRITE | PAGE_EXEC); \
  73.     }
  74.  
  75.  
  76. void page_arch_init(void)
  77. {
  78.     __address cur;
  79.     int i;
  80.     int identity_flags = PAGE_CACHEABLE | PAGE_EXEC | PAGE_GLOBAL;
  81.  
  82.     if (config.cpu_active == 1) {
  83.         page_mapping_operations = &pt_mapping_operations;
  84.        
  85.         /*
  86.          * PA2KA(identity) mapping for all frames.
  87.          */
  88.         for (cur = 0; cur < last_frame; cur += FRAME_SIZE) {
  89.             /* Standard identity mapping */
  90.             page_mapping_insert(AS_KERNEL, PA2KA(cur), cur, identity_flags);
  91.         }
  92.         /* Upper kernel mapping
  93.          * - from zero to top of kernel (include bottom addresses
  94.          *   because some are needed for init )
  95.          */
  96.         for (cur = PA2KA_CODE(0); cur < config.base+config.kernel_size; cur += FRAME_SIZE) {
  97.             page_mapping_insert(AS_KERNEL, cur, KA2PA(cur), identity_flags);
  98.         }
  99.         for (i=0; i < init.cnt; i++) {
  100.             for (cur=init.tasks[i].addr;cur < init.tasks[i].size; cur += FRAME_SIZE) {
  101.                 page_mapping_insert(AS_KERNEL, PA2KA_CODE(KA2PA(cur)), KA2PA(cur), identity_flags);
  102.             }
  103.         }
  104.  
  105.         exc_register(14, "page_fault", (iroutine)page_fault);
  106.         write_cr3((__address) AS_KERNEL->page_table);
  107.     }
  108.     else {
  109.         write_cr3((__address) AS_KERNEL->page_table);
  110.     }
  111. }
  112.  
  113.  
  114. /** Identity page mapper
  115.  *
  116.  * We need to map whole physical memory identically before the page subsystem
  117.  * is initializaed. This thing clears page table and fills in the specific
  118.  * items.
  119.  */
  120. void ident_page_fault(int n, istate_t *istate)
  121. {
  122.     __address page;
  123.     static __address oldpage = 0;
  124.     pte_t *aptl_1, *aptl_2, *aptl_3;
  125.  
  126.     page = read_cr2();
  127.     if (oldpage) {
  128.         /* Unmap old address */
  129.         aptl_1 = PTL1_ADDR(&ptl_0, oldpage);
  130.         aptl_2 = PTL2_ADDR(aptl_1, oldpage);
  131.         aptl_3 = PTL3_ADDR(aptl_2, oldpage);
  132.  
  133.         SET_FRAME_FLAGS_ARCH(aptl_3, PTL3_INDEX_ARCH(oldpage), PAGE_NOT_PRESENT);
  134.         if (KA2PA(aptl_3) == KA2PA(helper_ptl3))
  135.             SET_PTL3_FLAGS_ARCH(aptl_2, PTL2_INDEX_ARCH(oldpage), PAGE_NOT_PRESENT);
  136.         if (KA2PA(aptl_2) == KA2PA(helper_ptl2))
  137.             SET_PTL2_FLAGS_ARCH(aptl_1, PTL1_INDEX_ARCH(oldpage), PAGE_NOT_PRESENT);
  138.         if (KA2PA(aptl_1) == KA2PA(helper_ptl1))
  139.             SET_PTL1_FLAGS_ARCH(&ptl_0, PTL0_INDEX_ARCH(oldpage), PAGE_NOT_PRESENT);
  140.     }
  141.     if (PTL1_PRESENT(&ptl_0, page))
  142.         aptl_1 = PTL1_ADDR(&ptl_0, page);
  143.     else {
  144.         SETUP_PTL1(&ptl_0, page, helper_ptl1);
  145.         aptl_1 = helper_ptl1;
  146.     }
  147.        
  148.     if (PTL2_PRESENT(aptl_1, page))
  149.         aptl_2 = PTL2_ADDR(aptl_1, page);
  150.     else {
  151.         SETUP_PTL2(aptl_1, page, helper_ptl2);
  152.         aptl_2 = helper_ptl2;
  153.     }
  154.  
  155.     if (PTL3_PRESENT(aptl_2, page))
  156.         aptl_3 = PTL3_ADDR(aptl_2, page);
  157.     else {
  158.         SETUP_PTL3(aptl_2, page, helper_ptl3);
  159.         aptl_3 = helper_ptl3;
  160.     }
  161.    
  162.     SETUP_FRAME(aptl_3, page, page);
  163.  
  164.     oldpage = page;
  165. }
  166.  
  167.  
  168. void page_fault(int n, istate_t *istate)
  169. {
  170.     __address page;
  171.     pf_access_t access;
  172.    
  173.     page = read_cr2();
  174.    
  175.     if (istate->error_word & PFERR_CODE_RSVD)
  176.         panic("Reserved bit set in page table entry.\n");
  177.    
  178.     if (istate->error_word & PFERR_CODE_RW)
  179.         access = PF_ACCESS_WRITE;
  180.     else if (istate->error_word & PFERR_CODE_ID)
  181.         access = PF_ACCESS_EXEC;
  182.     else
  183.         access = PF_ACCESS_READ;
  184.    
  185.     if (as_page_fault(page, access, istate) == AS_PF_FAULT) {
  186.         fault_if_from_uspace(istate, "Page fault: %#x", page);
  187.  
  188.         print_info_errcode(n, istate);
  189.         printf("Page fault address: %llX\n", page);
  190.         panic("page fault\n");
  191.     }
  192. }
  193.  
  194.  
  195. __address hw_map(__address physaddr, size_t size)
  196. {
  197.     if (last_frame + ALIGN_UP(size, PAGE_SIZE) > KA2PA(KERNEL_ADDRESS_SPACE_END_ARCH))
  198.         panic("Unable to map physical memory %p (%d bytes)", physaddr, size)
  199.    
  200.     __address virtaddr = PA2KA(last_frame);
  201.     pfn_t i;
  202.     for (i = 0; i < ADDR2PFN(ALIGN_UP(size, PAGE_SIZE)); i++)
  203.         page_mapping_insert(AS_KERNEL, virtaddr + PFN2ADDR(i), physaddr + PFN2ADDR(i), PAGE_NOT_CACHEABLE);
  204.    
  205.     last_frame = ALIGN_UP(last_frame + size, FRAME_SIZE);
  206.    
  207.     return virtaddr;
  208. }
  209.