windows-nt/Source/XPSP1/NT/base/hals/pciirqmp/i386/misc.c

718 lines
13 KiB
C
Raw Normal View History

2020-09-26 03:20:57 -05:00
/*++
Copyright (c) 1990-1998 Microsoft Corporation
Module Name:
misc.c
Abstract:
This contains the misc support functions used by the
PCI IRQ Miniport library.
Author:
Santosh Jodh (santoshj) 09-June-1998
Environment:
kernel mode only
Revision History:
--*/
#include "local.h"
NTSTATUS
EisaGetTrigger (
OUT PULONG Trigger
)
/*++
Routine Description:
This routine gets the EISA Irq trigger mask (1 - Level, 0 - Edge).
Parameters:
Trigger - Trigger mask is returned in this argument.
Return Value:
PCIIRQMP_STATUS_SUCCESS.
Notes:
--*/
{
UCHAR LowPart;
UCHAR HighPart;
//
// Read the edge\level mask for Irq 0-7.
//
LowPart = READ_PORT_UCHAR((PUCHAR)0x4D0);
//
// Allow delay before another I/O.
//
IO_Delay();
//
// Read the edge\level mask for Irq 8-15.
//
HighPart = READ_PORT_UCHAR((PUCHAR)0x4D1);
//
// Combine set the trigger to the mask for Irq 0-15.
//
*Trigger = (ULONG)((HighPart << 8) + LowPart) & 0xFFFF;
return (PCIMP_SUCCESS);
}
NTSTATUS
EisaSetTrigger (
IN ULONG Trigger
)
/*++
Routine Description:
This routine sets the EISA Irq trigger mask (1 - Level, 0 - Edge).
Parameters:
Trigger - Trigger mask to be set.
Return Value:
PCIIRQMP_STATUS_SUCCESS.
Notes:
--*/
{
//
// Program the EISA edge\level control for Irq 0-7.
//
WRITE_PORT_UCHAR((PUCHAR)0x4D0, (CHAR)Trigger);
//
// Allow delay before another I/O.
//
IO_Delay();
//
// Program the EISA edge\level control for Irq 8-15.
//
WRITE_PORT_UCHAR((PUCHAR)0x4D1, (CHAR)(Trigger >> 8));
return (PCIMP_SUCCESS);
}
UCHAR
ReadConfigUchar (
IN ULONG BusNumber,
IN ULONG DevFunc,
IN UCHAR Offset
)
/*++
Routine Description:
This routine calls the HAL to read the Pci config space.
Parameters:
BusNumber - Bus number of the Pci device being read.
DevFunc - Slot number of the Pci device being read (Dev (7:3), Func(2:0)).
Offset - Offset in the config space to be read.
Return Value:
Value read from the specified offset in the config space.
Notes:
--*/
{
UCHAR Data;
ULONG slotNumber;
slotNumber = (DevFunc >> 3) & 0x1F;
slotNumber |= ((DevFunc & 0x07) << 5);
//
// Initialize data to invalid values.
//
Data = 0xFF;
//
// Call the HAL to do the actual reading.
//
HalGetBusDataByOffset( PCIConfiguration,
BusNumber,
slotNumber,
&Data,
Offset,
sizeof(Data));
//
// Return data read to the caller.
//
return(Data);
}
USHORT
ReadConfigUshort (
IN ULONG BusNumber,
IN ULONG DevFunc,
IN UCHAR Offset
)
/*++
Routine Description:
This routine calls the HAL to read the Pci config space.
Parameters:
BusNumber - Bus number of the Pci device being read.
DevFunc - Slot number of the Pci device being read (Dev (7:3), Func(2:0)).
Offset - Offset in the config space to be read.
Return Value:
Value read from the specified offset in the config space.
Notes:
--*/
{
USHORT Data;
ULONG slotNumber;
slotNumber = (DevFunc >> 3) & 0x1F;
slotNumber |= ((DevFunc & 0x07) << 5);
//
// Initialize data to invalid values.
//
Data = 0xFFFF;
//
// Call the HAL to do the actual reading.
//
HalGetBusDataByOffset( PCIConfiguration,
BusNumber,
slotNumber,
&Data,
Offset,
sizeof(Data));
//
// Return data read to the caller.
//
return(Data);
}
ULONG
ReadConfigUlong (
IN ULONG BusNumber,
IN ULONG DevFunc,
IN UCHAR Offset
)
/*++
Routine Description:
This routine calls the HAL to read the Pci config space.
Parameters:
BusNumber - Bus number of the Pci device being read.
DevFunc - Slot number of the Pci device being read (Dev (7:3), Func(2:0)).
Offset - Offset in the config space to be read.
Return Value:
Value read from the specified offset in the config space.
Notes:
--*/
{
ULONG Data;
ULONG slotNumber;
slotNumber = (DevFunc >> 3) & 0x1F;
slotNumber |= ((DevFunc & 0x07) << 5);
//
// Initialize data to invalid values.
//
Data = 0xFFFFFFFF;
//
// Call the HAL to do the actual reading.
//
HalGetBusDataByOffset( PCIConfiguration,
BusNumber,
slotNumber,
&Data,
Offset,
sizeof(Data));
//
// Return data read to the caller.
//
return(Data);
}
VOID
WriteConfigUchar (
IN ULONG BusNumber,
IN ULONG DevFunc,
IN UCHAR Offset,
IN UCHAR Data
)
/*++
Routine Description:
This routine calls the HAL to write to the Pci config space.
Parameters:
BusNumber - Bus number of the Pci device being written to.
DevFunc - Slot number of the Pci device being read (Dev (7:3), Func(2:0)).
Offset - Offset in the config space to be written.
Data - Value to be written.
Return Value:
None.
Notes:
--*/
{
ULONG slotNumber;
slotNumber = (DevFunc >> 3) & 0x1F;
slotNumber |= ((DevFunc & 0x07) << 5);
//
// Call the HAL to do the actual writing.
//
HalSetBusDataByOffset( PCIConfiguration,
BusNumber,
slotNumber,
&Data,
Offset,
sizeof(Data));
}
VOID
WriteConfigUshort (
IN ULONG BusNumber,
IN ULONG DevFunc,
IN UCHAR Offset,
IN USHORT Data
)
/*++
Routine Description:
This routine calls the HAL to write to the Pci config space.
Parameters:
BusNumber - Bus number of the Pci device being written to.
DevFunc - Slot number of the Pci device being read (Dev (7:3), Func(2:0)).
Offset - Offset in the config space to be written.
Data - Value to be written.
Return Value:
None.
Notes:
--*/
{
ULONG slotNumber;
slotNumber = (DevFunc >> 3) & 0x1F;
slotNumber |= ((DevFunc & 0x07) << 5);
//
// Call the HAL to do the actual writing.
//
HalSetBusDataByOffset( PCIConfiguration,
BusNumber,
slotNumber,
&Data,
Offset,
sizeof(Data));
}
VOID
WriteConfigUlong (
IN ULONG BusNumber,
IN ULONG DevFunc,
IN UCHAR Offset,
IN ULONG Data
)
/*++
Routine Description:
This routine calls the HAL to write to the Pci config space.
Parameters:
BusNumber - Bus number of the Pci device being written to.
DevFunc - Slot number of the Pci device being read (Dev (7:3), Func(2:0)).
Offset - Offset in the config space to be written.
Data - Value to be written.
Return Value:
None.
Notes:
--*/
{
ULONG slotNumber;
slotNumber = (DevFunc >> 3) & 0x1F;
slotNumber |= ((DevFunc & 0x07) << 5);
//
// Call the HAL to do the actual writing.
//
HalSetBusDataByOffset( PCIConfiguration,
BusNumber,
slotNumber,
&Data,
Offset,
sizeof(Data));
}
UCHAR
GetMinLink (
IN PPCI_IRQ_ROUTING_TABLE PciIrqRoutingTable
)
/*++
Routine Description:
This routine finds and returns the minimum link value in the
given Pci Irq Routing Table.
Parameters:
PciIrqRoutingTable - Pci Irq Routing Table to be processed.
Return Value:
Minimum link value in the table.
Notes:
--*/
{
UCHAR MinLink;
PPIN_INFO PinInfo;
PPIN_INFO LastPin;
PSLOT_INFO SlotInfo;
PSLOT_INFO LastSlot;
//
// Start by setting the maximum link to the maximum possible value.
//
MinLink = 0xFF;
//
// Process all slots in this table.
//
SlotInfo = (PSLOT_INFO)((PUCHAR)PciIrqRoutingTable + sizeof(PCI_IRQ_ROUTING_TABLE));
LastSlot = (PSLOT_INFO)((PUCHAR)PciIrqRoutingTable + PciIrqRoutingTable->TableSize);
while (SlotInfo < LastSlot)
{
//
// Process all pins for this slot.
//
PinInfo = &SlotInfo->PinInfo[0];
LastPin = &SlotInfo->PinInfo[NUM_IRQ_PINS];
while (PinInfo < LastPin)
{
//
// Update the min link found so far if the current link is
// valid and smaller.
//
if ( PinInfo->Link &&
PinInfo->Link < MinLink)
{
MinLink = PinInfo->Link;
}
//
// Next link.
//
PinInfo++;
}
//
// Next slot.
//
SlotInfo++;
}
//
// If we failed to find the minimum value, set the minimum to zero.
//
if (MinLink == 0xFF)
MinLink = 0;
//
// Return the minimum link in the table to the caller.
//
return (MinLink);
}
UCHAR
GetMaxLink (
IN PPCI_IRQ_ROUTING_TABLE PciIrqRoutingTable
)
/*++
Routine Description:
This routine finds and returns the maximum link value in the
given Pci Irq Routing Table.
Parameters:
PciIrqRoutingTable - Pci Irq Routing Table to be processed.
Return Value:
Maximum link value in the table.
Notes:
--*/
{
UCHAR MaxLink;
PPIN_INFO PinInfo;
PPIN_INFO LastPin;
PSLOT_INFO SlotInfo;
PSLOT_INFO LastSlot;
//
// Start by setting the maximum link to the smallest possible value.
//
MaxLink = 0;
//
// Process all slots in this table.
//
SlotInfo = (PSLOT_INFO)((PUCHAR)PciIrqRoutingTable + sizeof(PCI_IRQ_ROUTING_TABLE));
LastSlot = (PSLOT_INFO)((PUCHAR)PciIrqRoutingTable + PciIrqRoutingTable->TableSize);
while (SlotInfo < LastSlot)
{
//
// Process all pins for this slot.
//
PinInfo = &SlotInfo->PinInfo[0];
LastPin = &SlotInfo->PinInfo[NUM_IRQ_PINS];
while (PinInfo < LastPin)
{
//
// Update the max link found so far if the current link is
// valid and larger.
//
if ( PinInfo->Link &&
PinInfo->Link > MaxLink)
{
MaxLink = PinInfo->Link;
}
//
// Next pin.
//
PinInfo++;
}
//
// Next slot.
//
SlotInfo++;
}
//
// Return the maximum link in the table to the caller.
//
return (MaxLink);
}
#ifdef ALLOC_PRAGMA
#pragma alloc_text(PAGE, NormalizeLinks)
#endif //ALLOC_PRAGMA
VOID
NormalizeLinks (
IN PPCI_IRQ_ROUTING_TABLE PciIrqRoutingTable,
IN UCHAR Adjustment
)
/*++
Routine Description:
This routine normalizes all link values in the Pci Irq Routing Table by
adding the adjustment to all the links.
Parameters:
PciIrqRoutingTable - Pci Irq Routing Table to be normalized.
Adjustment - Amount to be added to each link.
Return Value:
None.
Notes:
--*/
{
PPIN_INFO PinInfo;
PPIN_INFO LastPin;
PSLOT_INFO SlotInfo;
PSLOT_INFO LastSlot;
PAGED_CODE();
//
// Process all slots in this table.
//
SlotInfo = (PSLOT_INFO)((PUCHAR)PciIrqRoutingTable + sizeof(PCI_IRQ_ROUTING_TABLE));
LastSlot = (PSLOT_INFO)((PUCHAR)PciIrqRoutingTable + PciIrqRoutingTable->TableSize);
while (SlotInfo < LastSlot)
{
//
// Process all pins.
//
PinInfo = &SlotInfo->PinInfo[0];
LastPin = &SlotInfo->PinInfo[NUM_IRQ_PINS];
while (PinInfo < LastPin)
{
//
// Only normalize valid link values.
//
if(PinInfo->Link)
{
PinInfo->Link += Adjustment;
}
//
// Next pin.
//
PinInfo++;
}
//
// Next slot.
//
SlotInfo++;
}
}