4 * Copyright (C) 2004 Eric Kohl
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.
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.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
26 typedef struct _ROUTING_SLOT
40 } __attribute__((packed
)) ROUTING_SLOT
, *PROUTING_SLOT
;
42 typedef struct _PCI_IRQ_ROUTING_TABLE
50 ULONG CompatibleRouter
;
55 } __attribute__((packed
)) PCI_IRQ_ROUTING_TABLE
, *PPCI_IRQ_ROUTING_TABLE
;
57 typedef struct _CM_PCI_BUS_DATA
61 UCHAR HardwareMechanism
;
62 } __attribute__((packed
)) CM_PCI_BUS_DATA
, *PCM_PCI_BUS_DATA
;
65 static PPCI_IRQ_ROUTING_TABLE
66 GetPciIrqRoutingTable(VOID
)
68 PPCI_IRQ_ROUTING_TABLE Table
;
73 Table
= (PPCI_IRQ_ROUTING_TABLE
)0xF0000;
74 while ((ULONG
)Table
< 0x100000)
76 if (Table
->Signature
== 0x52495024)
78 DbgPrint((DPRINT_HWDETECT
,
79 "Found signature\n"));
83 for (i
= 0; i
< Table
->Size
; i
++)
88 if ((Sum
& 0xFF) != 0)
90 DbgPrint((DPRINT_HWDETECT
,
91 "Invalid routing table\n"));
95 DbgPrint((DPRINT_HWDETECT
,
101 Table
= (PPCI_IRQ_ROUTING_TABLE
)((ULONG
)Table
+ 0x10);
109 FindPciBios(PCM_PCI_BUS_DATA BusData
)
114 RegsIn
.b
.ah
= 0xB1; /* Subfunction B1h */
115 RegsIn
.b
.al
= 0x01; /* PCI BIOS present */
117 Int386(0x1A, &RegsIn
, &RegsOut
);
119 if (INT386_SUCCESS(RegsOut
) && RegsOut
.d
.edx
== 0x20494350 && RegsOut
.b
.ah
== 0)
121 DbgPrint((DPRINT_HWDETECT
, "Found PCI bios\n"));
123 DbgPrint((DPRINT_HWDETECT
, "AL: %x\n", RegsOut
.b
.al
));
124 DbgPrint((DPRINT_HWDETECT
, "BH: %x\n", RegsOut
.b
.bh
));
125 DbgPrint((DPRINT_HWDETECT
, "BL: %x\n", RegsOut
.b
.bl
));
126 DbgPrint((DPRINT_HWDETECT
, "CL: %x\n", RegsOut
.b
.cl
));
128 BusData
->BusCount
= RegsOut
.b
.cl
+ 1;
129 BusData
->PciVersion
= RegsOut
.w
.bx
;
130 BusData
->HardwareMechanism
= RegsOut
.b
.cl
;
136 DbgPrint((DPRINT_HWDETECT
, "No PCI bios found\n"));
143 DetectPciIrqRoutingTable(PCONFIGURATION_COMPONENT_DATA BusKey
)
145 PCM_FULL_RESOURCE_DESCRIPTOR FullResourceDescriptor
;
146 PCM_PARTIAL_RESOURCE_DESCRIPTOR PartialDescriptor
;
147 PPCI_IRQ_ROUTING_TABLE Table
;
148 PCONFIGURATION_COMPONENT_DATA TableKey
;
151 Table
= GetPciIrqRoutingTable();
154 DbgPrint((DPRINT_HWDETECT
, "Table size: %u\n", Table
->Size
));
156 FldrCreateComponentKey(BusKey
,
157 L
"RealModeIrqRoutingTable",
160 RealModeIrqRoutingTable
,
163 /* Set 'Component Information' */
164 FldrSetComponentInformation(TableKey
,
169 /* Set 'Identifier' value */
170 FldrSetIdentifier(TableKey
, L
"PCI Real-mode IRQ Routing Table");
172 /* Set 'Configuration Data' value */
173 Size
= FIELD_OFFSET(CM_FULL_RESOURCE_DESCRIPTOR
, PartialResourceList
.PartialDescriptors
) +
174 2 * sizeof(CM_PARTIAL_RESOURCE_DESCRIPTOR
) + Table
->Size
;
175 FullResourceDescriptor
= MmAllocateMemory(Size
);
176 if (FullResourceDescriptor
== NULL
)
178 DbgPrint((DPRINT_HWDETECT
,
179 "Failed to allocate resource descriptor\n"));
183 /* Initialize resource descriptor */
184 memset(FullResourceDescriptor
, 0, Size
);
185 FullResourceDescriptor
->InterfaceType
= Isa
;
186 FullResourceDescriptor
->BusNumber
= 0;
187 FullResourceDescriptor
->PartialResourceList
.Version
= 1;
188 FullResourceDescriptor
->PartialResourceList
.Revision
= 1;
189 FullResourceDescriptor
->PartialResourceList
.Count
= 2;
191 PartialDescriptor
= &FullResourceDescriptor
->PartialResourceList
.PartialDescriptors
[0];
192 PartialDescriptor
->Type
= CmResourceTypeBusNumber
;
193 PartialDescriptor
->ShareDisposition
= CmResourceShareDeviceExclusive
;
194 PartialDescriptor
->u
.BusNumber
.Start
= 0;
195 PartialDescriptor
->u
.BusNumber
.Length
= 1;
197 PartialDescriptor
= &FullResourceDescriptor
->PartialResourceList
.PartialDescriptors
[1];
198 PartialDescriptor
->Type
= CmResourceTypeDeviceSpecific
;
199 PartialDescriptor
->ShareDisposition
= CmResourceShareUndetermined
;
200 PartialDescriptor
->u
.DeviceSpecificData
.DataSize
= Table
->Size
;
202 memcpy(&FullResourceDescriptor
->PartialResourceList
.PartialDescriptors
[2],
206 /* Set 'Configuration Data' value */
207 FldrSetConfigurationData(TableKey
, FullResourceDescriptor
, Size
);
208 MmFreeMemory(FullResourceDescriptor
);
214 DetectPciBios(PCONFIGURATION_COMPONENT_DATA SystemKey
, ULONG
*BusNumber
)
216 PCM_FULL_RESOURCE_DESCRIPTOR FullResourceDescriptor
;
217 CM_PCI_BUS_DATA BusData
;
218 PCONFIGURATION_COMPONENT_DATA BiosKey
;
221 PCONFIGURATION_COMPONENT_DATA BusKey
;
223 WCHAR szPci
[] = L
"PCI";
226 /* Report the PCI BIOS */
227 if (FindPciBios(&BusData
))
229 /* Create new bus key */
230 FldrCreateComponentKey(SystemKey
,
231 L
"MultifunctionAdapter",
234 MultiFunctionAdapter
,
237 /* Set 'Component Information' */
238 FldrSetComponentInformation(BiosKey
,
243 /* Increment bus number */
246 /* Set 'Identifier' value */
247 FldrSetIdentifier(BiosKey
, L
"PCI BIOS");
249 /* Set 'Configuration Data' value */
250 Size
= sizeof(CM_FULL_RESOURCE_DESCRIPTOR
);
251 FullResourceDescriptor
= MmAllocateMemory(Size
);
252 if (FullResourceDescriptor
== NULL
)
254 DbgPrint((DPRINT_HWDETECT
,
255 "Failed to allocate resource descriptor\n"));
259 /* Initialize resource descriptor */
260 memset(FullResourceDescriptor
, 0, Size
);
261 FullResourceDescriptor
->InterfaceType
= PCIBus
;
262 FullResourceDescriptor
->BusNumber
= 0;
263 FullResourceDescriptor
->PartialResourceList
.Version
= 1;
264 FullResourceDescriptor
->PartialResourceList
.Revision
= 1;
265 FullResourceDescriptor
->PartialResourceList
.Count
= 1;
266 FullResourceDescriptor
->PartialResourceList
.PartialDescriptors
[0].Type
= CmResourceTypeBusNumber
;
267 FullResourceDescriptor
->PartialResourceList
.PartialDescriptors
[0].ShareDisposition
= CmResourceShareDeviceExclusive
;
268 FullResourceDescriptor
->PartialResourceList
.PartialDescriptors
[0].u
.BusNumber
.Start
= 0;
269 FullResourceDescriptor
->PartialResourceList
.PartialDescriptors
[0].u
.BusNumber
.Length
= 1;
271 /* Set 'Configuration Data' value */
272 FldrSetConfigurationData(BiosKey
, FullResourceDescriptor
, Size
);
273 MmFreeMemory(FullResourceDescriptor
);
275 DetectPciIrqRoutingTable(BiosKey
);
280 * Enabling this piece of code will corrupt the boot sequence!
281 * This is probably caused by a bug in the registry code!
284 /* Report PCI buses */
285 for (i
= 0; i
< (ULONG
)BusData
.BusCount
; i
++)
287 FldrCreateComponentKey(SystemKey
,
288 L
"MultifunctionAdapter",
291 MultiFunctionAdapter
,
294 /* Set 'Component Information' */
295 FldrSetComponentInformation(BusKey
,
300 /* Increment bus number */
303 /* Set 'Identifier' value */
304 FldrSetIdentifier(BiosKey
, szPci
);