9a13c975d08f26c322ba4da62677d6fc9c47962b
[reactos.git] / boot / freeldr / freeldr / arch / i386 / hwacpi.c
1 /*
2 * FreeLoader
3 *
4 * Copyright (C) 2004 Eric Kohl
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License along
17 * with this program; if not, write to the Free Software Foundation, Inc.,
18 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
19 */
20
21 #include <freeldr.h>
22 #include <debug.h>
23
24 DBG_DEFAULT_CHANNEL(HWDETECT);
25
26 BOOLEAN AcpiPresent = FALSE;
27
28 static PRSDP_DESCRIPTOR
29 FindAcpiBios(VOID)
30 {
31 PUCHAR Ptr;
32
33 /* Find the 'Root System Descriptor Table Pointer' */
34 Ptr = (PUCHAR)0xE0000;
35 while ((ULONG_PTR)Ptr < 0x100000)
36 {
37 if (!memcmp(Ptr, "RSD PTR ", 8))
38 {
39 TRACE("ACPI supported\n");
40
41 return (PRSDP_DESCRIPTOR)Ptr;
42 }
43
44 Ptr = (PUCHAR)((ULONG_PTR)Ptr + 0x10);
45 }
46
47 TRACE("ACPI not supported\n");
48
49 return NULL;
50 }
51
52
53 VOID
54 DetectAcpiBios(PCONFIGURATION_COMPONENT_DATA SystemKey, ULONG *BusNumber)
55 {
56 PCONFIGURATION_COMPONENT_DATA BiosKey;
57 PCM_PARTIAL_RESOURCE_LIST PartialResourceList;
58 PCM_PARTIAL_RESOURCE_DESCRIPTOR PartialDescriptor;
59 PRSDP_DESCRIPTOR Rsdp;
60 PACPI_BIOS_DATA AcpiBiosData;
61 ULONG TableSize;
62
63 Rsdp = FindAcpiBios();
64
65 if (Rsdp)
66 {
67 /* Set up the flag in the loader block */
68 AcpiPresent = TRUE;
69
70 /* Calculate the table size */
71 TableSize = PcBiosMapCount * sizeof(BIOS_MEMORY_MAP) +
72 sizeof(ACPI_BIOS_DATA) - sizeof(BIOS_MEMORY_MAP);
73
74 /* Set 'Configuration Data' value */
75 PartialResourceList =
76 FrLdrHeapAlloc(sizeof(CM_PARTIAL_RESOURCE_LIST) + TableSize,
77 TAG_HW_RESOURCE_LIST);
78
79 if (PartialResourceList == NULL)
80 {
81 ERR("Failed to allocate resource descriptor\n");
82 return;
83 }
84
85 memset(PartialResourceList, 0, sizeof(CM_PARTIAL_RESOURCE_LIST) + TableSize);
86 PartialResourceList->Version = 0;
87 PartialResourceList->Revision = 0;
88 PartialResourceList->Count = 1;
89
90 PartialDescriptor = &PartialResourceList->PartialDescriptors[0];
91 PartialDescriptor->Type = CmResourceTypeDeviceSpecific;
92 PartialDescriptor->ShareDisposition = CmResourceShareUndetermined;
93 PartialDescriptor->u.DeviceSpecificData.DataSize = TableSize;
94
95 /* Fill the table */
96 AcpiBiosData = (PACPI_BIOS_DATA)&PartialResourceList->PartialDescriptors[1];
97 AcpiBiosData->RSDTAddress.LowPart = Rsdp->rsdt_physical_address;
98 AcpiBiosData->Count = PcBiosMapCount;
99 memcpy(AcpiBiosData->MemoryMap, PcBiosMemoryMap,
100 PcBiosMapCount * sizeof(BIOS_MEMORY_MAP));
101
102 TRACE("RSDT %p, data size %x\n", Rsdp->rsdt_physical_address,
103 TableSize);
104
105 /* Create new bus key */
106 FldrCreateComponentKey(SystemKey,
107 AdapterClass,
108 MultiFunctionAdapter,
109 0x0,
110 0x0,
111 0xFFFFFFFF,
112 "ACPI BIOS",
113 PartialResourceList,
114 sizeof(CM_PARTIAL_RESOURCE_LIST) + TableSize,
115 &BiosKey);
116
117 /* Increment bus number */
118 (*BusNumber)++;
119 }
120 }
121
122 /* EOF */