390 lines
12 KiB
C
390 lines
12 KiB
C
/*++
|
||
|
||
Copyright (c) 1990 Microsoft Corporation
|
||
|
||
Module Name:
|
||
|
||
PnpEisa.c
|
||
|
||
Abstract:
|
||
|
||
This file implements Eisa related code.
|
||
|
||
Author:
|
||
|
||
Shie-Lin Tzong (shielint)
|
||
|
||
Environment:
|
||
|
||
Kernel Mode.
|
||
|
||
Notes:
|
||
|
||
Revision History:
|
||
|
||
--*/
|
||
|
||
#include "pnpmgrp.h"
|
||
#pragma hdrstop
|
||
|
||
#ifdef POOL_TAGGING
|
||
#undef ExAllocatePool
|
||
#define ExAllocatePool(a,b) ExAllocatePoolWithTag(a,b,'iepP')
|
||
#endif
|
||
|
||
#define EISA_DEVICE_NODE_NAME L"EisaResources"
|
||
#define BUFFER_LENGTH 50
|
||
|
||
NTSTATUS
|
||
EisaGetEisaDevicesResources (
|
||
OUT PCM_RESOURCE_LIST *ResourceList,
|
||
OUT PULONG ResourceLength
|
||
);
|
||
|
||
NTSTATUS
|
||
EisaBuildSlotsResources (
|
||
IN ULONG SlotMasks,
|
||
IN ULONG NumberMasks,
|
||
OUT PCM_RESOURCE_LIST *Resource,
|
||
OUT ULONG *Length
|
||
);
|
||
|
||
#ifdef ALLOC_PRAGMA
|
||
#pragma alloc_text(INIT, EisaBuildEisaDeviceNode)
|
||
#pragma alloc_text(INIT, EisaGetEisaDevicesResources)
|
||
#pragma alloc_text(INIT, EisaBuildSlotsResources)
|
||
#endif
|
||
|
||
NTSTATUS
|
||
EisaBuildEisaDeviceNode (
|
||
VOID
|
||
)
|
||
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
This routine build an registry key to report eisa resources to arbiters.
|
||
|
||
Arguments:
|
||
|
||
None.
|
||
|
||
Return Value:
|
||
|
||
NTSTATUS code.
|
||
|
||
--*/
|
||
|
||
{
|
||
NTSTATUS status;
|
||
ULONG disposition, tmpValue;
|
||
WCHAR buffer[BUFFER_LENGTH];
|
||
|
||
UNICODE_STRING unicodeString;
|
||
HANDLE rootHandle, deviceHandle, instanceHandle, logConfHandle;
|
||
|
||
PCM_RESOURCE_LIST resourceList;
|
||
ULONG resourceLength;
|
||
|
||
status = EisaGetEisaDevicesResources(&resourceList, &resourceLength);
|
||
if (!NT_SUCCESS(status) || resourceList == NULL) {
|
||
return STATUS_UNSUCCESSFUL;
|
||
}
|
||
|
||
PiWstrToUnicodeString(&unicodeString, L"\\Registry\\Machine\\System\\CurrentControlSet\\Enum\\Root");
|
||
status = IopOpenRegistryKeyEx( &rootHandle,
|
||
NULL,
|
||
&unicodeString,
|
||
KEY_ALL_ACCESS
|
||
);
|
||
|
||
if (!NT_SUCCESS(status)) {
|
||
if (resourceList) {
|
||
ExFreePool (resourceList);
|
||
}
|
||
return status;
|
||
}
|
||
|
||
PiWstrToUnicodeString(&unicodeString, EISA_DEVICE_NODE_NAME);
|
||
status = IopCreateRegistryKeyEx( &deviceHandle,
|
||
rootHandle,
|
||
&unicodeString,
|
||
KEY_ALL_ACCESS,
|
||
REG_OPTION_NON_VOLATILE,
|
||
NULL
|
||
);
|
||
|
||
ZwClose(rootHandle);
|
||
if (!NT_SUCCESS(status)) {
|
||
if (resourceList) {
|
||
ExFreePool (resourceList);
|
||
}
|
||
return status;
|
||
}
|
||
|
||
PiWstrToUnicodeString( &unicodeString, L"0000" );
|
||
status = IopCreateRegistryKeyEx( &instanceHandle,
|
||
deviceHandle,
|
||
&unicodeString,
|
||
KEY_ALL_ACCESS,
|
||
REG_OPTION_NON_VOLATILE,
|
||
&disposition );
|
||
ZwClose(deviceHandle);
|
||
if (NT_SUCCESS(status)) {
|
||
|
||
//
|
||
// If the key already exists because it was explicitly migrated
|
||
// during textmode setup, we should still consider it a "new key".
|
||
//
|
||
if (disposition != REG_CREATED_NEW_KEY) {
|
||
PKEY_VALUE_FULL_INFORMATION keyValueInformation;
|
||
|
||
status = IopGetRegistryValue(instanceHandle,
|
||
REGSTR_VALUE_MIGRATED,
|
||
&keyValueInformation);
|
||
if (NT_SUCCESS(status)) {
|
||
|
||
if ((keyValueInformation->Type == REG_DWORD) &&
|
||
(keyValueInformation->DataLength == sizeof(ULONG)) &&
|
||
((*(PULONG)KEY_VALUE_DATA(keyValueInformation)) != 0)) {
|
||
disposition = REG_CREATED_NEW_KEY;
|
||
}
|
||
|
||
ExFreePool(keyValueInformation);
|
||
|
||
PiWstrToUnicodeString(&unicodeString, REGSTR_VALUE_MIGRATED);
|
||
ZwDeleteValueKey(instanceHandle, &unicodeString);
|
||
}
|
||
}
|
||
|
||
if (disposition == REG_CREATED_NEW_KEY) {
|
||
|
||
PiWstrToUnicodeString( &unicodeString, L"DeviceDesc" );
|
||
wcsncpy(buffer, L"Device to report Eisa Slot Resources", sizeof(buffer) / sizeof(WCHAR));
|
||
buffer[(sizeof(buffer) / sizeof(WCHAR)) - 1] = UNICODE_NULL;
|
||
|
||
ZwSetValueKey(instanceHandle,
|
||
&unicodeString,
|
||
0,
|
||
REG_SZ,
|
||
buffer,
|
||
(ULONG)((wcslen(buffer) + 1) * sizeof(WCHAR))
|
||
);
|
||
|
||
PiWstrToUnicodeString( &unicodeString, L"HardwareID" );
|
||
RtlZeroMemory(buffer, BUFFER_LENGTH * sizeof(WCHAR));
|
||
wcsncpy(buffer, L"*Eisa_Resource_Device", sizeof(buffer) / sizeof(WCHAR));
|
||
buffer[(sizeof(buffer) / sizeof(WCHAR)) - 1] = UNICODE_NULL;
|
||
|
||
ZwSetValueKey(instanceHandle,
|
||
&unicodeString,
|
||
0,
|
||
REG_MULTI_SZ,
|
||
buffer,
|
||
(ULONG)((wcslen(buffer) + 2) * sizeof(WCHAR))
|
||
);
|
||
|
||
PiWstrToUnicodeString(&unicodeString, REGSTR_VALUE_CONFIG_FLAGS);
|
||
tmpValue = 0;
|
||
ZwSetValueKey(instanceHandle,
|
||
&unicodeString,
|
||
TITLE_INDEX_VALUE,
|
||
REG_DWORD,
|
||
&tmpValue,
|
||
sizeof(tmpValue)
|
||
);
|
||
|
||
}
|
||
|
||
PiWstrToUnicodeString( &unicodeString, REGSTR_KEY_LOGCONF );
|
||
status = IopCreateRegistryKeyEx( &logConfHandle,
|
||
instanceHandle,
|
||
&unicodeString,
|
||
KEY_ALL_ACCESS,
|
||
REG_OPTION_NON_VOLATILE,
|
||
NULL
|
||
);
|
||
ZwClose(instanceHandle);
|
||
if (NT_SUCCESS(status)) {
|
||
PiWstrToUnicodeString( &unicodeString, REGSTR_VAL_BOOTCONFIG );
|
||
|
||
status = ZwSetValueKey(logConfHandle,
|
||
&unicodeString,
|
||
0,
|
||
REG_RESOURCE_LIST,
|
||
resourceList,
|
||
resourceLength
|
||
);
|
||
ZwClose(logConfHandle);
|
||
}
|
||
}
|
||
if (resourceList) {
|
||
ExFreePool (resourceList);
|
||
}
|
||
return status;
|
||
}
|
||
|
||
NTSTATUS
|
||
EisaGetEisaDevicesResources (
|
||
OUT PCM_RESOURCE_LIST *ResourceList,
|
||
OUT PULONG ResourceLength
|
||
)
|
||
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
This routine builds a cm resource list for all the eisa slots.
|
||
|
||
Arguments:
|
||
|
||
None.
|
||
|
||
Return Value:
|
||
|
||
A CmResourceList.
|
||
|
||
--*/
|
||
|
||
{
|
||
NTSTATUS status = STATUS_SUCCESS;
|
||
HANDLE handle;
|
||
PKEY_VALUE_FULL_INFORMATION keyValueInformation;
|
||
UNICODE_STRING unicodeString;
|
||
ULONG slotMasks = 0, numberMasks = 0, i;
|
||
|
||
*ResourceList = NULL;
|
||
*ResourceLength = 0;
|
||
|
||
//
|
||
// Open LocalMachine\Hardware\Description
|
||
//
|
||
|
||
//PiWstrToUnicodeString(&unicodeString, L"\\REGISTRY\\MACHINE\\HARDWARE\\DESCRIPTION\\SYSTEM\\EisaAdapter\\0");
|
||
PiWstrToUnicodeString(&unicodeString, L"\\REGISTRY\\MACHINE\\SYSTEM\\CurrentControlSet\\EisaAdapter");
|
||
status = IopOpenRegistryKeyEx( &handle,
|
||
NULL,
|
||
&unicodeString,
|
||
KEY_READ
|
||
);
|
||
if (NT_SUCCESS(status)) {
|
||
status = IopGetRegistryValue(handle,
|
||
L"Configuration Data",
|
||
&keyValueInformation
|
||
);
|
||
if (NT_SUCCESS(status)) {
|
||
PCM_FULL_RESOURCE_DESCRIPTOR resourceDescriptor;
|
||
PCM_PARTIAL_RESOURCE_DESCRIPTOR partialResourceDescriptor;
|
||
|
||
resourceDescriptor = (PCM_FULL_RESOURCE_DESCRIPTOR)
|
||
((PUCHAR) keyValueInformation + keyValueInformation->DataOffset);
|
||
|
||
if ((keyValueInformation->DataLength >= sizeof(CM_FULL_RESOURCE_DESCRIPTOR)) &&
|
||
(resourceDescriptor->PartialResourceList.Count > 0) ) {
|
||
LONG eisaInfoLength;
|
||
PCM_EISA_SLOT_INFORMATION eisaInfo;
|
||
|
||
partialResourceDescriptor = resourceDescriptor->PartialResourceList.PartialDescriptors;
|
||
if (partialResourceDescriptor->Type == CmResourceTypeDeviceSpecific) {
|
||
eisaInfo = (PCM_EISA_SLOT_INFORMATION)
|
||
((PUCHAR)partialResourceDescriptor + sizeof(CM_PARTIAL_RESOURCE_DESCRIPTOR));
|
||
eisaInfoLength = (LONG)partialResourceDescriptor->u.DeviceSpecificData.DataSize;
|
||
|
||
//
|
||
// Parse the eisa slot info to find the eisa slots with device installed.
|
||
//
|
||
|
||
for (i = 0; i < 0x10 && eisaInfoLength > 0; i++) {
|
||
if (eisaInfo->ReturnCode == EISA_INVALID_SLOT) {
|
||
break;
|
||
}
|
||
if (eisaInfo->ReturnCode != EISA_EMPTY_SLOT && (i != 0)) {
|
||
slotMasks |= (1 << i);
|
||
numberMasks++;
|
||
}
|
||
if (eisaInfo->ReturnCode == EISA_EMPTY_SLOT) {
|
||
eisaInfoLength -= sizeof(CM_EISA_SLOT_INFORMATION);
|
||
eisaInfo++;
|
||
} else {
|
||
eisaInfoLength -= sizeof(CM_EISA_SLOT_INFORMATION) + eisaInfo->NumberFunctions * sizeof(CM_EISA_FUNCTION_INFORMATION);
|
||
eisaInfo = (PCM_EISA_SLOT_INFORMATION)
|
||
((PUCHAR)eisaInfo + eisaInfo->NumberFunctions * sizeof(CM_EISA_FUNCTION_INFORMATION) +
|
||
sizeof(CM_EISA_SLOT_INFORMATION));
|
||
}
|
||
}
|
||
|
||
if (slotMasks) {
|
||
status = EisaBuildSlotsResources(slotMasks, numberMasks, ResourceList, ResourceLength);
|
||
}
|
||
}
|
||
|
||
}
|
||
ExFreePool(keyValueInformation);
|
||
}
|
||
ZwClose(handle);
|
||
}
|
||
return status;
|
||
}
|
||
|
||
NTSTATUS
|
||
EisaBuildSlotsResources (
|
||
IN ULONG SlotMasks,
|
||
IN ULONG NumberMasks,
|
||
OUT PCM_RESOURCE_LIST *Resources,
|
||
OUT ULONG *Length
|
||
)
|
||
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
This routine build a cm resource list for all the io resources used
|
||
by the eisa devices.
|
||
|
||
Arguments:
|
||
|
||
SlotMask - a mask to indicate the valid eisa slot.
|
||
|
||
Return Value:
|
||
|
||
A pointer to a CM_RESOURCE_LIST.
|
||
|
||
--*/
|
||
|
||
{
|
||
PCM_RESOURCE_LIST resources = NULL;
|
||
PCM_PARTIAL_RESOURCE_DESCRIPTOR partialDesc;
|
||
ULONG slot;
|
||
|
||
*Length = sizeof(CM_RESOURCE_LIST) + sizeof(CM_PARTIAL_RESOURCE_DESCRIPTOR) * (NumberMasks - 1);
|
||
resources = ExAllocatePool(PagedPool, *Length);
|
||
if (resources) {
|
||
resources->Count = 1;
|
||
resources->List[0].InterfaceType = Eisa;
|
||
resources->List[0].BusNumber = 0;
|
||
resources->List[0].PartialResourceList.Version = 0;
|
||
resources->List[0].PartialResourceList.Revision = 0;
|
||
resources->List[0].PartialResourceList.Count = NumberMasks;
|
||
partialDesc = resources->List[0].PartialResourceList.PartialDescriptors;
|
||
slot = 0; // ignore slot 0
|
||
while (SlotMasks) {
|
||
SlotMasks >>= 1;
|
||
slot++;
|
||
if (SlotMasks & 1) {
|
||
partialDesc->Type = CmResourceTypePort;
|
||
partialDesc->ShareDisposition = CmResourceShareDeviceExclusive;
|
||
partialDesc->Flags = CM_RESOURCE_PORT_16_BIT_DECODE + CM_RESOURCE_PORT_IO;
|
||
partialDesc->u.Port.Start.LowPart = slot << 12;
|
||
partialDesc->u.Port.Start.HighPart = 0;
|
||
partialDesc->u.Port.Length = 0x1000;
|
||
partialDesc++;
|
||
}
|
||
}
|
||
*Resources = resources;
|
||
return STATUS_SUCCESS;
|
||
} else {
|
||
return STATUS_NO_MEMORY;
|
||
}
|
||
}
|