mirror of
https://github.com/edk2-porting/linux-next.git
synced 2024-12-16 17:23:55 +08:00
385 lines
10 KiB
C
385 lines
10 KiB
C
|
/*
|
||
|
* pci_bind.c - ACPI PCI Device Binding ($Revision: 2 $)
|
||
|
*
|
||
|
* Copyright (C) 2001, 2002 Andy Grover <andrew.grover@intel.com>
|
||
|
* Copyright (C) 2001, 2002 Paul Diefenbaugh <paul.s.diefenbaugh@intel.com>
|
||
|
*
|
||
|
* ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
|
||
|
*
|
||
|
* This program is free software; you can redistribute it and/or modify
|
||
|
* it under the terms of the GNU General Public License as published by
|
||
|
* the Free Software Foundation; either version 2 of the License, or (at
|
||
|
* your option) any later version.
|
||
|
*
|
||
|
* This program is distributed in the hope that it will be useful, but
|
||
|
* WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
||
|
* General Public License for more details.
|
||
|
*
|
||
|
* You should have received a copy of the GNU General Public License along
|
||
|
* with this program; if not, write to the Free Software Foundation, Inc.,
|
||
|
* 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
|
||
|
*
|
||
|
* ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
|
||
|
*/
|
||
|
|
||
|
#include <linux/kernel.h>
|
||
|
#include <linux/module.h>
|
||
|
#include <linux/init.h>
|
||
|
#include <linux/types.h>
|
||
|
#include <linux/proc_fs.h>
|
||
|
#include <linux/spinlock.h>
|
||
|
#include <linux/pm.h>
|
||
|
#include <linux/pci.h>
|
||
|
#include <linux/acpi.h>
|
||
|
#include <acpi/acpi_bus.h>
|
||
|
#include <acpi/acpi_drivers.h>
|
||
|
|
||
|
|
||
|
#define _COMPONENT ACPI_PCI_COMPONENT
|
||
|
ACPI_MODULE_NAME ("pci_bind")
|
||
|
|
||
|
struct acpi_pci_data {
|
||
|
struct acpi_pci_id id;
|
||
|
struct pci_bus *bus;
|
||
|
struct pci_dev *dev;
|
||
|
};
|
||
|
|
||
|
|
||
|
void
|
||
|
acpi_pci_data_handler (
|
||
|
acpi_handle handle,
|
||
|
u32 function,
|
||
|
void *context)
|
||
|
{
|
||
|
ACPI_FUNCTION_TRACE("acpi_pci_data_handler");
|
||
|
|
||
|
/* TBD: Anything we need to do here? */
|
||
|
|
||
|
return_VOID;
|
||
|
}
|
||
|
|
||
|
|
||
|
/**
|
||
|
* acpi_os_get_pci_id
|
||
|
* ------------------
|
||
|
* This function is used by the ACPI Interpreter (a.k.a. Core Subsystem)
|
||
|
* to resolve PCI information for ACPI-PCI devices defined in the namespace.
|
||
|
* This typically occurs when resolving PCI operation region information.
|
||
|
*/
|
||
|
#ifdef ACPI_FUTURE_USAGE
|
||
|
acpi_status
|
||
|
acpi_os_get_pci_id (
|
||
|
acpi_handle handle,
|
||
|
struct acpi_pci_id *id)
|
||
|
{
|
||
|
int result = 0;
|
||
|
acpi_status status = AE_OK;
|
||
|
struct acpi_device *device = NULL;
|
||
|
struct acpi_pci_data *data = NULL;
|
||
|
|
||
|
ACPI_FUNCTION_TRACE("acpi_os_get_pci_id");
|
||
|
|
||
|
if (!id)
|
||
|
return_ACPI_STATUS(AE_BAD_PARAMETER);
|
||
|
|
||
|
result = acpi_bus_get_device(handle, &device);
|
||
|
if (result) {
|
||
|
ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
|
||
|
"Invalid ACPI Bus context for device %s\n",
|
||
|
acpi_device_bid(device)));
|
||
|
return_ACPI_STATUS(AE_NOT_EXIST);
|
||
|
}
|
||
|
|
||
|
status = acpi_get_data(handle, acpi_pci_data_handler, (void**) &data);
|
||
|
if (ACPI_FAILURE(status) || !data || !data->dev) {
|
||
|
ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
|
||
|
"Invalid ACPI-PCI context for device %s\n",
|
||
|
acpi_device_bid(device)));
|
||
|
return_ACPI_STATUS(status);
|
||
|
}
|
||
|
|
||
|
*id = data->id;
|
||
|
|
||
|
/*
|
||
|
id->segment = data->id.segment;
|
||
|
id->bus = data->id.bus;
|
||
|
id->device = data->id.device;
|
||
|
id->function = data->id.function;
|
||
|
*/
|
||
|
|
||
|
ACPI_DEBUG_PRINT((ACPI_DB_INFO,
|
||
|
"Device %s has PCI address %02x:%02x:%02x.%02x\n",
|
||
|
acpi_device_bid(device), id->segment, id->bus,
|
||
|
id->device, id->function));
|
||
|
|
||
|
return_ACPI_STATUS(AE_OK);
|
||
|
}
|
||
|
#endif /* ACPI_FUTURE_USAGE */
|
||
|
|
||
|
|
||
|
int
|
||
|
acpi_pci_bind (
|
||
|
struct acpi_device *device)
|
||
|
{
|
||
|
int result = 0;
|
||
|
acpi_status status = AE_OK;
|
||
|
struct acpi_pci_data *data = NULL;
|
||
|
struct acpi_pci_data *pdata = NULL;
|
||
|
char *pathname = NULL;
|
||
|
struct acpi_buffer buffer = {0, NULL};
|
||
|
acpi_handle handle = NULL;
|
||
|
|
||
|
ACPI_FUNCTION_TRACE("acpi_pci_bind");
|
||
|
|
||
|
if (!device || !device->parent)
|
||
|
return_VALUE(-EINVAL);
|
||
|
|
||
|
pathname = kmalloc(ACPI_PATHNAME_MAX, GFP_KERNEL);
|
||
|
if(!pathname)
|
||
|
return_VALUE(-ENOMEM);
|
||
|
memset(pathname, 0, ACPI_PATHNAME_MAX);
|
||
|
buffer.length = ACPI_PATHNAME_MAX;
|
||
|
buffer.pointer = pathname;
|
||
|
|
||
|
data = kmalloc(sizeof(struct acpi_pci_data), GFP_KERNEL);
|
||
|
if (!data){
|
||
|
kfree (pathname);
|
||
|
return_VALUE(-ENOMEM);
|
||
|
}
|
||
|
memset(data, 0, sizeof(struct acpi_pci_data));
|
||
|
|
||
|
acpi_get_name(device->handle, ACPI_FULL_PATHNAME, &buffer);
|
||
|
ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Binding PCI device [%s]...\n",
|
||
|
pathname));
|
||
|
|
||
|
/*
|
||
|
* Segment & Bus
|
||
|
* -------------
|
||
|
* These are obtained via the parent device's ACPI-PCI context.
|
||
|
*/
|
||
|
status = acpi_get_data(device->parent->handle, acpi_pci_data_handler,
|
||
|
(void**) &pdata);
|
||
|
if (ACPI_FAILURE(status) || !pdata || !pdata->bus) {
|
||
|
ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
|
||
|
"Invalid ACPI-PCI context for parent device %s\n",
|
||
|
acpi_device_bid(device->parent)));
|
||
|
result = -ENODEV;
|
||
|
goto end;
|
||
|
}
|
||
|
data->id.segment = pdata->id.segment;
|
||
|
data->id.bus = pdata->bus->number;
|
||
|
|
||
|
/*
|
||
|
* Device & Function
|
||
|
* -----------------
|
||
|
* These are simply obtained from the device's _ADR method. Note
|
||
|
* that a value of zero is valid.
|
||
|
*/
|
||
|
data->id.device = device->pnp.bus_address >> 16;
|
||
|
data->id.function = device->pnp.bus_address & 0xFFFF;
|
||
|
|
||
|
ACPI_DEBUG_PRINT((ACPI_DB_INFO, "...to %02x:%02x:%02x.%02x\n",
|
||
|
data->id.segment, data->id.bus, data->id.device,
|
||
|
data->id.function));
|
||
|
|
||
|
/*
|
||
|
* TBD: Support slot devices (e.g. function=0xFFFF).
|
||
|
*/
|
||
|
|
||
|
/*
|
||
|
* Locate PCI Device
|
||
|
* -----------------
|
||
|
* Locate matching device in PCI namespace. If it doesn't exist
|
||
|
* this typically means that the device isn't currently inserted
|
||
|
* (e.g. docking station, port replicator, etc.).
|
||
|
*/
|
||
|
data->dev = pci_find_slot(data->id.bus, PCI_DEVFN(data->id.device, data->id.function));
|
||
|
if (!data->dev) {
|
||
|
ACPI_DEBUG_PRINT((ACPI_DB_INFO,
|
||
|
"Device %02x:%02x:%02x.%02x not present in PCI namespace\n",
|
||
|
data->id.segment, data->id.bus,
|
||
|
data->id.device, data->id.function));
|
||
|
result = -ENODEV;
|
||
|
goto end;
|
||
|
}
|
||
|
if (!data->dev->bus) {
|
||
|
ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
|
||
|
"Device %02x:%02x:%02x.%02x has invalid 'bus' field\n",
|
||
|
data->id.segment, data->id.bus,
|
||
|
data->id.device, data->id.function));
|
||
|
result = -ENODEV;
|
||
|
goto end;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* PCI Bridge?
|
||
|
* -----------
|
||
|
* If so, set the 'bus' field and install the 'bind' function to
|
||
|
* facilitate callbacks for all of its children.
|
||
|
*/
|
||
|
if (data->dev->subordinate) {
|
||
|
ACPI_DEBUG_PRINT((ACPI_DB_INFO,
|
||
|
"Device %02x:%02x:%02x.%02x is a PCI bridge\n",
|
||
|
data->id.segment, data->id.bus,
|
||
|
data->id.device, data->id.function));
|
||
|
data->bus = data->dev->subordinate;
|
||
|
device->ops.bind = acpi_pci_bind;
|
||
|
device->ops.unbind = acpi_pci_unbind;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* Attach ACPI-PCI Context
|
||
|
* -----------------------
|
||
|
* Thus binding the ACPI and PCI devices.
|
||
|
*/
|
||
|
status = acpi_attach_data(device->handle, acpi_pci_data_handler, data);
|
||
|
if (ACPI_FAILURE(status)) {
|
||
|
ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
|
||
|
"Unable to attach ACPI-PCI context to device %s\n",
|
||
|
acpi_device_bid(device)));
|
||
|
result = -ENODEV;
|
||
|
goto end;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* PCI Routing Table
|
||
|
* -----------------
|
||
|
* Evaluate and parse _PRT, if exists. This code is independent of
|
||
|
* PCI bridges (above) to allow parsing of _PRT objects within the
|
||
|
* scope of non-bridge devices. Note that _PRTs within the scope of
|
||
|
* a PCI bridge assume the bridge's subordinate bus number.
|
||
|
*
|
||
|
* TBD: Can _PRTs exist within the scope of non-bridge PCI devices?
|
||
|
*/
|
||
|
status = acpi_get_handle(device->handle, METHOD_NAME__PRT, &handle);
|
||
|
if (ACPI_SUCCESS(status)) {
|
||
|
if (data->bus) /* PCI-PCI bridge */
|
||
|
acpi_pci_irq_add_prt(device->handle, data->id.segment,
|
||
|
data->bus->number);
|
||
|
else /* non-bridge PCI device */
|
||
|
acpi_pci_irq_add_prt(device->handle, data->id.segment,
|
||
|
data->id.bus);
|
||
|
}
|
||
|
|
||
|
end:
|
||
|
kfree(pathname);
|
||
|
if (result)
|
||
|
kfree(data);
|
||
|
|
||
|
return_VALUE(result);
|
||
|
}
|
||
|
|
||
|
int acpi_pci_unbind(
|
||
|
struct acpi_device *device)
|
||
|
{
|
||
|
int result = 0;
|
||
|
acpi_status status = AE_OK;
|
||
|
struct acpi_pci_data *data = NULL;
|
||
|
char *pathname = NULL;
|
||
|
struct acpi_buffer buffer = {0, NULL};
|
||
|
|
||
|
ACPI_FUNCTION_TRACE("acpi_pci_unbind");
|
||
|
|
||
|
if (!device || !device->parent)
|
||
|
return_VALUE(-EINVAL);
|
||
|
|
||
|
pathname = (char *) kmalloc(ACPI_PATHNAME_MAX, GFP_KERNEL);
|
||
|
if(!pathname)
|
||
|
return_VALUE(-ENOMEM);
|
||
|
memset(pathname, 0, ACPI_PATHNAME_MAX);
|
||
|
|
||
|
buffer.length = ACPI_PATHNAME_MAX;
|
||
|
buffer.pointer = pathname;
|
||
|
acpi_get_name(device->handle, ACPI_FULL_PATHNAME, &buffer);
|
||
|
ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Unbinding PCI device [%s]...\n",
|
||
|
pathname));
|
||
|
kfree(pathname);
|
||
|
|
||
|
status = acpi_get_data(device->handle, acpi_pci_data_handler, (void**)&data);
|
||
|
if (ACPI_FAILURE(status)) {
|
||
|
ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
|
||
|
"Unable to get data from device %s\n",
|
||
|
acpi_device_bid(device)));
|
||
|
result = -ENODEV;
|
||
|
goto end;
|
||
|
}
|
||
|
|
||
|
status = acpi_detach_data(device->handle, acpi_pci_data_handler);
|
||
|
if (ACPI_FAILURE(status)) {
|
||
|
ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
|
||
|
"Unable to detach data from device %s\n",
|
||
|
acpi_device_bid(device)));
|
||
|
result = -ENODEV;
|
||
|
goto end;
|
||
|
}
|
||
|
if (data->dev->subordinate) {
|
||
|
acpi_pci_irq_del_prt(data->id.segment, data->bus->number);
|
||
|
}
|
||
|
kfree(data);
|
||
|
|
||
|
end:
|
||
|
return_VALUE(result);
|
||
|
}
|
||
|
|
||
|
int
|
||
|
acpi_pci_bind_root (
|
||
|
struct acpi_device *device,
|
||
|
struct acpi_pci_id *id,
|
||
|
struct pci_bus *bus)
|
||
|
{
|
||
|
int result = 0;
|
||
|
acpi_status status = AE_OK;
|
||
|
struct acpi_pci_data *data = NULL;
|
||
|
char *pathname = NULL;
|
||
|
struct acpi_buffer buffer = {0, NULL};
|
||
|
|
||
|
ACPI_FUNCTION_TRACE("acpi_pci_bind_root");
|
||
|
|
||
|
pathname = (char *)kmalloc(ACPI_PATHNAME_MAX, GFP_KERNEL);
|
||
|
if(!pathname)
|
||
|
return_VALUE(-ENOMEM);
|
||
|
memset(pathname, 0, ACPI_PATHNAME_MAX);
|
||
|
|
||
|
buffer.length = ACPI_PATHNAME_MAX;
|
||
|
buffer.pointer = pathname;
|
||
|
|
||
|
if (!device || !id || !bus){
|
||
|
kfree(pathname);
|
||
|
return_VALUE(-EINVAL);
|
||
|
}
|
||
|
|
||
|
data = kmalloc(sizeof(struct acpi_pci_data), GFP_KERNEL);
|
||
|
if (!data){
|
||
|
kfree(pathname);
|
||
|
return_VALUE(-ENOMEM);
|
||
|
}
|
||
|
memset(data, 0, sizeof(struct acpi_pci_data));
|
||
|
|
||
|
data->id = *id;
|
||
|
data->bus = bus;
|
||
|
device->ops.bind = acpi_pci_bind;
|
||
|
device->ops.unbind = acpi_pci_unbind;
|
||
|
|
||
|
acpi_get_name(device->handle, ACPI_FULL_PATHNAME, &buffer);
|
||
|
|
||
|
ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Binding PCI root bridge [%s] to "
|
||
|
"%02x:%02x\n", pathname, id->segment, id->bus));
|
||
|
|
||
|
status = acpi_attach_data(device->handle, acpi_pci_data_handler, data);
|
||
|
if (ACPI_FAILURE(status)) {
|
||
|
ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
|
||
|
"Unable to attach ACPI-PCI context to device %s\n",
|
||
|
pathname));
|
||
|
result = -ENODEV;
|
||
|
goto end;
|
||
|
}
|
||
|
|
||
|
end:
|
||
|
kfree(pathname);
|
||
|
if (result != 0)
|
||
|
kfree(data);
|
||
|
|
||
|
return_VALUE(result);
|
||
|
}
|