1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
|
/*
* Copyright (c) 2021, Konstantin Aladyshev <aladyshev22@gmail.com>
*
* SPDX-License-Identifier: MIT
*/
#include <Library/UefiBootServicesTableLib.h>
#include <Library/UefiLib.h>
#include <Library/BaseMemoryLib.h>
#include <Protocol/Shell.h>
EFI_SHELL_PROTOCOL* ShellProtocol;
EFI_STATUS SaveACPITable(UINT32 Signature, VOID* addr, UINTN size) {
CHAR16 TableName[5];
TableName[0] = (CHAR16)((Signature>> 0)&0xFF);
TableName[1] = (CHAR16)((Signature>> 8)&0xFF);
TableName[2] = (CHAR16)((Signature>>16)&0xFF);
TableName[3] = (CHAR16)((Signature>>24)&0xFF);
TableName[4] = 0;
CHAR16 FileName[9] = {0};
StrCpyS(FileName, 9, TableName);
StrCatS(FileName, 9, L".aml");
SHELL_FILE_HANDLE FileHandle;
EFI_STATUS Status = ShellProtocol->OpenFileByName(FileName,
&FileHandle,
EFI_FILE_MODE_CREATE |
EFI_FILE_MODE_WRITE |
EFI_FILE_MODE_READ);
if (!EFI_ERROR(Status)) {
Status = ShellProtocol->WriteFile(FileHandle, &size, addr);
if (EFI_ERROR(Status)) {
Print(L"Error in WriteFile: %r\n", Status);
}
Status = ShellProtocol->CloseFile(FileHandle);
if (EFI_ERROR(Status)) {
Print(L"Error in CloseFile: %r\n", Status);
}
} else {
Print(L"Error in OpenFileByName: %r\n", Status);
}
return Status;
}
VOID CheckSubtables(EFI_ACPI_6_3_COMMON_HEADER* table)
{
if (((CHAR8)((table->Signature >> 0) & 0xFF) == 'F') &&
((CHAR8)((table->Signature >> 8) & 0xFF) == 'A') &&
((CHAR8)((table->Signature >> 16) & 0xFF) == 'C') &&
((CHAR8)((table->Signature >> 24) & 0xFF) == 'P')) {
EFI_ACPI_6_3_FIXED_ACPI_DESCRIPTION_TABLE* FADT = (EFI_ACPI_6_3_FIXED_ACPI_DESCRIPTION_TABLE*)table;
EFI_ACPI_6_3_COMMON_HEADER* DSDT = (EFI_ACPI_6_3_COMMON_HEADER*)(UINT64)(FADT->Dsdt);
if (((CHAR8)((DSDT->Signature >> 0) & 0xFF) == 'D') &&
((CHAR8)((DSDT->Signature >> 8) & 0xFF) == 'S') &&
((CHAR8)((DSDT->Signature >> 16) & 0xFF) == 'D') &&
((CHAR8)((DSDT->Signature >> 24) & 0xFF) == 'T')) {
Print(L"\tDSDT table is placed at address %p with length 0x%x\n", DSDT, DSDT->Length);
SaveACPITable(DSDT->Signature, DSDT, DSDT->Length);
} else {
Print(L"\tError! DSDT signature is not valid!\n");
}
EFI_ACPI_6_3_COMMON_HEADER* FACS = (EFI_ACPI_6_3_COMMON_HEADER*)(UINT64)(FADT->FirmwareCtrl);
if (((CHAR8)((FACS->Signature >> 0) & 0xFF) == 'F') &&
((CHAR8)((FACS->Signature >> 8) & 0xFF) == 'A') &&
((CHAR8)((FACS->Signature >> 16) & 0xFF) == 'C') &&
((CHAR8)((FACS->Signature >> 24) & 0xFF) == 'S')) {
Print(L"\tFACS table is placed at address %p with length 0x%x\n", FACS, FACS->Length);
SaveACPITable(FACS->Signature, FACS, FACS->Length);
} else {
Print(L"\tError! FACS signature is not valid!\n");
}
}
}
EFI_STATUS
EFIAPI
UefiMain (
IN EFI_HANDLE ImageHandle,
IN EFI_SYSTEM_TABLE *SystemTable
)
{
EFI_STATUS Status = gBS->LocateProtocol(
&gEfiShellProtocolGuid,
NULL,
(VOID **)&ShellProtocol
);
if (EFI_ERROR(Status)) {
Print(L"Can't open EFI_SHELL_PROTOCOL: %r\n", Status);
return EFI_SUCCESS;
}
EFI_ACPI_6_3_ROOT_SYSTEM_DESCRIPTION_POINTER* RSDP = NULL;
for (UINTN i=0; i<SystemTable->NumberOfTableEntries; i++) {
if (CompareGuid(&(SystemTable->ConfigurationTable[i].VendorGuid), &gEfiAcpi20TableGuid)) {
Print(L"RSDP table is placed at %p\n\n", SystemTable->ConfigurationTable[i].VendorTable);
RSDP = SystemTable->ConfigurationTable[i].VendorTable;
}
}
if (!RSDP) {
Print(L"No ACPI2.0 table was found in the system\n");
return EFI_SUCCESS;
}
if (((CHAR8)((RSDP->Signature >> 0) & 0xFF) != 'R') ||
((CHAR8)((RSDP->Signature >> 8) & 0xFF) != 'S') ||
((CHAR8)((RSDP->Signature >> 16) & 0xFF) != 'D') ||
((CHAR8)((RSDP->Signature >> 24) & 0xFF) != ' ') ||
((CHAR8)((RSDP->Signature >> 32) & 0xFF) != 'P') ||
((CHAR8)((RSDP->Signature >> 40) & 0xFF) != 'T') ||
((CHAR8)((RSDP->Signature >> 48) & 0xFF) != 'R') ||
((CHAR8)((RSDP->Signature >> 56) & 0xFF) != ' ')) {
Print(L"Error! RSDP signature is not valid!\n");
return EFI_SUCCESS;
}
Print(L"System description tables:\n");
Print(L"\tRSDT table is placed at address %p\n", RSDP->RsdtAddress);
Print(L"\tXSDT table is placed at address %p\n", RSDP->XsdtAddress);
Print(L"\n");
EFI_ACPI_DESCRIPTION_HEADER* XSDT = (EFI_ACPI_DESCRIPTION_HEADER*)RSDP->XsdtAddress;
if (((CHAR8)((XSDT->Signature >> 0) & 0xFF) != 'X') ||
((CHAR8)((XSDT->Signature >> 8) & 0xFF) != 'S') ||
((CHAR8)((XSDT->Signature >> 16) & 0xFF) != 'D') ||
((CHAR8)((XSDT->Signature >> 24) & 0xFF) != 'T')) {
Print(L"Error! XSDT signature is not valid!\n");
return EFI_SUCCESS;
}
Print(L"Main ACPI tables:\n");
UINT64 offset = sizeof(EFI_ACPI_DESCRIPTION_HEADER);
while (offset < XSDT->Length) {
UINT64* table_address = (UINT64*)((UINT8*)XSDT + offset);
EFI_ACPI_6_3_COMMON_HEADER* table = (EFI_ACPI_6_3_COMMON_HEADER*)(*table_address);
Print(L"\t%c%c%c%c table is placed at address %p with length 0x%x\n",
(CHAR8)((table->Signature>> 0)&0xFF),
(CHAR8)((table->Signature>> 8)&0xFF),
(CHAR8)((table->Signature>>16)&0xFF),
(CHAR8)((table->Signature>>24)&0xFF),
table,
table->Length);
SaveACPITable(table->Signature, table, table->Length);
CheckSubtables(table);
offset += sizeof(UINT64);
}
return EFI_SUCCESS;
}
|
