Subversion Repositories HelenOS

Rev

Rev 825 | Rev 1063 | 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.  
  43. /* Definitions for identity page mapper */
  44. pte_t helper_ptl1[512] __attribute__((aligned (PAGE_SIZE)));
  45. pte_t helper_ptl2[512] __attribute__((aligned (PAGE_SIZE)));
  46. pte_t helper_ptl3[512] __attribute__((aligned (PAGE_SIZE)));
  47. extern pte_t ptl_0; /* From boot.S */
  48.  
  49. #define PTL1_PRESENT(ptl0, page) (!(GET_PTL1_FLAGS_ARCH(ptl0, PTL0_INDEX_ARCH(page)) & PAGE_NOT_PRESENT))
  50. #define PTL2_PRESENT(ptl1, page) (!(GET_PTL2_FLAGS_ARCH(ptl1, PTL1_INDEX_ARCH(page)) & PAGE_NOT_PRESENT))
  51. #define PTL3_PRESENT(ptl2, page) (!(GET_PTL3_FLAGS_ARCH(ptl2, PTL2_INDEX_ARCH(page)) & PAGE_NOT_PRESENT))
  52.  
  53. #define PTL1_ADDR(ptl0, page) ((pte_t *)PA2KA(GET_PTL1_ADDRESS_ARCH(ptl0, PTL0_INDEX_ARCH(page))))
  54. #define PTL2_ADDR(ptl1, page) ((pte_t *)PA2KA(GET_PTL2_ADDRESS_ARCH(ptl1, PTL1_INDEX_ARCH(page))))
  55. #define PTL3_ADDR(ptl2, page) ((pte_t *)PA2KA(GET_PTL3_ADDRESS_ARCH(ptl2, PTL2_INDEX_ARCH(page))))
  56.  
  57. #define SETUP_PTL1(ptl0, page, tgt)  {  \
  58.     SET_PTL1_ADDRESS_ARCH(ptl0, PTL0_INDEX_ARCH(page), (__address)KA2PA(tgt)); \
  59.         SET_PTL1_FLAGS_ARCH(ptl0, PTL0_INDEX_ARCH(page), PAGE_WRITE | PAGE_EXEC); \
  60.     }
  61. #define SETUP_PTL2(ptl1, page, tgt)  {  \
  62.     SET_PTL2_ADDRESS_ARCH(ptl1, PTL1_INDEX_ARCH(page), (__address)KA2PA(tgt)); \
  63.         SET_PTL2_FLAGS_ARCH(ptl1, PTL1_INDEX_ARCH(page), PAGE_WRITE | PAGE_EXEC); \
  64.     }
  65. #define SETUP_PTL3(ptl2, page, tgt)  {  \
  66.     SET_PTL3_ADDRESS_ARCH(ptl2, PTL2_INDEX_ARCH(page), (__address)KA2PA(tgt)); \
  67.         SET_PTL3_FLAGS_ARCH(ptl2, PTL2_INDEX_ARCH(page), PAGE_WRITE | PAGE_EXEC); \
  68.     }
  69. #define SETUP_FRAME(ptl3, page, tgt)  { \
  70.     SET_FRAME_ADDRESS_ARCH(ptl3, PTL3_INDEX_ARCH(page), (__address)KA2PA(tgt)); \
  71.         SET_FRAME_FLAGS_ARCH(ptl3, PTL3_INDEX_ARCH(page), PAGE_WRITE | PAGE_EXEC); \
  72.     }
  73.  
  74. void page_arch_init(void)
  75. {
  76.     __address cur;
  77.     int flags;
  78.  
  79.     if (config.cpu_active == 1) {
  80.         page_mapping_operations = &pt_mapping_operations;
  81.        
  82.         /*
  83.          * PA2KA(identity) mapping for all frames.
  84.          */
  85.         for (cur = 0; cur < last_frame; cur += FRAME_SIZE) {
  86.             flags = PAGE_CACHEABLE | PAGE_EXEC;
  87.             if ((PA2KA(cur) >= config.base) && (PA2KA(cur) < config.base + config.kernel_size))
  88.                 flags |= PAGE_GLOBAL;
  89.             page_mapping_insert(AS_KERNEL, PA2KA(cur), cur, flags);
  90.         }
  91.         exc_register(14, "page_fault", (iroutine)page_fault);
  92.         write_cr3((__address) AS_KERNEL->page_table);
  93.     }
  94.     else {
  95.         write_cr3((__address) AS_KERNEL->page_table);
  96.     }
  97. }
  98.  
  99. /** Identity page mapper
  100.  *
  101.  * We need to map whole physical memory identically before the page subsystem
  102.  * is initializaed. This thing clears page table and fills in the specific
  103.  * items.
  104.  */
  105. void ident_page_fault(int n, istate_t *istate)
  106. {
  107.     __address page;
  108.     static __address oldpage = 0;
  109.     pte_t *aptl_1, *aptl_2, *aptl_3;
  110.  
  111.     page = read_cr2();
  112.     if (oldpage) {
  113.         /* Unmap old address */
  114.         aptl_1 = PTL1_ADDR(&ptl_0, oldpage);
  115.         aptl_2 = PTL2_ADDR(aptl_1, oldpage);
  116.         aptl_3 = PTL3_ADDR(aptl_2, oldpage);
  117.  
  118.         SET_FRAME_FLAGS_ARCH(aptl_3, PTL3_INDEX_ARCH(oldpage), PAGE_NOT_PRESENT);
  119.         if (aptl_3 == helper_ptl3)
  120.             SET_PTL3_FLAGS_ARCH(aptl_2, PTL2_INDEX_ARCH(oldpage), PAGE_NOT_PRESENT);
  121.         if (aptl_2 == helper_ptl2)
  122.             SET_PTL2_FLAGS_ARCH(aptl_1, PTL1_INDEX_ARCH(oldpage), PAGE_NOT_PRESENT);
  123.         if (aptl_1 == helper_ptl1)
  124.             SET_PTL1_FLAGS_ARCH(&ptl_0, PTL0_INDEX_ARCH(oldpage), PAGE_NOT_PRESENT);
  125.     }
  126.     if (PTL1_PRESENT(&ptl_0, page))
  127.         aptl_1 = PTL1_ADDR(&ptl_0, page);
  128.     else {
  129.         SETUP_PTL1(&ptl_0, page, helper_ptl1);
  130.         aptl_1 = helper_ptl1;
  131.     }
  132.        
  133.     if (PTL2_PRESENT(aptl_1, page))
  134.         aptl_2 = PTL2_ADDR(aptl_1, page);
  135.     else {
  136.         SETUP_PTL2(aptl_1, page, helper_ptl2);
  137.         aptl_2 = helper_ptl2;
  138.     }
  139.  
  140.     if (PTL3_PRESENT(aptl_2, page))
  141.         aptl_3 = PTL3_ADDR(aptl_2, page);
  142.     else {
  143.         SETUP_PTL3(aptl_2, page, helper_ptl3);
  144.         aptl_3 = helper_ptl3;
  145.     }
  146.    
  147.     SETUP_FRAME(aptl_3, page, page);
  148.  
  149.     oldpage = page;
  150. }
  151.  
  152. void page_fault(int n, istate_t *istate)
  153. {
  154.     __address page;
  155.    
  156.     page = read_cr2();
  157.     if (!as_page_fault(page)) {
  158.         print_info_errcode(n, istate);
  159.         printf("Page fault address: %Q\n", page);
  160.         panic("page fault\n");
  161.     }
  162. }
  163.