diff --git a/ntoskrnl/include/internal/io.h b/ntoskrnl/include/internal/io.h index 69122da4d06..7fd74e1ca00 100644 --- a/ntoskrnl/include/internal/io.h +++ b/ntoskrnl/include/internal/io.h @@ -516,7 +516,7 @@ IopAssignDeviceResources( NTSTATUS NTAPI -IopCreateResourceListFromRequirements( +IopFixupResourceListWithRequirements( IN PIO_RESOURCE_REQUIREMENTS_LIST RequirementsList, OUT PCM_RESOURCE_LIST *ResourceList ); diff --git a/ntoskrnl/io/iomgr/iorsrce.c b/ntoskrnl/io/iomgr/iorsrce.c index db227cf5c61..978985b5fe0 100644 --- a/ntoskrnl/io/iomgr/iorsrce.c +++ b/ntoskrnl/io/iomgr/iorsrce.c @@ -930,9 +930,10 @@ IoAssignResources(PUNICODE_STRING RegistryPath, NTSTATUS Status; DPRINT1("IoAssignResources is halfplemented!\n"); - - Status = IopCreateResourceListFromRequirements(RequestedResources, - AllocatedResources); + + *AllocatedResources = NULL; + Status = IopFixupResourceListWithRequirements(RequestedResources, + AllocatedResources); if (!NT_SUCCESS(Status)) { if (Status == STATUS_CONFLICTING_ADDRESSES) diff --git a/ntoskrnl/io/pnpmgr/pnpres.c b/ntoskrnl/io/pnpmgr/pnpres.c index 63150247839..ac40576f943 100644 --- a/ntoskrnl/io/pnpmgr/pnpres.c +++ b/ntoskrnl/io/pnpmgr/pnpres.c @@ -47,7 +47,7 @@ IopFindBusNumberResource( ASSERT(IoDesc->Type == CmResourceTypeBusNumber); for (Start = IoDesc->u.BusNumber.MinBusNumber; - Start <= IoDesc->u.BusNumber.MaxBusNumber; + Start <= IoDesc->u.BusNumber.MaxBusNumber - IoDesc->u.BusNumber.Length + 1; Start++) { CmDesc->u.BusNumber.Length = IoDesc->u.BusNumber.Length; @@ -59,6 +59,7 @@ IopFindBusNumberResource( } else { + DPRINT1("Satisfying bus number requirement with 0x%x (length: 0x%x)\n", Start, CmDesc->u.BusNumber.Length); return TRUE; } } @@ -82,7 +83,7 @@ IopFindMemoryResource( if (IoDesc->u.Memory.Alignment == 0) IoDesc->u.Memory.Alignment = 1; for (Start = IoDesc->u.Memory.MinimumAddress.QuadPart; - Start <= IoDesc->u.Memory.MaximumAddress.QuadPart; + Start <= IoDesc->u.Memory.MaximumAddress.QuadPart - IoDesc->u.Memory.Length + 1; Start += IoDesc->u.Memory.Alignment) { CmDesc->u.Memory.Length = IoDesc->u.Memory.Length; @@ -95,6 +96,7 @@ IopFindMemoryResource( } else { + DPRINT1("Satisfying memory requirement with 0x%I64x (length: 0x%x)\n", Start, CmDesc->u.Memory.Length); return TRUE; } } @@ -118,7 +120,7 @@ IopFindPortResource( if (IoDesc->u.Port.Alignment == 0) IoDesc->u.Port.Alignment = 1; for (Start = IoDesc->u.Port.MinimumAddress.QuadPart; - Start <= IoDesc->u.Port.MaximumAddress.QuadPart; + Start <= IoDesc->u.Port.MaximumAddress.QuadPart - IoDesc->u.Port.Length + 1; Start += IoDesc->u.Port.Alignment) { CmDesc->u.Port.Length = IoDesc->u.Port.Length; @@ -130,6 +132,7 @@ IopFindPortResource( } else { + DPRINT1("Satisfying port requirement with 0x%I64x (length: 0x%x)\n", Start, CmDesc->u.Port.Length); return TRUE; } } @@ -156,7 +159,10 @@ IopFindDmaResource( CmDesc->u.Dma.Port = 0; if (!IopCheckDescriptorForConflict(CmDesc, NULL)) + { + DPRINT1("Satisfying DMA requirement with channel 0x%x\n", Channel); return TRUE; + } } return FALSE; @@ -182,163 +188,298 @@ IopFindInterruptResource( CmDesc->u.Interrupt.Affinity = (KAFFINITY)-1; if (!IopCheckDescriptorForConflict(CmDesc, NULL)) + { + DPRINT1("Satisfying interrupt requirement with IRQ 0x%x\n", Vector); return TRUE; + } } return FALSE; } - NTSTATUS NTAPI -IopCreateResourceListFromRequirements( +IopFixupResourceListWithRequirements( IN PIO_RESOURCE_REQUIREMENTS_LIST RequirementsList, OUT PCM_RESOURCE_LIST *ResourceList) { - ULONG i, ii, Size; - PCM_PARTIAL_RESOURCE_DESCRIPTOR ResDesc; + ULONG i; + for (i = 0; i < RequirementsList->AlternativeLists; i++) + { + ULONG ii; + PIO_RESOURCE_LIST ResList = &RequirementsList->List[i]; + BOOLEAN AlternateRequired = FALSE; - Size = FIELD_OFFSET(CM_RESOURCE_LIST, List); - for (i = 0; i < RequirementsList->AlternativeLists; i++) - { - PIO_RESOURCE_LIST ResList = &RequirementsList->List[i]; - Size += FIELD_OFFSET(CM_FULL_RESOURCE_DESCRIPTOR, PartialResourceList.PartialDescriptors) - + ResList->Count * sizeof(CM_PARTIAL_RESOURCE_DESCRIPTOR); - } + for (ii = 0; ii < ResList->Count; ii++) + { + ULONG iii; + PCM_PARTIAL_RESOURCE_LIST PartialList = (*ResourceList) ? &(*ResourceList)->List[0].PartialResourceList : NULL; + PIO_RESOURCE_DESCRIPTOR IoDesc = &ResList->Descriptors[ii]; + BOOLEAN Matched = FALSE; + + /* Skip alternates if we don't need one */ + if (!AlternateRequired && (IoDesc->Option & IO_RESOURCE_ALTERNATIVE)) + { + DPRINT("Skipping unneeded alternate\n"); + continue; + } - *ResourceList = ExAllocatePool(PagedPool, Size); - if (!*ResourceList) - return STATUS_INSUFFICIENT_RESOURCES; + /* Check if we couldn't satsify a requirement or its alternates */ + if (AlternateRequired && !(IoDesc->Option & IO_RESOURCE_ALTERNATIVE)) + { + DPRINT1("Unable to satisfy preferred resource or alternates\n"); - (*ResourceList)->Count = 1; - (*ResourceList)->List[0].BusNumber = RequirementsList->BusNumber; - (*ResourceList)->List[0].InterfaceType = RequirementsList->InterfaceType; - (*ResourceList)->List[0].PartialResourceList.Version = 1; - (*ResourceList)->List[0].PartialResourceList.Revision = 1; - (*ResourceList)->List[0].PartialResourceList.Count = 0; + if (*ResourceList) + { + ExFreePool(*ResourceList); + *ResourceList = NULL; + } + return STATUS_CONFLICTING_ADDRESSES; + } - ResDesc = &(*ResourceList)->List[0].PartialResourceList.PartialDescriptors[0]; + for (iii = 0; PartialList && iii < PartialList->Count && !Matched; iii++) + { + PCM_PARTIAL_RESOURCE_DESCRIPTOR CmDesc = &PartialList->PartialDescriptors[iii]; - for (i = 0; i < RequirementsList->AlternativeLists; i++) - { - PIO_RESOURCE_LIST ResList = &RequirementsList->List[i]; - for (ii = 0; ii < ResList->Count; ii++) - { - PIO_RESOURCE_DESCRIPTOR ReqDesc = &ResList->Descriptors[ii]; - BOOLEAN FoundResource = TRUE; + /* First check types */ + if (IoDesc->Type != CmDesc->Type) + continue; - /* FIXME: Handle alternate ranges */ - if (ReqDesc->Option == IO_RESOURCE_ALTERNATIVE) - continue; + switch (IoDesc->Type) + { + case CmResourceTypeInterrupt: + /* Make sure it satisfies our vector range */ + if (CmDesc->u.Interrupt.Vector >= IoDesc->u.Interrupt.MinimumVector && + CmDesc->u.Interrupt.Vector <= IoDesc->u.Interrupt.MaximumVector) + { + /* Found it */ + Matched = TRUE; + } + else + { + DPRINT("Interrupt - Not a match! 0x%x not inside 0x%x to 0x%x\n", + CmDesc->u.Interrupt.Vector, + IoDesc->u.Interrupt.MinimumVector, + IoDesc->u.Interrupt.MaximumVector); + } + break; - ResDesc->Type = ReqDesc->Type; - ResDesc->Flags = ReqDesc->Flags; - ResDesc->ShareDisposition = ReqDesc->ShareDisposition; + case CmResourceTypeMemory: + case CmResourceTypePort: + /* Make sure the length matches and it satisfies our address range */ + if (CmDesc->u.Memory.Length == IoDesc->u.Memory.Length && + CmDesc->u.Memory.Start.QuadPart >= IoDesc->u.Memory.MinimumAddress.QuadPart && + CmDesc->u.Memory.Start.QuadPart + CmDesc->u.Memory.Length - 1 <= IoDesc->u.Memory.MaximumAddress.QuadPart) + { + /* Found it */ + Matched = TRUE; + } + else + { + DPRINT("Memory/Port - Not a match! 0x%I64x with length 0x%x not inside 0x%I64x to 0x%I64x with length 0x%x\n", + CmDesc->u.Memory.Start.QuadPart, + CmDesc->u.Memory.Length, + IoDesc->u.Memory.MinimumAddress.QuadPart, + IoDesc->u.Memory.MaximumAddress.QuadPart, + IoDesc->u.Memory.Length); + } + break; - switch (ReqDesc->Type) - { - case CmResourceTypeInterrupt: - if (!IopFindInterruptResource(ReqDesc, ResDesc)) - { - DPRINT1("Failed to find an available interrupt resource (0x%x to 0x%x)\n", - ReqDesc->u.Interrupt.MinimumVector, ReqDesc->u.Interrupt.MaximumVector); + case CmResourceTypeBusNumber: + /* Make sure the length matches and it satisfies our bus number range */ + if (CmDesc->u.BusNumber.Length == IoDesc->u.BusNumber.Length && + CmDesc->u.BusNumber.Start >= IoDesc->u.BusNumber.MinBusNumber && + CmDesc->u.BusNumber.Start + CmDesc->u.BusNumber.Length - 1 <= IoDesc->u.BusNumber.MaxBusNumber) + { + /* Found it */ + Matched = TRUE; + } + else + { + DPRINT("Bus Number - Not a match! 0x%x with length 0x%x not inside 0x%x to 0x%x with length 0x%x\n", + CmDesc->u.BusNumber.Start, + CmDesc->u.BusNumber.Length, + IoDesc->u.BusNumber.MinBusNumber, + IoDesc->u.BusNumber.MaxBusNumber, + IoDesc->u.BusNumber.Length); + } + break; - if (ReqDesc->Option == 0) - { - ExFreePool(*ResourceList); - *ResourceList = NULL; - return STATUS_CONFLICTING_ADDRESSES; - } + case CmResourceTypeDma: + /* Make sure it fits in our channel range */ + if (CmDesc->u.Dma.Channel >= IoDesc->u.Dma.MinimumChannel && + CmDesc->u.Dma.Channel <= IoDesc->u.Dma.MaximumChannel) + { + /* Found it */ + Matched = TRUE; + } + else + { + DPRINT("DMA - Not a match! 0x%x not inside 0x%x to 0x%x\n", + CmDesc->u.Dma.Channel, + IoDesc->u.Dma.MinimumChannel, + IoDesc->u.Dma.MaximumChannel); + } + break; - FoundResource = FALSE; - } - break; + default: + /* Other stuff is fine */ + Matched = TRUE; + break; + } + } - case CmResourceTypePort: - if (!IopFindPortResource(ReqDesc, ResDesc)) - { - DPRINT1("Failed to find an available port resource (0x%I64x to 0x%I64x length: 0x%x)\n", - ReqDesc->u.Port.MinimumAddress.QuadPart, ReqDesc->u.Port.MaximumAddress.QuadPart, - ReqDesc->u.Port.Length); + /* Check if we found a matching descriptor */ + if (!Matched) + { + PCM_RESOURCE_LIST NewList; + CM_PARTIAL_RESOURCE_DESCRIPTOR NewDesc; + PCM_PARTIAL_RESOURCE_DESCRIPTOR DescPtr; + BOOLEAN FoundResource = TRUE; - if (ReqDesc->Option == 0) - { - ExFreePool(*ResourceList); - *ResourceList = NULL; - return STATUS_CONFLICTING_ADDRESSES; - } + /* Setup the new CM descriptor */ + NewDesc.Type = IoDesc->Type; + NewDesc.Flags = IoDesc->Flags; + NewDesc.ShareDisposition = IoDesc->ShareDisposition; - FoundResource = FALSE; - } - break; + /* Let'se see if we can find a resource to satisfy this */ + switch (IoDesc->Type) + { + case CmResourceTypeInterrupt: + /* Find an available interrupt */ + if (!IopFindInterruptResource(IoDesc, &NewDesc)) + { + DPRINT1("Failed to find an available interrupt resource (0x%x to 0x%x)\n", + IoDesc->u.Interrupt.MinimumVector, IoDesc->u.Interrupt.MaximumVector); - case CmResourceTypeMemory: - if (!IopFindMemoryResource(ReqDesc, ResDesc)) - { - DPRINT1("Failed to find an available memory resource (0x%I64x to 0x%I64x length: 0x%x)\n", - ReqDesc->u.Memory.MinimumAddress.QuadPart, ReqDesc->u.Memory.MaximumAddress.QuadPart, - ReqDesc->u.Memory.Length); + FoundResource = FALSE; + } + break; + + case CmResourceTypePort: + /* Find an available port range */ + if (!IopFindPortResource(IoDesc, &NewDesc)) + { + DPRINT1("Failed to find an available port resource (0x%I64x to 0x%I64x length: 0x%x)\n", + IoDesc->u.Port.MinimumAddress.QuadPart, IoDesc->u.Port.MaximumAddress.QuadPart, + IoDesc->u.Port.Length); - if (ReqDesc->Option == 0) - { - ExFreePool(*ResourceList); - *ResourceList = NULL; - return STATUS_CONFLICTING_ADDRESSES; - } + FoundResource = FALSE; + } + break; + + case CmResourceTypeMemory: + /* Find an available memory range */ + if (!IopFindMemoryResource(IoDesc, &NewDesc)) + { + DPRINT1("Failed to find an available memory resource (0x%I64x to 0x%I64x length: 0x%x)\n", + IoDesc->u.Memory.MinimumAddress.QuadPart, IoDesc->u.Memory.MaximumAddress.QuadPart, + IoDesc->u.Memory.Length); - FoundResource = FALSE; - } - break; + FoundResource = FALSE; + } + break; + + case CmResourceTypeBusNumber: + /* Find an available bus address range */ + if (!IopFindBusNumberResource(IoDesc, &NewDesc)) + { + DPRINT1("Failed to find an available bus number resource (0x%x to 0x%x length: 0x%x)\n", + IoDesc->u.BusNumber.MinBusNumber, IoDesc->u.BusNumber.MaxBusNumber, + IoDesc->u.BusNumber.Length); - case CmResourceTypeBusNumber: - if (!IopFindBusNumberResource(ReqDesc, ResDesc)) - { - DPRINT1("Failed to find an available bus number resource (0x%x to 0x%x length: 0x%x)\n", - ReqDesc->u.BusNumber.MinBusNumber, ReqDesc->u.BusNumber.MaxBusNumber, - ReqDesc->u.BusNumber.Length); + FoundResource = FALSE; + } + break; + + case CmResourceTypeDma: + /* Find an available DMA channel */ + if (!IopFindDmaResource(IoDesc, &NewDesc)) + { + DPRINT1("Failed to find an available dma resource (0x%x to 0x%x)\n", + IoDesc->u.Dma.MinimumChannel, IoDesc->u.Dma.MaximumChannel); - if (ReqDesc->Option == 0) - { - ExFreePool(*ResourceList); - *ResourceList = NULL; - return STATUS_CONFLICTING_ADDRESSES; - } + FoundResource = FALSE; + } + break; + + default: + DPRINT1("Unsupported resource type: %x\n", IoDesc->Type); + FoundResource = FALSE; + break; + } - FoundResource = FALSE; - } - break; + /* Check if it's missing and required */ + if (!FoundResource && IoDesc->Option == 0) + { + if (*ResourceList) + { + ExFreePool(*ResourceList); + *ResourceList = NULL; + } + return STATUS_CONFLICTING_ADDRESSES; + } + else if (!FoundResource) + { + /* Try an alternate for this preferred descriptor */ + AlternateRequired = TRUE; + continue; + } + else + { + /* Move on to the next preferred or required descriptor after this one */ + AlternateRequired = FALSE; + } - case CmResourceTypeDma: - if (!IopFindDmaResource(ReqDesc, ResDesc)) - { - DPRINT1("Failed to find an available dma resource (0x%x to 0x%x)\n", - ReqDesc->u.Dma.MinimumChannel, ReqDesc->u.Dma.MaximumChannel); + /* Figure out what we need */ + if (PartialList == NULL) + { + /* We need a new list */ + NewList = ExAllocatePool(PagedPool, sizeof(CM_RESOURCE_LIST)); + if (!NewList) + return STATUS_NO_MEMORY; - if (ReqDesc->Option == 0) - { - ExFreePool(*ResourceList); - *ResourceList = NULL; - return STATUS_CONFLICTING_ADDRESSES; - } + /* Set it up */ + NewList->Count = 1; + NewList->List[0].InterfaceType = RequirementsList->InterfaceType; + NewList->List[0].BusNumber = RequirementsList->BusNumber; + NewList->List[0].PartialResourceList.Version = 1; + NewList->List[0].PartialResourceList.Revision = 1; + NewList->List[0].PartialResourceList.Count = 1; - FoundResource = FALSE; - } - break; + /* Set our pointer */ + DescPtr = &NewList->List[0].PartialResourceList.PartialDescriptors[0]; + } + else + { + /* Allocate the new larger list */ + NewList = ExAllocatePool(PagedPool, PnpDetermineResourceListSize(*ResourceList) + sizeof(CM_PARTIAL_RESOURCE_DESCRIPTOR)); + if (!NewList) + return STATUS_NO_MEMORY; - default: - DPRINT1("Unsupported resource type: %x\n", ReqDesc->Type); - FoundResource = FALSE; - break; - } + /* Copy the old stuff back */ + RtlCopyMemory(NewList, *ResourceList, PnpDetermineResourceListSize(*ResourceList)); - if (FoundResource) - { - (*ResourceList)->List[0].PartialResourceList.Count++; - ResDesc++; - } - } - } + /* Set our pointer */ + DescPtr = &NewList->List[0].PartialResourceList.PartialDescriptors[NewList->List[0].PartialResourceList.Count]; - return STATUS_SUCCESS; + /* Increment the descriptor count */ + NewList->List[0].PartialResourceList.Count++; + + /* Free the old list */ + ExFreePool(*ResourceList); + } + + /* Copy the descriptor in */ + *DescPtr = NewDesc; + + /* Store the new list */ + *ResourceList = NewList; + } + } + } + + /* Done */ + return STATUS_SUCCESS; } static @@ -888,50 +1029,47 @@ IopAssignDeviceResources( return STATUS_SUCCESS; } - /* Fill DeviceNode->ResourceList - * FIXME: the PnP arbiter should go there! - * Actually, use the BootResources if provided, else the resource requirements - */ - if (DeviceNode->BootResources) { - ListSize = PnpDetermineResourceListSize(DeviceNode->BootResources); + ListSize = PnpDetermineResourceListSize(DeviceNode->BootResources); - DeviceNode->ResourceList = ExAllocatePool(PagedPool, ListSize); - if (!DeviceNode->ResourceList) - { - Status = STATUS_NO_MEMORY; - goto ByeBye; - } - RtlCopyMemory(DeviceNode->ResourceList, DeviceNode->BootResources, ListSize); + DeviceNode->ResourceList = ExAllocatePool(PagedPool, ListSize); + if (!DeviceNode->ResourceList) + { + Status = STATUS_NO_MEMORY; + goto ByeBye; + } - Status = IopDetectResourceConflict(DeviceNode->ResourceList, FALSE, NULL); - if (NT_SUCCESS(Status) || !DeviceNode->ResourceRequirements) - { - if (!NT_SUCCESS(Status) && !DeviceNode->ResourceRequirements) - { - DPRINT1("Using conflicting boot resources because no requirements were supplied!\n"); - } + RtlCopyMemory(DeviceNode->ResourceList, DeviceNode->BootResources, ListSize); - goto Finish; - } - else - { - DPRINT1("Boot resources for %wZ cause a resource conflict!\n", &DeviceNode->InstancePath); - ExFreePool(DeviceNode->ResourceList); - DeviceNode->ResourceList = NULL; - } + Status = IopDetectResourceConflict(DeviceNode->ResourceList, FALSE, NULL); + if (!NT_SUCCESS(Status)) + { + DPRINT1("Boot resources for %wZ cause a resource conflict!\n", &DeviceNode->InstancePath); + ExFreePool(DeviceNode->ResourceList); + DeviceNode->ResourceList = NULL; + } + } + else + { + /* We'll make this from the requirements */ + DeviceNode->ResourceList = NULL; } - Status = IopCreateResourceListFromRequirements(DeviceNode->ResourceRequirements, - &DeviceNode->ResourceList); + /* No resources requirements */ + if (!DeviceNode->ResourceRequirements) + goto Finish; + + /* Add resource requirements that aren't in the list we already got */ + Status = IopFixupResourceListWithRequirements(DeviceNode->ResourceRequirements, + &DeviceNode->ResourceList); if (!NT_SUCCESS(Status)) { - DPRINT1("Failed to create a resource list from supplied resources for %wZ\n", &DeviceNode->InstancePath); + DPRINT1("Failed to fixup a resource list from supplied resources for %wZ\n", &DeviceNode->InstancePath); goto ByeBye; } - /* IopCreateResourceListFromRequirements should NEVER succeed with a conflicting list */ + /* IopFixupResourceListWithRequirements should NEVER give us a conflicting list */ ASSERT(IopDetectResourceConflict(DeviceNode->ResourceList, FALSE, NULL) != STATUS_CONFLICTING_ADDRESSES); Finish: