Subversion Repositories HelenOS

Rev

Rev 1817 | Go to most recent revision | Blame | 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. /** @addtogroup xen32mm
  30.  * @{
  31.  */
  32. /** @file
  33.  * @ingroup xen32mm
  34.  */
  35.  
  36. #include <mm/frame.h>
  37. #include <arch/mm/frame.h>
  38. #include <mm/as.h>
  39. #include <config.h>
  40. #include <arch/boot/boot.h>
  41. #include <arch/hypercall.h>
  42. #include <panic.h>
  43. #include <debug.h>
  44. #include <align.h>
  45. #include <macros.h>
  46.  
  47. #include <console/cmd.h>
  48. #include <console/kconsole.h>
  49.  
  50. uintptr_t last_frame = 0;
  51.  
  52. #define L1_PT_SHIFT 10
  53. #define L2_PT_SHIFT 0
  54.  
  55. #define L1_PT_ENTRIES   1024
  56. #define L2_PT_ENTRIES   1024
  57.  
  58. #define L1_OFFSET_MASK          (L1_PT_ENTRIES - 1)
  59. #define L2_OFFSET_MASK          (L2_PT_ENTRIES - 1)
  60.  
  61. #define PFN2PTL1_OFFSET(pfn)    ((pfn >> L1_PT_SHIFT) & L1_OFFSET_MASK)
  62. #define PFN2PTL2_OFFSET(pfn)    ((pfn >> L2_PT_SHIFT) & L2_OFFSET_MASK)
  63.  
  64. #define PAGE_MASK   (~(PAGE_SIZE - 1))
  65.  
  66. #define PTE2ADDR(pte)   (pte & PAGE_MASK)
  67.  
  68. #define _PAGE_PRESENT   0x001UL
  69. #define _PAGE_RW        0x002UL
  70. #define _PAGE_USER      0x004UL
  71. #define _PAGE_PWT       0x008UL
  72. #define _PAGE_PCD       0x010UL
  73. #define _PAGE_ACCESSED  0x020UL
  74. #define _PAGE_DIRTY     0x040UL
  75. #define _PAGE_PAT       0x080UL
  76. #define _PAGE_PSE       0x080UL
  77. #define _PAGE_GLOBAL    0x100UL
  78.  
  79. #define L1_PROT (_PAGE_PRESENT | _PAGE_ACCESSED)
  80. #define L2_PROT (_PAGE_PRESENT | _PAGE_RW | _PAGE_ACCESSED)
  81.  
  82. void frame_arch_init(void)
  83. {
  84.     if (config.cpu_active == 1) {
  85.         /* The only memory zone starts just after page table */
  86.         pfn_t start = ADDR2PFN(ALIGN_UP(KA2PA(start_info.pt_base), PAGE_SIZE)) + start_info.nr_pt_frames;
  87.         size_t size = start_info.nr_pages - start;
  88.        
  89.         /* Create identity mapping */
  90.         pfn_t phys;
  91.         count_t count = 0;
  92.         for (phys = start; phys < start + size; phys++) {
  93.             mmu_update_t updates[L2_PT_ENTRIES];
  94.             pfn_t virt = ADDR2PFN(PA2KA(PFN2ADDR(phys)));
  95.            
  96.             size_t ptl1_offset = PFN2PTL1_OFFSET(virt);
  97.             size_t ptl2_offset = PFN2PTL2_OFFSET(virt);
  98.            
  99.             unsigned long *ptl2_base = (unsigned long *) PTE2ADDR(start_info.pt_base[ptl1_offset]);
  100.            
  101.             if (ptl2_base == 0) {
  102.                 mmuext_op_t mmu_ext;
  103.                
  104.                 pfn_t virt2 = ADDR2PFN(PA2KA(PFN2ADDR(start)));
  105.                
  106.                 /* New L1 page table entry needed */
  107.                 memsetb(PFN2ADDR(virt2), PAGE_SIZE, 0);
  108.                
  109.                 size_t ptl1_offset2 = PFN2PTL1_OFFSET(virt2);
  110.                 size_t ptl2_offset2 = PFN2PTL2_OFFSET(virt2);
  111.                 unsigned long *ptl2_base2 = (unsigned long *) PTE2ADDR(start_info.pt_base[ptl1_offset2]);
  112.                
  113.                 if (ptl2_base2 == 0)
  114.                     panic("Unable to find page table reference");
  115.                
  116.                 updates[count].ptr = (uintptr_t) &ptl2_base2[ptl2_offset2];
  117.                 updates[count].val = PFN2ADDR(start_info.mfn_list[start]) | L1_PROT;
  118.                 if (xen_mmu_update(updates, count + 1, NULL, DOMID_SELF) < 0)
  119.                     panic("Unable to map new page table");
  120.                 count = 0;
  121.                
  122.                 mmu_ext.cmd = MMUEXT_PIN_L1_TABLE;
  123.                 mmu_ext.arg1.mfn = start_info.mfn_list[start];
  124.                 if (xen_mmuext_op(&mmu_ext, 1, NULL, DOMID_SELF) < 0)
  125.                     panic("Error pinning new page table");
  126.                
  127.                 unsigned long *ptl0 = (unsigned long *) PFN2ADDR(start_info.mfn_list[ADDR2PFN(KA2PA(start_info.pt_base))]);
  128.                
  129.                 updates[count].ptr = (uintptr_t) &ptl0[ptl1_offset];
  130.                 updates[count].val = PFN2ADDR(start_info.mfn_list[start]) | L2_PROT;
  131.                 if (xen_mmu_update(updates, count + 1, NULL, DOMID_SELF) < 0)
  132.                     panic("Unable to update PTE for page table");
  133.                 count = 0;
  134.                
  135.                 ptl2_base = (unsigned long *) PTE2ADDR(start_info.pt_base[ptl1_offset]);
  136.                 start++;
  137.                 size--;
  138.             }
  139.            
  140.             updates[count].ptr = (uintptr_t) &ptl2_base[ptl2_offset];
  141.             updates[count].val = PFN2ADDR(start_info.mfn_list[phys]) | L2_PROT;
  142.             count++;
  143.            
  144.             if ((count == L2_PT_ENTRIES) || (phys + 1 == start + size)) {
  145.                 if (xen_mmu_update(updates, count, NULL, DOMID_SELF) < 0)
  146.                     panic("Unable to update PTE");
  147.                 count = 0;
  148.             }
  149.         }
  150.        
  151.         zone_create(start, size, start, 0);
  152.         last_frame = start + size;
  153.     }
  154. }
  155.  
  156. /** @}
  157.  */
  158.