472 lines
11 KiB
C
472 lines
11 KiB
C
|
/*++
|
|||
|
|
|||
|
|
|||
|
Copyright (c) 1989 Microsoft Corporation
|
|||
|
|
|||
|
Module Name:
|
|||
|
|
|||
|
spsysbus.c
|
|||
|
|
|||
|
Abstract:
|
|||
|
|
|||
|
Author:
|
|||
|
|
|||
|
Environment:
|
|||
|
|
|||
|
Revision History:
|
|||
|
|
|||
|
--*/
|
|||
|
|
|||
|
#include "halp.h"
|
|||
|
#include "spmp.inc"
|
|||
|
|
|||
|
ULONG HalpDefaultInterruptAffinity;
|
|||
|
ULONG HalpCpuCount;
|
|||
|
|
|||
|
BOOLEAN
|
|||
|
HalpTranslateSystemBusAddress(
|
|||
|
IN PBUS_HANDLER BusHandler,
|
|||
|
IN PBUS_HANDLER RootHandler,
|
|||
|
IN PHYSICAL_ADDRESS BusAddress,
|
|||
|
IN OUT PULONG AddressSpace,
|
|||
|
OUT PPHYSICAL_ADDRESS TranslatedAddress
|
|||
|
);
|
|||
|
|
|||
|
ULONG
|
|||
|
HalpGetSystemInterruptVector(
|
|||
|
IN PBUS_HANDLER BusHandler,
|
|||
|
IN PBUS_HANDLER RootHandler,
|
|||
|
IN ULONG BusInterruptLevel,
|
|||
|
IN ULONG BusInterruptVector,
|
|||
|
OUT PKIRQL Irql,
|
|||
|
OUT PKAFFINITY Affinity
|
|||
|
);
|
|||
|
|
|||
|
|
|||
|
#ifdef ALLOC_PRAGMA
|
|||
|
#pragma alloc_text(PAGE,HalpGetSystemInterruptVector)
|
|||
|
#pragma alloc_text(PAGE,HalTranslatorReference)
|
|||
|
#pragma alloc_text(PAGE,HalTranslatorDereference)
|
|||
|
#pragma alloc_text(PAGE,HalIrqTranslateResourcesRoot)
|
|||
|
#pragma alloc_text(PAGE,HalIrqTranslateResourceRequirementsRoot)
|
|||
|
#pragma alloc_text(PAGE,HalpTransMemIoResource)
|
|||
|
#pragma alloc_text(PAGE,HalpTransMemIoResourceRequirement)
|
|||
|
#endif
|
|||
|
|
|||
|
extern UCHAR SpCpuCount;
|
|||
|
extern Sp8259PerProcessorMode;
|
|||
|
extern UCHAR RegisteredProcessorCount;
|
|||
|
|
|||
|
|
|||
|
BOOLEAN
|
|||
|
HalpTranslateSystemBusAddress(
|
|||
|
IN PBUS_HANDLER BusHandler,
|
|||
|
IN PBUS_HANDLER RootHandler,
|
|||
|
IN PHYSICAL_ADDRESS BusAddress,
|
|||
|
IN OUT PULONG AddressSpace,
|
|||
|
OUT PPHYSICAL_ADDRESS TranslatedAddress
|
|||
|
)
|
|||
|
|
|||
|
/*++
|
|||
|
|
|||
|
Routine Description:
|
|||
|
|
|||
|
This function translates a bus-relative address space and address into
|
|||
|
a system physical address.
|
|||
|
|
|||
|
Arguments:
|
|||
|
|
|||
|
BusAddress - Supplies the bus-relative address
|
|||
|
|
|||
|
AddressSpace - Supplies the address space number.
|
|||
|
Returns the host address space number.
|
|||
|
|
|||
|
AddressSpace == 0 => memory space
|
|||
|
AddressSpace == 1 => I/O space
|
|||
|
|
|||
|
TranslatedAddress - Supplies a pointer to return the translated address
|
|||
|
|
|||
|
Return Value:
|
|||
|
|
|||
|
A return value of TRUE indicates that a system physical address
|
|||
|
corresponding to the supplied bus relative address and bus address
|
|||
|
number has been returned in TranslatedAddress.
|
|||
|
|
|||
|
A return value of FALSE occurs if the translation for the address was
|
|||
|
not possible
|
|||
|
|
|||
|
--*/
|
|||
|
|
|||
|
{
|
|||
|
PSUPPORTED_RANGE pRange;
|
|||
|
|
|||
|
pRange = NULL;
|
|||
|
switch (*AddressSpace) {
|
|||
|
case 0:
|
|||
|
// verify memory address is within buses memory limits
|
|||
|
for (pRange = &BusHandler->BusAddresses->PrefetchMemory; pRange; pRange = pRange->Next) {
|
|||
|
if (BusAddress.QuadPart >= pRange->Base &&
|
|||
|
BusAddress.QuadPart <= pRange->Limit) {
|
|||
|
break;
|
|||
|
}
|
|||
|
}
|
|||
|
|
|||
|
if (!pRange) {
|
|||
|
for (pRange = &BusHandler->BusAddresses->Memory; pRange; pRange = pRange->Next) {
|
|||
|
if (BusAddress.QuadPart >= pRange->Base &&
|
|||
|
BusAddress.QuadPart <= pRange->Limit) {
|
|||
|
break;
|
|||
|
}
|
|||
|
}
|
|||
|
}
|
|||
|
|
|||
|
break;
|
|||
|
|
|||
|
case 1:
|
|||
|
// verify IO address is within buses IO limits
|
|||
|
for (pRange = &BusHandler->BusAddresses->IO; pRange; pRange = pRange->Next) {
|
|||
|
if (BusAddress.QuadPart >= pRange->Base &&
|
|||
|
BusAddress.QuadPart <= pRange->Limit) {
|
|||
|
break;
|
|||
|
}
|
|||
|
}
|
|||
|
break;
|
|||
|
}
|
|||
|
|
|||
|
if (pRange) {
|
|||
|
TranslatedAddress->QuadPart = BusAddress.QuadPart + pRange->SystemBase;
|
|||
|
*AddressSpace = pRange->SystemAddressSpace;
|
|||
|
return TRUE;
|
|||
|
}
|
|||
|
|
|||
|
return FALSE;
|
|||
|
}
|
|||
|
|
|||
|
|
|||
|
ULONG
|
|||
|
HalpGetSystemInterruptVector(
|
|||
|
IN PBUS_HANDLER BusHandler,
|
|||
|
IN PBUS_HANDLER RootHandler,
|
|||
|
IN ULONG BusInterruptLevel,
|
|||
|
IN ULONG BusInterruptVector,
|
|||
|
OUT PKIRQL pIrql,
|
|||
|
OUT PKAFFINITY pAffinity
|
|||
|
)
|
|||
|
|
|||
|
/*++
|
|||
|
|
|||
|
Routine Description:
|
|||
|
|
|||
|
Arguments:
|
|||
|
|
|||
|
BusInterruptLevel - Supplies the bus specific interrupt level.
|
|||
|
|
|||
|
BusInterruptVector - Supplies the bus specific interrupt vector.
|
|||
|
|
|||
|
Irql - Returns the system request priority.
|
|||
|
|
|||
|
Affinity - Returns the system wide irq affinity.
|
|||
|
|
|||
|
Return Value:
|
|||
|
|
|||
|
Returns the system interrupt vector corresponding to the specified device.
|
|||
|
|
|||
|
--*/
|
|||
|
{
|
|||
|
ULONG SystemVector;
|
|||
|
ULONG Cpu;
|
|||
|
ULONG Affinity;
|
|||
|
KIRQL Irql;
|
|||
|
|
|||
|
UNREFERENCED_PARAMETER( BusHandler );
|
|||
|
UNREFERENCED_PARAMETER( RootHandler );
|
|||
|
UNREFERENCED_PARAMETER( BusInterruptVector );
|
|||
|
|
|||
|
//
|
|||
|
// Set default SystemVector, IRQL & CPU
|
|||
|
//
|
|||
|
|
|||
|
SystemVector = BusInterruptLevel + PRIMARY_VECTOR_BASE;
|
|||
|
Irql = (KIRQL)(HIGHEST_LEVEL_FOR_8259 + PRIMARY_VECTOR_BASE - SystemVector);
|
|||
|
Cpu = 0;
|
|||
|
|
|||
|
|
|||
|
if (SystemVector < PRIMARY_VECTOR_BASE ||
|
|||
|
SystemVector > PRIMARY_VECTOR_BASE + HIGHEST_LEVEL_FOR_8259 ||
|
|||
|
HalpIDTUsageFlags[SystemVector].Flags & IDTOwned ) {
|
|||
|
|
|||
|
//
|
|||
|
// This is an illegal BusInterruptVector and cannot be connected.
|
|||
|
//
|
|||
|
|
|||
|
return(0);
|
|||
|
}
|
|||
|
|
|||
|
//
|
|||
|
// If this is machine has reported SMP Dev Ints then lets
|
|||
|
// use them in a static interrupt distribution method.
|
|||
|
// Notice some devices are kept on P0 for compatibility.
|
|||
|
// These interrupts and their devices are not generally used
|
|||
|
// for steady state operations.
|
|||
|
//
|
|||
|
|
|||
|
if (Sp8259PerProcessorMode & SP_SMPDEVINTS) {
|
|||
|
|
|||
|
//
|
|||
|
// This is for overriding some devices that belong on P0.
|
|||
|
//
|
|||
|
|
|||
|
switch (BusInterruptLevel) {
|
|||
|
case 1: // keyboard
|
|||
|
case 3: // com2
|
|||
|
case 4: // com1
|
|||
|
case 5: // SysMgmt Modem
|
|||
|
case 6: // floppy
|
|||
|
case 12: // mouse
|
|||
|
// use first cpu
|
|||
|
break;
|
|||
|
|
|||
|
case 13: // Health (IPIs on all)
|
|||
|
// use first cpu, as:
|
|||
|
Irql = IPI_LEVEL;
|
|||
|
SystemVector = PRIMARY_VECTOR_BASE + SECOND_IPI_DISPATCH;
|
|||
|
break;
|
|||
|
|
|||
|
default:
|
|||
|
Cpu = SystemVector % HalpCpuCount;
|
|||
|
break;
|
|||
|
}
|
|||
|
}
|
|||
|
|
|||
|
//
|
|||
|
// Get Affinity for Cpu
|
|||
|
//
|
|||
|
|
|||
|
Affinity = 1 << Cpu;
|
|||
|
ASSERT (Affinity);
|
|||
|
|
|||
|
//
|
|||
|
// Done
|
|||
|
//
|
|||
|
|
|||
|
*pAffinity = Affinity;
|
|||
|
*pIrql = Irql;
|
|||
|
return SystemVector;
|
|||
|
}
|
|||
|
|
|||
|
NTSTATUS
|
|||
|
HalIrqTranslateResourceRequirementsRoot(
|
|||
|
IN PVOID Context,
|
|||
|
IN PIO_RESOURCE_DESCRIPTOR Source,
|
|||
|
IN PDEVICE_OBJECT PhysicalDeviceObject,
|
|||
|
OUT PULONG TargetCount,
|
|||
|
OUT PIO_RESOURCE_DESCRIPTOR *Target
|
|||
|
)
|
|||
|
/*++
|
|||
|
|
|||
|
Routine Description:
|
|||
|
|
|||
|
This function takes an IO_RESOURCE_DESCRIPTOR and translates
|
|||
|
it from an IO-bus-relative to a Processor-bus-relative form. In this
|
|||
|
x86-specific example, an IO-bus-relative form is the ISA IRQ and the
|
|||
|
Processor-bus-relative form is the IDT entry and the associated IRQL.
|
|||
|
This is essentially a PnP form of HalGetInterruptVector.
|
|||
|
|
|||
|
Arguments:
|
|||
|
|
|||
|
Context - unused
|
|||
|
|
|||
|
Source - descriptor that we are translating
|
|||
|
|
|||
|
PhysicalDeviceObject- unused
|
|||
|
|
|||
|
TargetCount - 1
|
|||
|
|
|||
|
Target - translated descriptor
|
|||
|
|
|||
|
Return Value:
|
|||
|
|
|||
|
status
|
|||
|
|
|||
|
--*/
|
|||
|
{
|
|||
|
return STATUS_NOT_IMPLEMENTED;
|
|||
|
}
|
|||
|
NTSTATUS
|
|||
|
HalIrqTranslateResourcesRoot(
|
|||
|
IN PVOID Context,
|
|||
|
IN PCM_PARTIAL_RESOURCE_DESCRIPTOR Source,
|
|||
|
IN RESOURCE_TRANSLATION_DIRECTION Direction,
|
|||
|
IN ULONG AlternativesCount, OPTIONAL
|
|||
|
IN IO_RESOURCE_DESCRIPTOR Alternatives[], OPTIONAL
|
|||
|
IN PDEVICE_OBJECT PhysicalDeviceObject,
|
|||
|
OUT PCM_PARTIAL_RESOURCE_DESCRIPTOR Target
|
|||
|
)
|
|||
|
{
|
|||
|
return STATUS_NOT_IMPLEMENTED;
|
|||
|
}
|
|||
|
|
|||
|
NTSTATUS
|
|||
|
HalpTransMemIoResourceRequirement(
|
|||
|
IN PVOID Context,
|
|||
|
IN PIO_RESOURCE_DESCRIPTOR Source,
|
|||
|
IN PDEVICE_OBJECT PhysicalDeviceObject,
|
|||
|
OUT PULONG TargetCount,
|
|||
|
OUT PIO_RESOURCE_DESCRIPTOR *Target
|
|||
|
)
|
|||
|
|
|||
|
/*++
|
|||
|
|
|||
|
Routine Description:
|
|||
|
|
|||
|
This routine translates memory and IO resource requirements.
|
|||
|
|
|||
|
Parameters:
|
|||
|
|
|||
|
Context - The context from the TRANSLATOR_INTERFACE
|
|||
|
|
|||
|
Source - The interrupt requirement to translate
|
|||
|
|
|||
|
PhysicalDeviceObject - The device requesting the resource
|
|||
|
|
|||
|
TargetCount - Pointer to where to return the number of descriptors this
|
|||
|
requirement translates into
|
|||
|
|
|||
|
Target - Pointer to where a pointer to a callee allocated buffer containing
|
|||
|
the translated descriptors should be placed.
|
|||
|
|
|||
|
Return Value:
|
|||
|
|
|||
|
STATUS_SUCCESS or an error status
|
|||
|
|
|||
|
Note:
|
|||
|
|
|||
|
We do not perform any translation.
|
|||
|
|
|||
|
--*/
|
|||
|
|
|||
|
{
|
|||
|
ASSERT(Source);
|
|||
|
ASSERT(Target);
|
|||
|
ASSERT(TargetCount);
|
|||
|
ASSERT(Source->Type == CmResourceTypeMemory ||
|
|||
|
Source->Type == CmResourceTypePort);
|
|||
|
|
|||
|
|
|||
|
//
|
|||
|
// Allocate space for the target
|
|||
|
//
|
|||
|
|
|||
|
*Target = ExAllocatePoolWithTag(PagedPool,
|
|||
|
sizeof(IO_RESOURCE_DESCRIPTOR),
|
|||
|
' laH');
|
|||
|
|
|||
|
if (!*Target) {
|
|||
|
return STATUS_INSUFFICIENT_RESOURCES;
|
|||
|
}
|
|||
|
|
|||
|
//
|
|||
|
// Copy the source to target and update the fields that have changed
|
|||
|
//
|
|||
|
|
|||
|
**Target = *Source;
|
|||
|
*TargetCount = 1;
|
|||
|
|
|||
|
return STATUS_SUCCESS;
|
|||
|
}
|
|||
|
|
|||
|
NTSTATUS
|
|||
|
HalpTransMemIoResource(
|
|||
|
IN PVOID Context,
|
|||
|
IN PCM_PARTIAL_RESOURCE_DESCRIPTOR Source,
|
|||
|
IN RESOURCE_TRANSLATION_DIRECTION Direction,
|
|||
|
IN ULONG AlternativesCount, OPTIONAL
|
|||
|
IN IO_RESOURCE_DESCRIPTOR Alternatives[], OPTIONAL
|
|||
|
IN PDEVICE_OBJECT PhysicalDeviceObject,
|
|||
|
OUT PCM_PARTIAL_RESOURCE_DESCRIPTOR Target
|
|||
|
)
|
|||
|
|
|||
|
/*++
|
|||
|
|
|||
|
Routine Description:
|
|||
|
|
|||
|
This routine translates memory and IO resources. On generic x86
|
|||
|
machines, such as those that use this HAL, there isn't actually
|
|||
|
any translation.
|
|||
|
|
|||
|
Parameters:
|
|||
|
|
|||
|
Context - The context from the TRANSLATOR_INTERFACE
|
|||
|
|
|||
|
Source - The interrupt resource to translate
|
|||
|
|
|||
|
Direction - The direction in relation to the Pnp device tree translation
|
|||
|
should occur in.
|
|||
|
|
|||
|
AlternativesCount - The number of alternatives this resource was selected
|
|||
|
from.
|
|||
|
|
|||
|
Alternatives - Array of alternatives this resource was selected from.
|
|||
|
|
|||
|
PhysicalDeviceObject - The device requesting the resource
|
|||
|
|
|||
|
Target - Pointer to a caller allocated buffer to hold the translted resource
|
|||
|
descriptor.
|
|||
|
|
|||
|
Return Value:
|
|||
|
|
|||
|
STATUS_SUCCESS or an error status
|
|||
|
|
|||
|
--*/
|
|||
|
|
|||
|
{
|
|||
|
NTSTATUS status;
|
|||
|
|
|||
|
//
|
|||
|
// Copy the target to the source
|
|||
|
//
|
|||
|
|
|||
|
*Target = *Source;
|
|||
|
|
|||
|
switch (Direction) {
|
|||
|
case TranslateChildToParent:
|
|||
|
|
|||
|
//
|
|||
|
// Make sure PnP knows it doesn't have to walk up the tree
|
|||
|
// translating at each point.
|
|||
|
//
|
|||
|
|
|||
|
status = STATUS_TRANSLATION_COMPLETE;
|
|||
|
break;
|
|||
|
|
|||
|
case TranslateParentToChild:
|
|||
|
|
|||
|
//
|
|||
|
// We do not translate requirements so do nothing...
|
|||
|
//
|
|||
|
|
|||
|
status = STATUS_SUCCESS;
|
|||
|
break;
|
|||
|
|
|||
|
default:
|
|||
|
status = STATUS_INVALID_PARAMETER;
|
|||
|
}
|
|||
|
return status;
|
|||
|
}
|
|||
|
VOID
|
|||
|
HalTranslatorReference(
|
|||
|
PVOID Context
|
|||
|
)
|
|||
|
{
|
|||
|
return;
|
|||
|
}
|
|||
|
|
|||
|
VOID
|
|||
|
HalTranslatorDereference(
|
|||
|
PVOID Context
|
|||
|
)
|
|||
|
{
|
|||
|
return;
|
|||
|
}
|
|||
|
|