+/** @file\r
+*\r
+* Copyright (c) 2011-2012, ARM Limited. All rights reserved.\r
+* \r
+* 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
+**/\r
+\r
+#include <PiDxe.h>\r
+#include <Library/UefiLib.h>\r
+#include <Library/ArmLib.h>\r
+#include <Chipset/ArmV7.h>\r
+#include <Library/CacheMaintenanceLib.h>\r
+#include <Library/EblCmdLib.h>\r
+#include <Library/BaseLib.h>\r
+#include <Library/DebugLib.h>\r
+\r
+#define GET_TT_ATTRIBUTES(TTEntry) ((TTEntry) & ~(TT_DESCRIPTOR_SECTION_BASE_ADDRESS_MASK))\r
+#define GET_TT_PAGE_ATTRIBUTES(TTEntry) ((TTEntry) & 0xFFF)\r
+#define GET_TT_LARGEPAGE_ATTRIBUTES(TTEntry) ((TTEntry) & 0xFFFF)\r
+\r
+// Section\r
+#define TT_DESCRIPTOR_SECTION_STRONGLY_ORDER (TT_DESCRIPTOR_SECTION_TYPE_SECTION | \\r
+ TT_DESCRIPTOR_SECTION_NG_GLOBAL | \\r
+ TT_DESCRIPTOR_SECTION_S_NOT_SHARED | \\r
+ TT_DESCRIPTOR_SECTION_DOMAIN(0) | \\r
+ TT_DESCRIPTOR_SECTION_AP_RW_RW | \\r
+ TT_DESCRIPTOR_SECTION_CACHE_POLICY_STRONGLY_ORDERED)\r
+\r
+// Small Page\r
+#define TT_DESCRIPTOR_PAGE_STRONGLY_ORDER (TT_DESCRIPTOR_PAGE_TYPE_PAGE | \\r
+ TT_DESCRIPTOR_PAGE_NG_GLOBAL | \\r
+ TT_DESCRIPTOR_PAGE_S_NOT_SHARED | \\r
+ TT_DESCRIPTOR_PAGE_AP_RW_RW | \\r
+ TT_DESCRIPTOR_PAGE_CACHE_POLICY_STRONGLY_ORDERED)\r
+\r
+// Large Page\r
+#define TT_DESCRIPTOR_LARGEPAGE_WRITE_BACK (TT_DESCRIPTOR_PAGE_TYPE_LARGEPAGE | \\r
+ TT_DESCRIPTOR_PAGE_NG_GLOBAL | \\r
+ TT_DESCRIPTOR_PAGE_S_NOT_SHARED | \\r
+ TT_DESCRIPTOR_PAGE_AP_RW_RW | \\r
+ TT_DESCRIPTOR_SECTION_CACHE_POLICY_WRITE_BACK_ALLOC)\r
+#define TT_DESCRIPTOR_LARGEPAGE_WRITE_THROUGH (TT_DESCRIPTOR_PAGE_TYPE_LARGEPAGE | \\r
+ TT_DESCRIPTOR_PAGE_NG_GLOBAL | \\r
+ TT_DESCRIPTOR_PAGE_S_NOT_SHARED | \\r
+ TT_DESCRIPTOR_PAGE_AP_RW_RW | \\r
+ TT_DESCRIPTOR_SECTION_CACHE_POLICY_WRITE_THROUGH_NO_ALLOC)\r
+#define TT_DESCRIPTOR_LARGEPAGE_DEVICE (TT_DESCRIPTOR_PAGE_TYPE_LARGEPAGE | \\r
+ TT_DESCRIPTOR_PAGE_NG_GLOBAL | \\r
+ TT_DESCRIPTOR_PAGE_S_NOT_SHARED | \\r
+ TT_DESCRIPTOR_PAGE_AP_RW_RW | \\r
+ TT_DESCRIPTOR_SECTION_CACHE_POLICY_SHAREABLE_DEVICE)\r
+#define TT_DESCRIPTOR_LARGEPAGE_UNCACHED (TT_DESCRIPTOR_PAGE_TYPE_LARGEPAGE | \\r
+ TT_DESCRIPTOR_PAGE_NG_GLOBAL | \\r
+ TT_DESCRIPTOR_PAGE_S_NOT_SHARED | \\r
+ TT_DESCRIPTOR_PAGE_AP_RW_RW | \\r
+ TT_DESCRIPTOR_SECTION_CACHE_POLICY_NON_CACHEABLE)\r
+\r
+\r
+typedef enum { Level0, Level1,Level2 } MMU_LEVEL;\r
+\r
+typedef struct {\r
+ MMU_LEVEL Level;\r
+ UINT32 Value;\r
+ UINT32 Index;\r
+ UINT32* Table;\r
+} MMU_ENTRY;\r
+\r
+MMU_ENTRY\r
+MmuEntryCreate (\r
+ IN MMU_LEVEL Level,\r
+ IN UINT32* Table,\r
+ IN UINT32 Index\r
+ )\r
+{\r
+ MMU_ENTRY Entry;\r
+ Entry.Level = Level;\r
+ Entry.Value = Table[Index];\r
+ Entry.Table = Table;\r
+ Entry.Index = Index;\r
+ return Entry;\r
+}\r
+\r
+UINT32\r
+MmuEntryIsValidAddress (\r
+ IN MMU_LEVEL Level,\r
+ IN UINT32 Entry\r
+ )\r
+{\r
+ if (Level == Level0) {\r
+ return 0;\r
+ } else if (Level == Level1) {\r
+ if ((Entry & 0x3) == 0) { // Ignored\r
+ return 0;\r
+ } else if ((Entry & 0x3) == 2) { // Section Type\r
+ return 1;\r
+ } else { // Page Type\r
+ return 0;\r
+ }\r
+ } else if (Level == Level2){\r
+ if ((Entry & 0x3) == 0) { // Ignored\r
+ return 0;\r
+ } else { // Page Type\r
+ return 1;\r
+ }\r
+ } else {\r
+ DEBUG((EFI_D_ERROR,"MmuEntryIsValidAddress: Level:%d Entry:0x%X\n",(UINT32)Level,(UINT32)Entry));\r
+ ASSERT(0);\r
+ return 0;\r
+ }\r
+}\r
+\r
+UINT32\r
+MmuEntryGetAddress (\r
+ IN MMU_ENTRY Entry\r
+ )\r
+{\r
+ if (Entry.Level == Level1) {\r
+ if ((Entry.Value & 0x3) == 0) {\r
+ return 0;\r
+ } else if ((Entry.Value & 0x3) == 2) { // Section Type\r
+ return Entry.Value & TT_DESCRIPTOR_SECTION_BASE_ADDRESS_MASK;\r
+ } else if ((Entry.Value & 0x3) == 1) { // Level2 Table\r
+ MMU_ENTRY Level2Entry = MmuEntryCreate (Level2,(UINT32*)(Entry.Value & 0xFFFFC000),0);\r
+ return MmuEntryGetAddress (Level2Entry);\r
+ } else { // Page Type\r
+ return 0;\r
+ }\r
+ } else if (Entry.Level == Level2) {\r
+ if ((Entry.Value & 0x3) == 0) { // Ignored\r
+ return 0;\r
+ } else if ((Entry.Value & 0x3) == 1) { // Large Page\r
+ return Entry.Value & 0xFFFF0000;\r
+ } else if ((Entry.Value & 0x2) == 2) { // Small Page\r
+ return Entry.Value & 0xFFFFF000;\r
+ } else {\r
+ return 0;\r
+ }\r
+ } else {\r
+ ASSERT(0);\r
+ return 0;\r
+ }\r
+}\r
+\r
+UINT32\r
+MmuEntryGetSize (\r
+ IN MMU_ENTRY Entry\r
+ )\r
+{\r
+ if (Entry.Level == Level1) {\r
+ if ((Entry.Value & 0x3) == 0) {\r
+ return 0;\r
+ } else if ((Entry.Value & 0x3) == 2) {\r
+ if (Entry.Value & (1 << 18))\r
+ return 16*SIZE_1MB;\r
+ else\r
+ return SIZE_1MB;\r
+ } else if ((Entry.Value & 0x3) == 1) { // Level2 Table split 1MB section\r
+ return SIZE_1MB;\r
+ } else {\r
+ DEBUG((EFI_D_ERROR, "MmuEntryGetSize: Value:0x%X",Entry.Value));\r
+ ASSERT(0);\r
+ return 0;\r
+ }\r
+ } else if (Entry.Level == Level2) {\r
+ if ((Entry.Value & 0x3) == 0) { // Ignored\r
+ return 0;\r
+ } else if ((Entry.Value & 0x3) == 1) { // Large Page\r
+ return SIZE_64KB;\r
+ } else if ((Entry.Value & 0x2) == 2) { // Small Page\r
+ return SIZE_4KB;\r
+ } else {\r
+ ASSERT(0);\r
+ return 0;\r
+ }\r
+ } else {\r
+ ASSERT(0);\r
+ return 0;\r
+ }\r
+}\r
+\r
+CONST CHAR8*\r
+MmuEntryGetAttributesName (\r
+ IN MMU_ENTRY Entry\r
+ )\r
+{\r
+ UINT32 Value;\r
+\r
+ if (Entry.Level == Level1) {\r
+ Value = GET_TT_ATTRIBUTES(Entry.Value) | TT_DESCRIPTOR_SECTION_NS_MASK;\r
+ if (Value == TT_DESCRIPTOR_SECTION_WRITE_BACK(0))\r
+ return "TT_DESCRIPTOR_SECTION_WRITE_BACK";\r
+ else if (Value == TT_DESCRIPTOR_SECTION_WRITE_THROUGH(0))\r
+ return "TT_DESCRIPTOR_SECTION_WRITE_THROUGH";\r
+ else if (Value == TT_DESCRIPTOR_SECTION_DEVICE(0))\r
+ return "TT_DESCRIPTOR_SECTION_DEVICE";\r
+ else if (Value == TT_DESCRIPTOR_SECTION_UNCACHED(0))\r
+ return "TT_DESCRIPTOR_SECTION_UNCACHED";\r
+ else if (Value == TT_DESCRIPTOR_SECTION_STRONGLY_ORDER)\r
+ return "TT_DESCRIPTOR_SECTION_STRONGLY_ORDERED";\r
+ else {\r
+ return "SectionUnknown";\r
+ }\r
+ } else if ((Entry.Level == Level2) && ((Entry.Value & 0x2) == 2)) { //Small Page\r
+ Value = GET_TT_PAGE_ATTRIBUTES(Entry.Value);\r
+ if (Value == TT_DESCRIPTOR_PAGE_WRITE_BACK)\r
+ return "TT_DESCRIPTOR_PAGE_WRITE_BACK";\r
+ else if (Value == TT_DESCRIPTOR_PAGE_WRITE_THROUGH)\r
+ return "TT_DESCRIPTOR_PAGE_WRITE_THROUGH";\r
+ else if (Value == TT_DESCRIPTOR_PAGE_DEVICE)\r
+ return "TT_DESCRIPTOR_PAGE_DEVICE";\r
+ else if (Value == TT_DESCRIPTOR_PAGE_UNCACHED)\r
+ return "TT_DESCRIPTOR_PAGE_UNCACHED";\r
+ else if (Value == TT_DESCRIPTOR_PAGE_STRONGLY_ORDER)\r
+ return "TT_DESCRIPTOR_PAGE_STRONGLY_ORDERED";\r
+ else {\r
+ return "PageUnknown";\r
+ }\r
+ } else if ((Entry.Level == Level2) && ((Entry.Value & 0x3) == 1)) { //Large Page\r
+ Value = GET_TT_LARGEPAGE_ATTRIBUTES(Entry.Value);\r
+ if (Value == TT_DESCRIPTOR_LARGEPAGE_WRITE_BACK)\r
+ return "TT_DESCRIPTOR_LARGEPAGE_WRITE_BACK";\r
+ else if (Value == TT_DESCRIPTOR_LARGEPAGE_WRITE_THROUGH)\r
+ return "TT_DESCRIPTOR_LARGEPAGE_WRITE_THROUGH";\r
+ else if (Value == TT_DESCRIPTOR_LARGEPAGE_DEVICE)\r
+ return "TT_DESCRIPTOR_LARGEPAGE_DEVICE";\r
+ else if (Value == TT_DESCRIPTOR_LARGEPAGE_UNCACHED)\r
+ return "TT_DESCRIPTOR_LARGEPAGE_UNCACHED";\r
+ else {\r
+ return "LargePageUnknown";\r
+ }\r
+ } else {\r
+ ASSERT(0);\r
+ return "";\r
+ }\r
+}\r
+\r
+UINT32\r
+MmuEntryGetAttributes (\r
+ IN MMU_ENTRY Entry\r
+ )\r
+{\r
+ if (Entry.Level == Level1) {\r
+ if ((Entry.Value & 0x3) == 0) {\r
+ return 0;\r
+ } else if ((Entry.Value & 0x3) == 2) {\r
+ return GET_TT_ATTRIBUTES(Entry.Value);\r
+ } else {\r
+ return 0;\r
+ }\r
+ } else if ((Entry.Level == Level2) && ((Entry.Value & 0x2) == 2)) { //Small Page\r
+ if (GET_TT_PAGE_ATTRIBUTES(Entry.Value) == TT_DESCRIPTOR_PAGE_WRITE_BACK)\r
+ return TT_DESCRIPTOR_SECTION_WRITE_BACK(0);\r
+ else if (GET_TT_PAGE_ATTRIBUTES(Entry.Value) == TT_DESCRIPTOR_PAGE_WRITE_THROUGH)\r
+ return TT_DESCRIPTOR_SECTION_WRITE_THROUGH(0);\r
+ else if (GET_TT_PAGE_ATTRIBUTES(Entry.Value) == TT_DESCRIPTOR_PAGE_DEVICE)\r
+ return TT_DESCRIPTOR_SECTION_DEVICE(0);\r
+ else if (GET_TT_PAGE_ATTRIBUTES(Entry.Value) == TT_DESCRIPTOR_PAGE_UNCACHED)\r
+ return TT_DESCRIPTOR_SECTION_UNCACHED(0);\r
+ else if (GET_TT_PAGE_ATTRIBUTES(Entry.Value) == TT_DESCRIPTOR_PAGE_STRONGLY_ORDER)\r
+ return TT_DESCRIPTOR_SECTION_STRONGLY_ORDER;\r
+ else {\r
+ return 0;\r
+ }\r
+ } else if ((Entry.Level == Level2) && ((Entry.Value & 0x3) == 1)) { //Large Page\r
+ if (GET_TT_LARGEPAGE_ATTRIBUTES(Entry.Value) == TT_DESCRIPTOR_LARGEPAGE_WRITE_BACK)\r
+ return TT_DESCRIPTOR_SECTION_WRITE_BACK(0);\r
+ else if (GET_TT_LARGEPAGE_ATTRIBUTES(Entry.Value) == TT_DESCRIPTOR_LARGEPAGE_WRITE_THROUGH)\r
+ return TT_DESCRIPTOR_SECTION_WRITE_THROUGH(0);\r
+ else if (GET_TT_LARGEPAGE_ATTRIBUTES(Entry.Value) == TT_DESCRIPTOR_LARGEPAGE_DEVICE)\r
+ return TT_DESCRIPTOR_SECTION_DEVICE(0);\r
+ else if (GET_TT_LARGEPAGE_ATTRIBUTES(Entry.Value) == TT_DESCRIPTOR_LARGEPAGE_UNCACHED)\r
+ return TT_DESCRIPTOR_SECTION_UNCACHED(0);\r
+ else {\r
+ return 0;\r
+ }\r
+ } else {\r
+ return 0;\r
+ }\r
+}\r
+\r
+\r
+MMU_ENTRY\r
+DumpMmuLevel (\r
+ IN MMU_LEVEL Level,\r
+ IN UINT32* Table,\r
+ IN MMU_ENTRY PreviousEntry\r
+ )\r
+{\r
+ UINT32 Index = 0, Count;\r
+ MMU_ENTRY LastEntry, Entry;\r
+\r
+ ASSERT((Level == Level1) || (Level == Level2));\r
+\r
+ if (Level == Level1) Count = 4096;\r
+ else Count = 256;\r
+\r
+ // At Level1, we will get into this function because PreviousEntry is not valid\r
+ if (!MmuEntryIsValidAddress((MMU_LEVEL)(Level-1),PreviousEntry.Value)) {\r
+ // Find the first valid address\r
+ for (; (Index < Count) && (!MmuEntryIsValidAddress(Level,Table[Index])); Index++);\r
+\r
+ LastEntry = MmuEntryCreate(Level,Table,Index);\r
+ Index++;\r
+ } else {\r
+ LastEntry = PreviousEntry;\r
+ }\r
+\r
+ for (; Index < Count; Index++) {\r
+ Entry = MmuEntryCreate(Level,Table,Index);\r
+ if ((Level == Level1) && ((Entry.Value & 0x3) == 1)) { // We have got a Level2 table redirection\r
+ LastEntry = DumpMmuLevel(Level2,(UINT32*)(Entry.Value & 0xFFFFFC00),LastEntry);\r
+ } else if (!MmuEntryIsValidAddress(Level,Table[Index])) {\r
+ if (MmuEntryIsValidAddress(LastEntry.Level,LastEntry.Value)) {\r
+ AsciiPrint("0x%08X-0x%08X\t%a\n",\r
+ MmuEntryGetAddress(LastEntry),MmuEntryGetAddress(PreviousEntry)+MmuEntryGetSize(PreviousEntry)-1,\r
+ MmuEntryGetAttributesName(LastEntry));\r
+ }\r
+ LastEntry = Entry;\r
+ } else {\r
+ if (MmuEntryGetAttributes(LastEntry) != MmuEntryGetAttributes(Entry)) {\r
+ if (MmuEntryIsValidAddress(Level,LastEntry.Value)) {\r
+ AsciiPrint("0x%08X-0x%08X\t%a\n",\r
+ MmuEntryGetAddress(LastEntry),MmuEntryGetAddress(PreviousEntry)+MmuEntryGetSize(PreviousEntry)-1,\r
+ MmuEntryGetAttributesName(LastEntry));\r
+ }\r
+ LastEntry = Entry;\r
+ } else {\r
+ ASSERT(LastEntry.Value != 0);\r
+ }\r
+ }\r
+ PreviousEntry = Entry;\r
+ }\r
+\r
+ if ((Level == Level1) && (LastEntry.Index != Index) && MmuEntryIsValidAddress(Level,LastEntry.Value)) {\r
+ AsciiPrint("0x%08X-0x%08X\t%a\n",\r
+ MmuEntryGetAddress(LastEntry),MmuEntryGetAddress(PreviousEntry)+MmuEntryGetSize(PreviousEntry)-1,\r
+ MmuEntryGetAttributesName(LastEntry));\r
+ }\r
+\r
+ return LastEntry;\r
+}\r
+\r
+\r
+EFI_STATUS\r
+EblDumpMmu (\r
+ IN UINTN Argc,\r
+ IN CHAR8 **Argv\r
+ )\r
+{\r
+ UINT32 *TTEntry;\r
+ MMU_ENTRY NoEntry;\r
+\r
+ TTEntry = ArmGetTTBR0BaseAddress();\r
+\r
+ AsciiPrint ("\nTranslation Table:0x%X\n",TTEntry);\r
+ AsciiPrint ("Address Range\t\tAttributes\n");\r
+ AsciiPrint ("____________________________________________________\n");\r
+\r
+ NoEntry.Level = (MMU_LEVEL)200;\r
+ DumpMmuLevel(Level1,TTEntry,NoEntry);\r
+\r
+ return EFI_SUCCESS;\r
+}\r