8670848171
iodev_write_*(). This removes unnecessary uses of temporary macros as well. There is no functional change after this (verified with md5(1) on amd64).
216 lines
6.1 KiB
C
216 lines
6.1 KiB
C
/*-
|
|
* Copyright (c) 2000, 2001 Michael Smith
|
|
* Copyright (c) 2000 BSDi
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
|
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
|
|
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
|
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
|
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
|
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
|
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
|
* SUCH DAMAGE.
|
|
*/
|
|
|
|
/*
|
|
* 6.7 : Hardware Abstraction
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__FBSDID("$FreeBSD$");
|
|
|
|
#include <contrib/dev/acpica/include/acpi.h>
|
|
|
|
#include <sys/bus.h>
|
|
#include <sys/kernel.h>
|
|
#include <machine/iodev.h>
|
|
#include <machine/pci_cfgreg.h>
|
|
#include <dev/acpica/acpivar.h>
|
|
#include <dev/pci/pcireg.h>
|
|
|
|
/*
|
|
* ACPICA's rather gung-ho approach to hardware resource ownership is a little
|
|
* troublesome insofar as there is no easy way for us to know in advance
|
|
* exactly which I/O resources it's going to want to use.
|
|
*
|
|
* In order to deal with this, we ignore resource ownership entirely, and simply
|
|
* use the native I/O space accessor functionality. This is Evil, but it works.
|
|
*/
|
|
|
|
ACPI_STATUS
|
|
AcpiOsReadPort(ACPI_IO_ADDRESS InPort, UINT32 *Value, UINT32 Width)
|
|
{
|
|
|
|
switch (Width) {
|
|
case 8:
|
|
*Value = iodev_read_1(InPort);
|
|
break;
|
|
case 16:
|
|
*Value = iodev_read_2(InPort);
|
|
break;
|
|
case 32:
|
|
*Value = iodev_read_4(InPort);
|
|
break;
|
|
}
|
|
|
|
return (AE_OK);
|
|
}
|
|
|
|
ACPI_STATUS
|
|
AcpiOsWritePort(ACPI_IO_ADDRESS OutPort, UINT32 Value, UINT32 Width)
|
|
{
|
|
|
|
switch (Width) {
|
|
case 8:
|
|
iodev_write_1(OutPort, Value);
|
|
break;
|
|
case 16:
|
|
iodev_write_2(OutPort, Value);
|
|
break;
|
|
case 32:
|
|
iodev_write_4(OutPort, Value);
|
|
break;
|
|
}
|
|
|
|
return (AE_OK);
|
|
}
|
|
|
|
ACPI_STATUS
|
|
AcpiOsReadPciConfiguration(ACPI_PCI_ID *PciId, UINT32 Register, void *Value,
|
|
UINT32 Width)
|
|
{
|
|
|
|
if (Width == 64)
|
|
return (AE_SUPPORT);
|
|
|
|
if (!pci_cfgregopen())
|
|
return (AE_NOT_EXIST);
|
|
|
|
*(UINT64 *)Value = pci_cfgregread(PciId->Bus, PciId->Device,
|
|
PciId->Function, Register, Width / 8);
|
|
|
|
return (AE_OK);
|
|
}
|
|
|
|
|
|
ACPI_STATUS
|
|
AcpiOsWritePciConfiguration (ACPI_PCI_ID *PciId, UINT32 Register,
|
|
UINT64 Value, UINT32 Width)
|
|
{
|
|
|
|
if (Width == 64)
|
|
return (AE_SUPPORT);
|
|
|
|
if (!pci_cfgregopen())
|
|
return (AE_NOT_EXIST);
|
|
|
|
pci_cfgregwrite(PciId->Bus, PciId->Device, PciId->Function, Register,
|
|
Value, Width / 8);
|
|
|
|
return (AE_OK);
|
|
}
|
|
|
|
/*
|
|
* Depth-first recursive case for finding the bus, given the slot/function.
|
|
*/
|
|
static int
|
|
acpi_bus_number(ACPI_HANDLE root, ACPI_HANDLE curr, ACPI_PCI_ID *PciId)
|
|
{
|
|
ACPI_HANDLE parent;
|
|
ACPI_STATUS status;
|
|
ACPI_OBJECT_TYPE type;
|
|
UINT32 adr;
|
|
int bus, slot, func, class, subclass, header;
|
|
|
|
/* Try to get the _BBN object of the root, otherwise assume it is 0. */
|
|
bus = 0;
|
|
if (root == curr) {
|
|
status = acpi_GetInteger(root, "_BBN", &bus);
|
|
if (ACPI_FAILURE(status) && bootverbose)
|
|
printf("acpi_bus_number: root bus has no _BBN, assuming 0\n");
|
|
return (bus);
|
|
}
|
|
status = AcpiGetParent(curr, &parent);
|
|
if (ACPI_FAILURE(status))
|
|
return (bus);
|
|
|
|
/* First, recurse up the tree until we find the host bus. */
|
|
bus = acpi_bus_number(root, parent, PciId);
|
|
|
|
/* Validate parent bus device type. */
|
|
if (ACPI_FAILURE(AcpiGetType(parent, &type)) || type != ACPI_TYPE_DEVICE) {
|
|
printf("acpi_bus_number: not a device, type %d\n", type);
|
|
return (bus);
|
|
}
|
|
|
|
/* Get the parent's slot and function. */
|
|
status = acpi_GetInteger(parent, "_ADR", &adr);
|
|
if (ACPI_FAILURE(status))
|
|
return (bus);
|
|
slot = ACPI_HIWORD(adr);
|
|
func = ACPI_LOWORD(adr);
|
|
|
|
/* Is this a PCI-PCI or Cardbus-PCI bridge? */
|
|
class = pci_cfgregread(bus, slot, func, PCIR_CLASS, 1);
|
|
if (class != PCIC_BRIDGE)
|
|
return (bus);
|
|
subclass = pci_cfgregread(bus, slot, func, PCIR_SUBCLASS, 1);
|
|
|
|
/* Find the header type, masking off the multifunction bit. */
|
|
header = pci_cfgregread(bus, slot, func, PCIR_HDRTYPE, 1) & PCIM_HDRTYPE;
|
|
if (header == PCIM_HDRTYPE_BRIDGE && subclass == PCIS_BRIDGE_PCI)
|
|
bus = pci_cfgregread(bus, slot, func, PCIR_SECBUS_1, 1);
|
|
else if (header == PCIM_HDRTYPE_CARDBUS && subclass == PCIS_BRIDGE_CARDBUS)
|
|
bus = pci_cfgregread(bus, slot, func, PCIR_SECBUS_2, 1);
|
|
return (bus);
|
|
}
|
|
|
|
/*
|
|
* Find the bus number for a device
|
|
*
|
|
* Device: handle for the PCI root bridge device
|
|
* Region: handle for the PCI configuration space operation region
|
|
* PciId: pointer to device slot and function, we fill out bus
|
|
*/
|
|
void
|
|
AcpiOsDerivePciId(ACPI_HANDLE Device, ACPI_HANDLE Region, ACPI_PCI_ID **PciId)
|
|
{
|
|
ACPI_HANDLE parent;
|
|
ACPI_STATUS status;
|
|
int bus;
|
|
|
|
if (pci_cfgregopen() == 0)
|
|
panic("AcpiOsDerivePciId unable to initialize pci bus");
|
|
|
|
/* Try to read _BBN for bus number if we're at the root. */
|
|
bus = 0;
|
|
if (Device == Region) {
|
|
status = acpi_GetInteger(Device, "_BBN", &bus);
|
|
if (ACPI_FAILURE(status) && bootverbose)
|
|
printf("AcpiOsDerivePciId: root bus has no _BBN, assuming 0\n");
|
|
}
|
|
|
|
/* Get the parent handle and call the recursive case. */
|
|
if (ACPI_SUCCESS(AcpiGetParent(Region, &parent)))
|
|
bus = acpi_bus_number(Device, parent, *PciId);
|
|
(*PciId)->Bus = bus;
|
|
if (bootverbose) {
|
|
printf("AcpiOsDerivePciId: %s -> bus %d dev %d func %d\n",
|
|
acpi_name(Region), (*PciId)->Bus, (*PciId)->Device,
|
|
(*PciId)->Function);
|
|
}
|
|
}
|