]> git.proxmox.com Git - mirror_edk2.git/blobdiff - DuetPkg/DxeIpl/X64/Paging.c
Initialize DuetPkg ...
[mirror_edk2.git] / DuetPkg / DxeIpl / X64 / Paging.c
diff --git a/DuetPkg/DxeIpl/X64/Paging.c b/DuetPkg/DxeIpl/X64/Paging.c
new file mode 100644 (file)
index 0000000..0377b6a
--- /dev/null
@@ -0,0 +1,238 @@
+/*++\r
+\r
+Copyright (c) 2006 - 2007, Intel Corporation                                                         \r
+All rights reserved. This program and the accompanying materials                          \r
+are licensed and made available under the terms and conditions of the BSD License         \r
+which accompanies this distribution.  The full text of the license may be found at        \r
+http://opensource.org/licenses/bsd-license.php                                            \r
+                                                                                          \r
+THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,                     \r
+WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.             \r
+\r
+Module Name:\r
+  Paging.c\r
+\r
+Abstract:\r
+\r
+Revision History:\r
+\r
+--*/\r
+\r
+#include "HobGeneration.h"\r
+#include "VirtualMemory.h"\r
+\r
+//\r
+// Create 2M-page table\r
+// PML4 (47:39)\r
+// PDPTE (38:30)\r
+// PDE (29:21)\r
+//\r
+\r
+#define EFI_2M_PAGE_BITS_NUM    21\r
+#define EFI_MAX_ENTRY_BITS_NUM  9\r
+\r
+#define EFI_PAGE_SIZE_4K        0x1000\r
+#define EFI_PAGE_SIZE_2M        (1 << EFI_2M_PAGE_BITS_NUM)\r
+\r
+#ifndef MIN\r
+  #define MIN(a, b)               ((a) < (b) ? (a) : (b))\r
+#endif\r
+#define ENTRY_NUM(x)            ((UINTN)1 << (x))\r
+\r
+UINT8 gPML4BitsNum;\r
+UINT8 gPDPTEBitsNum;\r
+UINT8 gPDEBitsNum;\r
+\r
+UINTN gPageNum2M;\r
+UINTN gPageNum4K;\r
+\r
+VOID\r
+EnableNullPointerProtection (\r
+  UINT8                       *PageTable\r
+  )\r
+{\r
+  X64_PAGE_TABLE_ENTRY_4K *PageTableEntry4KB;\r
+\r
+  PageTableEntry4KB = (X64_PAGE_TABLE_ENTRY_4K *) (PageTable + gPageNum2M * EFI_PAGE_SIZE_4K);\r
+  //\r
+  // Fill in the Page Table entries\r
+  // Mark 0~4K as not present\r
+  //\r
+  PageTableEntry4KB->Bits.Present = 0;\r
+\r
+  return ;\r
+}\r
+\r
+VOID\r
+X64Create4KPageTables (\r
+  UINT8                       *PageTable\r
+  )\r
+/*++\r
+Routine Description:\r
+  Create 4K-Page-Table for the low 2M memory.\r
+  This will change the previously created 2M-Page-Table-Entry.\r
+--*/\r
+{\r
+  UINT64                                        PageAddress;\r
+  UINTN                                         PTEIndex;\r
+  X64_PAGE_DIRECTORY_ENTRY_4K                   *PageDirectoryEntry4KB;\r
+  X64_PAGE_TABLE_ENTRY_4K                       *PageTableEntry4KB;\r
+\r
+  //\r
+  //  Page Table structure 4 level 4K.\r
+  //\r
+  //                   PageMapLevel4Entry        : bits 47-39\r
+  //                   PageDirectoryPointerEntry : bits 38-30\r
+  //  Page Table 4K  : PageDirectoryEntry4K      : bits 29-21\r
+  //                   PageTableEntry            : bits 20-12\r
+  //\r
+\r
+  PageTableEntry4KB = (X64_PAGE_TABLE_ENTRY_4K *)(PageTable + gPageNum2M * EFI_PAGE_SIZE_4K);\r
+\r
+  PageDirectoryEntry4KB = (X64_PAGE_DIRECTORY_ENTRY_4K *) (PageTable + 2 * EFI_PAGE_SIZE_4K);\r
+  PageDirectoryEntry4KB->Uint64 = (UINT64)(UINTN)PageTableEntry4KB;\r
+  PageDirectoryEntry4KB->Bits.ReadWrite = 1;\r
+  PageDirectoryEntry4KB->Bits.Present = 1;\r
+  PageDirectoryEntry4KB->Bits.MustBeZero = 0;\r
+\r
+  for (PTEIndex = 0, PageAddress = 0; \r
+       PTEIndex < ENTRY_NUM (EFI_MAX_ENTRY_BITS_NUM); \r
+       PTEIndex++, PageTableEntry4KB++, PageAddress += EFI_PAGE_SIZE_4K\r
+      ) {\r
+    //\r
+    // Fill in the Page Table entries\r
+    //\r
+    PageTableEntry4KB->Uint64 = (UINT64)PageAddress;\r
+    PageTableEntry4KB->Bits.ReadWrite = 1;\r
+    PageTableEntry4KB->Bits.Present = 1;\r
+  }\r
+\r
+  return ;\r
+}\r
+\r
+VOID\r
+X64Create2MPageTables (\r
+  UINT8 *PageTable\r
+  )\r
+{\r
+  UINT64                                        PageAddress;\r
+  UINT8                                         *TempPageTable;\r
+  UINTN                                         PML4Index;\r
+  UINTN                                         PDPTEIndex;\r
+  UINTN                                         PDEIndex;\r
+  X64_PAGE_MAP_AND_DIRECTORY_POINTER_2MB_4K     *PageMapLevel4Entry;\r
+  X64_PAGE_MAP_AND_DIRECTORY_POINTER_2MB_4K     *PageDirectoryPointerEntry;\r
+  X64_PAGE_TABLE_ENTRY_2M                       *PageDirectoryEntry2MB;\r
+\r
+  TempPageTable = PageTable;\r
+  PageAddress   = 0;\r
+\r
+  //\r
+  //  Page Table structure 3 level 2MB.\r
+  //\r
+  //                   PageMapLevel4Entry        : bits 47-39\r
+  //                   PageDirectoryPointerEntry : bits 38-30\r
+  //  Page Table 2MB : PageDirectoryEntry2M      : bits 29-21\r
+  //\r
+\r
+  PageMapLevel4Entry = (X64_PAGE_MAP_AND_DIRECTORY_POINTER_2MB_4K *)TempPageTable;\r
+\r
+  for (PML4Index = 0; PML4Index < ENTRY_NUM (gPML4BitsNum); PML4Index++, PageMapLevel4Entry++) {\r
+    //\r
+    // Each PML4 entry points to a page of Page Directory Pointer entires.\r
+    //  \r
+    TempPageTable += EFI_PAGE_SIZE_4K;\r
+    PageDirectoryPointerEntry = (X64_PAGE_MAP_AND_DIRECTORY_POINTER_2MB_4K *)TempPageTable;\r
+\r
+    //\r
+    // Make a PML4 Entry\r
+    //\r
+    PageMapLevel4Entry->Uint64 = (UINT64)(UINTN)(TempPageTable);\r
+    PageMapLevel4Entry->Bits.ReadWrite = 1;\r
+    PageMapLevel4Entry->Bits.Present = 1;\r
+\r
+    for (PDPTEIndex = 0; PDPTEIndex < ENTRY_NUM (gPDPTEBitsNum); PDPTEIndex++, PageDirectoryPointerEntry++) {\r
+      //\r
+      // Each Directory Pointer entries points to a page of Page Directory entires.\r
+      //       \r
+      TempPageTable += EFI_PAGE_SIZE_4K;\r
+      PageDirectoryEntry2MB = (X64_PAGE_TABLE_ENTRY_2M *)TempPageTable;\r
+\r
+      //\r
+      // Fill in a Page Directory Pointer Entries\r
+      //\r
+      PageDirectoryPointerEntry->Uint64 = (UINT64)(UINTN)(TempPageTable);\r
+      PageDirectoryPointerEntry->Bits.ReadWrite = 1;\r
+      PageDirectoryPointerEntry->Bits.Present = 1;\r
+\r
+      for (PDEIndex = 0; PDEIndex < ENTRY_NUM (gPDEBitsNum); PDEIndex++, PageDirectoryEntry2MB++) {\r
+        //\r
+        // Fill in the Page Directory entries\r
+        //\r
+        PageDirectoryEntry2MB->Uint64 = (UINT64)PageAddress;\r
+        PageDirectoryEntry2MB->Bits.ReadWrite = 1;\r
+        PageDirectoryEntry2MB->Bits.Present = 1;\r
+        PageDirectoryEntry2MB->Bits.MustBe1 = 1;\r
+\r
+        PageAddress += EFI_PAGE_SIZE_2M;\r
+      }\r
+    }\r
+  }\r
+\r
+  return ;\r
+}\r
+\r
+VOID *\r
+PreparePageTable (\r
+  VOID  *PageNumberTop,\r
+  UINT8 SizeOfMemorySpace\r
+  )\r
+/*++\r
+Description:\r
+  Generate pagetable below PageNumberTop, \r
+  and return the bottom address of pagetable for putting other things later.\r
+--*/\r
+{\r
+  VOID  *PageNumberBase;\r
+\r
+  SizeOfMemorySpace -= EFI_2M_PAGE_BITS_NUM;\r
+  gPDEBitsNum        = MIN (SizeOfMemorySpace, EFI_MAX_ENTRY_BITS_NUM);\r
+  SizeOfMemorySpace  = SizeOfMemorySpace - gPDEBitsNum;\r
+  gPDPTEBitsNum      = MIN (SizeOfMemorySpace, EFI_MAX_ENTRY_BITS_NUM);\r
+  SizeOfMemorySpace  = SizeOfMemorySpace - gPDPTEBitsNum;\r
+  gPML4BitsNum       = SizeOfMemorySpace;\r
+  if (gPML4BitsNum > EFI_MAX_ENTRY_BITS_NUM) {\r
+    return NULL;\r
+  }\r
+\r
+  //\r
+  // Suppose we have:\r
+  // 2MPage:\r
+  //   Entry:       PML4   ->     PDPTE     ->     PDE    -> Page\r
+  //   EntryNum:     a              b               c\r
+  // then\r
+  //   Occupy4KPage: 1              a              a*b\r
+  // \r
+  // 2M 4KPage:\r
+  //   Entry:       PTE    ->     Page\r
+  //   EntryNum:    512\r
+  // then\r
+  //   Occupy4KPage: 1\r
+  //   \r
+\r
+  gPageNum2M = 1 + ENTRY_NUM (gPML4BitsNum) + ENTRY_NUM (gPML4BitsNum + gPDPTEBitsNum);\r
+  gPageNum4K = 1;\r
+\r
+\r
+  PageNumberBase = (VOID *)((UINTN)PageNumberTop - (gPageNum2M + gPageNum4K) * EFI_PAGE_SIZE_4K);\r
+  ZeroMem (PageNumberBase, (gPageNum2M + gPageNum4K) * EFI_PAGE_SIZE_4K);\r
+\r
+  X64Create2MPageTables (PageNumberBase);\r
+  X64Create4KPageTables (PageNumberBase);\r
+  //\r
+  // Not enable NULL Pointer Protection if using INTx call\r
+  //\r
+//  EnableNullPointerProtection (PageNumberBase);\r
+\r
+  return PageNumberBase;\r
+}\r