IN PVOID DeviceId,
OUT PULONG Slot)
{
- PCI_SLOT_NUMBER PciSlotNumber;
- ULONG DeviceNumber;
- ULONG FunctionNumber;
- PCI_COMMON_CONFIG Config;
- PCM_RESOURCE_LIST AllocatedResources;
- NTSTATUS Status;
- UINT AssignedCount;
- CM_FULL_RESOURCE_DESCRIPTOR *FullList;
- CM_PARTIAL_RESOURCE_DESCRIPTOR *Descriptor;
- PVIDEO_PORT_DEVICE_EXTENSION DeviceExtension;
- PVIDEO_PORT_DRIVER_EXTENSION DriverExtension;
- USHORT VendorIdToFind;
- USHORT DeviceIdToFind;
- ULONG ReturnedLength;
- PVIDEO_ACCESS_RANGE LegacyAccessRanges;
- ULONG LegacyAccessRangeCount;
- PDRIVER_OBJECT DriverObject;
- BOOLEAN DeviceAndVendorFound = FALSE;
-
- TRACE_(VIDEOPRT, "VideoPortGetAccessRanges\n");
-
- DeviceExtension = VIDEO_PORT_GET_DEVICE_EXTENSION(HwDeviceExtension);
- DriverObject = DeviceExtension->DriverObject;
- DriverExtension = IoGetDriverObjectExtension(DriverObject, DriverObject);
-
- if (NumRequestedResources == 0)
- {
- AllocatedResources = DeviceExtension->AllocatedResources;
- if (AllocatedResources == NULL &&
- DeviceExtension->AdapterInterfaceType == PCIBus)
- {
- if (DeviceExtension->PhysicalDeviceObject != NULL)
- {
- PciSlotNumber.u.AsULONG = DeviceExtension->SystemIoSlotNumber;
-
- ReturnedLength = HalGetBusData(
- PCIConfiguration,
- DeviceExtension->SystemIoBusNumber,
- PciSlotNumber.u.AsULONG,
- &Config,
- sizeof(PCI_COMMON_CONFIG));
-
- if (ReturnedLength != sizeof(PCI_COMMON_CONFIG))
- {
- return ERROR_NOT_ENOUGH_MEMORY;
- }
- }
- else
- {
- VendorIdToFind = VendorId != NULL ? *(PUSHORT)VendorId : 0;
- DeviceIdToFind = DeviceId != NULL ? *(PUSHORT)DeviceId : 0;
+ PCI_SLOT_NUMBER PciSlotNumber;
+ ULONG DeviceNumber;
+ ULONG FunctionNumber;
+ PCI_COMMON_CONFIG Config;
+ PCM_RESOURCE_LIST AllocatedResources;
+ NTSTATUS Status;
+ UINT AssignedCount;
+ CM_FULL_RESOURCE_DESCRIPTOR *FullList;
+ CM_PARTIAL_RESOURCE_DESCRIPTOR *Descriptor;
+ PVIDEO_PORT_DEVICE_EXTENSION DeviceExtension;
+ PVIDEO_PORT_DRIVER_EXTENSION DriverExtension;
+ USHORT VendorIdToFind;
+ USHORT DeviceIdToFind;
+ ULONG ReturnedLength;
+ PVIDEO_ACCESS_RANGE LegacyAccessRanges;
+ ULONG LegacyAccessRangeCount;
+ PDRIVER_OBJECT DriverObject;
+ ULONG ListSize;
+ PIO_RESOURCE_REQUIREMENTS_LIST ResReqList;
+ BOOLEAN DeviceAndVendorFound = FALSE;
+
+ TRACE_(VIDEOPRT, "VideoPortGetAccessRanges\n");
+
+ DeviceExtension = VIDEO_PORT_GET_DEVICE_EXTENSION(HwDeviceExtension);
+ DriverObject = DeviceExtension->DriverObject;
+ DriverExtension = IoGetDriverObjectExtension(DriverObject, DriverObject);
- if (VendorIdToFind == 0 && DeviceIdToFind == 0)
+ if (NumRequestedResources == 0)
+ {
+ AllocatedResources = DeviceExtension->AllocatedResources;
+ if (AllocatedResources == NULL &&
+ DeviceExtension->AdapterInterfaceType == PCIBus)
+ {
+ if (DeviceExtension->PhysicalDeviceObject != NULL)
{
- /* We're screwed */
- return ERROR_DEV_NOT_EXIST;
+ PciSlotNumber.u.AsULONG = DeviceExtension->SystemIoSlotNumber;
+
+ ReturnedLength = HalGetBusData(PCIConfiguration,
+ DeviceExtension->SystemIoBusNumber,
+ PciSlotNumber.u.AsULONG,
+ &Config,
+ sizeof(PCI_COMMON_CONFIG));
+
+ if (ReturnedLength != sizeof(PCI_COMMON_CONFIG))
+ {
+ return ERROR_NOT_ENOUGH_MEMORY;
+ }
}
-
- INFO_(VIDEOPRT, "Looking for VendorId 0x%04x DeviceId 0x%04x\n",
- VendorIdToFind, DeviceIdToFind);
-
- /*
- * Search for the device id and vendor id on this bus.
- */
- for (DeviceNumber = 0; DeviceNumber < PCI_MAX_DEVICES; DeviceNumber++)
+ else
{
- PciSlotNumber.u.bits.DeviceNumber = DeviceNumber;
- for (FunctionNumber = 0; FunctionNumber < PCI_MAX_FUNCTION; FunctionNumber++)
- {
- INFO_(VIDEOPRT, "- Function number: %d\n", FunctionNumber);
- PciSlotNumber.u.bits.FunctionNumber = FunctionNumber;
- ReturnedLength = HalGetBusData(
- PCIConfiguration,
- DeviceExtension->SystemIoBusNumber,
- PciSlotNumber.u.AsULONG,
- &Config,
- sizeof(PCI_COMMON_CONFIG));
- INFO_(VIDEOPRT, "- Length of data: %x\n", ReturnedLength);
- if (ReturnedLength == sizeof(PCI_COMMON_CONFIG))
- {
- INFO_(VIDEOPRT, "- Slot 0x%02x (Device %d Function %d) VendorId 0x%04x "
- "DeviceId 0x%04x\n",
- PciSlotNumber.u.AsULONG,
- PciSlotNumber.u.bits.DeviceNumber,
- PciSlotNumber.u.bits.FunctionNumber,
- Config.VendorID,
- Config.DeviceID);
-
- if ((VendorIdToFind == 0 || Config.VendorID == VendorIdToFind) &&
- (DeviceIdToFind == 0 || Config.DeviceID == DeviceIdToFind))
- {
- DeviceAndVendorFound = TRUE;
- break;
- }
- }
- }
- if (DeviceAndVendorFound) break;
+ VendorIdToFind = VendorId != NULL ? *(PUSHORT)VendorId : 0;
+ DeviceIdToFind = DeviceId != NULL ? *(PUSHORT)DeviceId : 0;
+
+ if (VendorIdToFind == 0 && DeviceIdToFind == 0)
+ {
+ /* We're screwed */
+ return ERROR_DEV_NOT_EXIST;
+ }
+
+ INFO_(VIDEOPRT, "Looking for VendorId 0x%04x DeviceId 0x%04x\n",
+ VendorIdToFind, DeviceIdToFind);
+
+ /*
+ * Search for the device id and vendor id on this bus.
+ */
+ for (DeviceNumber = 0; DeviceNumber < PCI_MAX_DEVICES; DeviceNumber++)
+ {
+ PciSlotNumber.u.bits.DeviceNumber = DeviceNumber;
+ for (FunctionNumber = 0; FunctionNumber < PCI_MAX_FUNCTION; FunctionNumber++)
+ {
+ INFO_(VIDEOPRT, "- Function number: %d\n", FunctionNumber);
+ PciSlotNumber.u.bits.FunctionNumber = FunctionNumber;
+ ReturnedLength = HalGetBusData(PCIConfiguration,
+ DeviceExtension->SystemIoBusNumber,
+ PciSlotNumber.u.AsULONG,
+ &Config,
+ sizeof(PCI_COMMON_CONFIG));
+ INFO_(VIDEOPRT, "- Length of data: %x\n", ReturnedLength);
+ if (ReturnedLength == sizeof(PCI_COMMON_CONFIG))
+ {
+ INFO_(VIDEOPRT, "- Slot 0x%02x (Device %d Function %d) VendorId 0x%04x "
+ "DeviceId 0x%04x\n",
+ PciSlotNumber.u.AsULONG,
+ PciSlotNumber.u.bits.DeviceNumber,
+ PciSlotNumber.u.bits.FunctionNumber,
+ Config.VendorID,
+ Config.DeviceID);
+
+ if ((VendorIdToFind == 0 || Config.VendorID == VendorIdToFind) &&
+ (DeviceIdToFind == 0 || Config.DeviceID == DeviceIdToFind))
+ {
+ DeviceAndVendorFound = TRUE;
+ break;
+ }
+ }
+ }
+ if (DeviceAndVendorFound) break;
+ }
+ if (FunctionNumber == PCI_MAX_FUNCTION)
+ {
+ WARN_(VIDEOPRT, "Didn't find device.\n");
+ return ERROR_DEV_NOT_EXIST;
+ }
}
- if (FunctionNumber == PCI_MAX_FUNCTION)
+
+ Status = HalAssignSlotResources(&DeviceExtension->RegistryPath,
+ NULL,
+ DeviceExtension->DriverObject,
+ DeviceExtension->DriverObject->DeviceObject,
+ DeviceExtension->AdapterInterfaceType,
+ DeviceExtension->SystemIoBusNumber,
+ PciSlotNumber.u.AsULONG,
+ &AllocatedResources);
+
+ if (!NT_SUCCESS(Status))
{
- WARN_(VIDEOPRT, "Didn't find device.\n");
- return ERROR_DEV_NOT_EXIST;
+ WARN_(VIDEOPRT, "HalAssignSlotResources failed with status %x.\n",Status);
+ return Status;
}
- }
-
- Status = HalAssignSlotResources(
- &DeviceExtension->RegistryPath,
- NULL,
- DeviceExtension->DriverObject,
- DeviceExtension->DriverObject->DeviceObject,
- DeviceExtension->AdapterInterfaceType,
- DeviceExtension->SystemIoBusNumber,
- PciSlotNumber.u.AsULONG,
- &AllocatedResources);
-
- if (!NT_SUCCESS(Status))
- {
- WARN_(VIDEOPRT, "HalAssignSlotResources failed with status %x.\n",Status);
+ DeviceExtension->AllocatedResources = AllocatedResources;
+ }
+ }
+ else
+ {
+ ListSize = sizeof(IO_RESOURCE_REQUIREMENTS_LIST) + (NumRequestedResources - 1) * sizeof(IO_RESOURCE_DESCRIPTOR);
+ ResReqList = ExAllocatePool(NonPagedPool, ListSize);
+ if (!ResReqList) return ERROR_NOT_ENOUGH_MEMORY;
+
+ ResReqList->ListSize = ListSize;
+ ResReqList->InterfaceType = DeviceExtension->AdapterInterfaceType;
+ ResReqList->BusNumber = DeviceExtension->SystemIoBusNumber;
+ ResReqList->SlotNumber = DeviceExtension->SystemIoSlotNumber;
+ ResReqList->AlternativeLists = 1;
+ ResReqList->List[0].Version = 1;
+ ResReqList->List[0].Revision = 1;
+ ResReqList->List[0].Count = NumRequestedResources;
+
+ /* Copy in the caller's resource list */
+ RtlCopyMemory(ResReqList->List[0].Descriptors,
+ RequestedResources,
+ NumRequestedResources * sizeof(IO_RESOURCE_DESCRIPTOR));
+
+ Status = IoAssignResources(&DeviceExtension->RegistryPath,
+ NULL,
+ DeviceExtension->DriverObject,
+ DeviceExtension->PhysicalDeviceObject ?
+ DeviceExtension->PhysicalDeviceObject :
+ DeviceExtension->DriverObject->DeviceObject,
+ ResReqList,
+ &AllocatedResources);
+
+ if (!NT_SUCCESS(Status))
return Status;
- }
- DeviceExtension->AllocatedResources = AllocatedResources;
-
- /* Return the slot number if the caller wants it */
- if (Slot != NULL) *Slot = PciSlotNumber.u.AsULONG;
-
- }
- if (AllocatedResources == NULL)
- return ERROR_NOT_ENOUGH_MEMORY;
- Status = IntVideoPortGetLegacyResources(DriverExtension, DeviceExtension,
- &LegacyAccessRanges, &LegacyAccessRangeCount);
- if (!NT_SUCCESS(Status))
- return ERROR_DEV_NOT_EXIST;
- if (NumAccessRanges < LegacyAccessRangeCount)
- return ERROR_NOT_ENOUGH_MEMORY;
- RtlCopyMemory(AccessRanges, LegacyAccessRanges, LegacyAccessRangeCount * sizeof(VIDEO_ACCESS_RANGE));
- AssignedCount = LegacyAccessRangeCount;
- for (FullList = AllocatedResources->List;
- FullList < AllocatedResources->List + AllocatedResources->Count;
- FullList++)
- {
- INFO_(VIDEOPRT, "InterfaceType %u BusNumber List %u Device BusNumber %u Version %u Revision %u\n",
- FullList->InterfaceType, FullList->BusNumber, DeviceExtension->SystemIoBusNumber, FullList->PartialResourceList.Version, FullList->PartialResourceList.Revision);
-
- ASSERT(FullList->InterfaceType == PCIBus);
- ASSERT(FullList->BusNumber == DeviceExtension->SystemIoBusNumber);
- ASSERT(1 == FullList->PartialResourceList.Version);
- ASSERT(1 == FullList->PartialResourceList.Revision);
- for (Descriptor = FullList->PartialResourceList.PartialDescriptors;
- Descriptor < FullList->PartialResourceList.PartialDescriptors + FullList->PartialResourceList.Count;
- Descriptor++)
- {
+
+ if (!DeviceExtension->AllocatedResources)
+ DeviceExtension->AllocatedResources = AllocatedResources;
+ }
+
+ if (AllocatedResources == NULL)
+ return ERROR_NOT_ENOUGH_MEMORY;
+
+ /* Return the slot number if the caller wants it */
+ if (Slot != NULL) *Slot = DeviceExtension->SystemIoBusNumber;
+
+ Status = IntVideoPortGetLegacyResources(DriverExtension, DeviceExtension,
+ &LegacyAccessRanges, &LegacyAccessRangeCount);
+ if (!NT_SUCCESS(Status))
+ return ERROR_DEV_NOT_EXIST;
+ if (NumAccessRanges < LegacyAccessRangeCount)
+ return ERROR_NOT_ENOUGH_MEMORY;
+ RtlCopyMemory(AccessRanges, LegacyAccessRanges, LegacyAccessRangeCount * sizeof(VIDEO_ACCESS_RANGE));
+ AssignedCount = LegacyAccessRangeCount;
+ for (FullList = AllocatedResources->List;
+ FullList < AllocatedResources->List + AllocatedResources->Count;
+ FullList++)
+ {
+ INFO_(VIDEOPRT, "InterfaceType %u BusNumber List %u Device BusNumber %u Version %u Revision %u\n",
+ FullList->InterfaceType, FullList->BusNumber, DeviceExtension->SystemIoBusNumber, FullList->PartialResourceList.Version, FullList->PartialResourceList.Revision);
+
+ ASSERT(FullList->InterfaceType == PCIBus);
+ ASSERT(FullList->BusNumber == DeviceExtension->SystemIoBusNumber);
+ ASSERT(1 == FullList->PartialResourceList.Version);
+ ASSERT(1 == FullList->PartialResourceList.Revision);
+ for (Descriptor = FullList->PartialResourceList.PartialDescriptors;
+ Descriptor < FullList->PartialResourceList.PartialDescriptors + FullList->PartialResourceList.Count;
+ Descriptor++)
+ {
if ((Descriptor->Type == CmResourceTypeMemory ||
Descriptor->Type == CmResourceTypePort) &&
AssignedCount >= NumAccessRanges)
{
- WARN_(VIDEOPRT, "Too many access ranges found\n");
- return ERROR_NOT_ENOUGH_MEMORY;
+ WARN_(VIDEOPRT, "Too many access ranges found\n");
+ return ERROR_NOT_ENOUGH_MEMORY;
}
if (Descriptor->Type == CmResourceTypeMemory)
{
- INFO_(VIDEOPRT, "Memory range starting at 0x%08x length 0x%08x\n",
+ INFO_(VIDEOPRT, "Memory range starting at 0x%08x length 0x%08x\n",
Descriptor->u.Memory.Start.u.LowPart, Descriptor->u.Memory.Length);
- AccessRanges[AssignedCount].RangeStart = Descriptor->u.Memory.Start;
- AccessRanges[AssignedCount].RangeLength = Descriptor->u.Memory.Length;
- AccessRanges[AssignedCount].RangeInIoSpace = 0;
- AccessRanges[AssignedCount].RangeVisible = 0; /* FIXME: Just guessing */
- AccessRanges[AssignedCount].RangeShareable =
- (Descriptor->ShareDisposition == CmResourceShareShared);
- AccessRanges[AssignedCount].RangePassive = 0;
- AssignedCount++;
+ AccessRanges[AssignedCount].RangeStart = Descriptor->u.Memory.Start;
+ AccessRanges[AssignedCount].RangeLength = Descriptor->u.Memory.Length;
+ AccessRanges[AssignedCount].RangeInIoSpace = 0;
+ AccessRanges[AssignedCount].RangeVisible = 0; /* FIXME: Just guessing */
+ AccessRanges[AssignedCount].RangeShareable =
+ (Descriptor->ShareDisposition == CmResourceShareShared);
+ AccessRanges[AssignedCount].RangePassive = 0;
+ AssignedCount++;
}
else if (Descriptor->Type == CmResourceTypePort)
{
- INFO_(VIDEOPRT, "Port range starting at 0x%04x length %d\n",
+ INFO_(VIDEOPRT, "Port range starting at 0x%04x length %d\n",
Descriptor->u.Port.Start.u.LowPart, Descriptor->u.Port.Length);
- AccessRanges[AssignedCount].RangeStart = Descriptor->u.Port.Start;
- AccessRanges[AssignedCount].RangeLength = Descriptor->u.Port.Length;
- AccessRanges[AssignedCount].RangeInIoSpace = 1;
- AccessRanges[AssignedCount].RangeVisible = 0; /* FIXME: Just guessing */
- AccessRanges[AssignedCount].RangeShareable =
- (Descriptor->ShareDisposition == CmResourceShareShared);
- AccessRanges[AssignedCount].RangePassive = 0;
- if (Descriptor->Flags & CM_RESOURCE_PORT_10_BIT_DECODE)
- AccessRanges[AssignedCount].RangePassive |= VIDEO_RANGE_10_BIT_DECODE;
- if (Descriptor->Flags & CM_RESOURCE_PORT_PASSIVE_DECODE)
- AccessRanges[AssignedCount].RangePassive |= VIDEO_RANGE_PASSIVE_DECODE;
- AssignedCount++;
+ AccessRanges[AssignedCount].RangeStart = Descriptor->u.Port.Start;
+ AccessRanges[AssignedCount].RangeLength = Descriptor->u.Port.Length;
+ AccessRanges[AssignedCount].RangeInIoSpace = 1;
+ AccessRanges[AssignedCount].RangeVisible = 0; /* FIXME: Just guessing */
+ AccessRanges[AssignedCount].RangeShareable =
+ (Descriptor->ShareDisposition == CmResourceShareShared);
+ AccessRanges[AssignedCount].RangePassive = 0;
+ if (Descriptor->Flags & CM_RESOURCE_PORT_10_BIT_DECODE)
+ AccessRanges[AssignedCount].RangePassive |= VIDEO_RANGE_10_BIT_DECODE;
+ if (Descriptor->Flags & CM_RESOURCE_PORT_PASSIVE_DECODE)
+ AccessRanges[AssignedCount].RangePassive |= VIDEO_RANGE_PASSIVE_DECODE;
+ AssignedCount++;
}
else if (Descriptor->Type == CmResourceTypeInterrupt)
{
- DeviceExtension->InterruptLevel = Descriptor->u.Interrupt.Level;
- DeviceExtension->InterruptVector = Descriptor->u.Interrupt.Vector;
- if (Descriptor->ShareDisposition == CmResourceShareShared)
- DeviceExtension->InterruptShared = TRUE;
- else
- DeviceExtension->InterruptShared = FALSE;
+ DeviceExtension->InterruptLevel = Descriptor->u.Interrupt.Level;
+ DeviceExtension->InterruptVector = Descriptor->u.Interrupt.Vector;
+ if (Descriptor->ShareDisposition == CmResourceShareShared)
+ DeviceExtension->InterruptShared = TRUE;
+ else
+ DeviceExtension->InterruptShared = FALSE;
}
- }
- }
- }
- else
- {
- UNIMPLEMENTED
- }
+ }
+ }
return NO_ERROR;
}
projects / reactos.git / commitdiff