[PATCH] fix semaphore handling in __unregister_chrdev_region

[linux/fpc-iii.git] / drivers / acpi / pci_bind.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);
}