Skip to content
Snippets Groups Projects
acpiphp_glue.c 37.8 KiB
Newer Older
  • Learn to ignore specific revisions
  • Linus Torvalds's avatar
    Linus Torvalds committed
    /*
     * ACPI PCI HotPlug glue functions to ACPI CA subsystem
     *
     * Copyright (C) 2002,2003 Takayoshi Kochi (t-kochi@bq.jp.nec.com)
     * Copyright (C) 2002 Hiroshi Aono (h-aono@ap.jp.nec.com)
     * Copyright (C) 2002,2003 NEC Corporation
    
     * Copyright (C) 2003-2005 Matthew Wilcox (matthew.wilcox@hp.com)
     * Copyright (C) 2003-2005 Hewlett Packard
    
     * Copyright (C) 2005 Rajesh Shah (rajesh.shah@intel.com)
     * Copyright (C) 2005 Intel Corporation
    
    Linus Torvalds's avatar
    Linus Torvalds committed
     *
     * All rights reserved.
     *
     * 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, GOOD TITLE or
     * NON INFRINGEMENT.  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., 675 Mass Ave, Cambridge, MA 02139, USA.
     *
    
     * Send feedback to <kristen.c.accardi@intel.com>
    
    Linus Torvalds's avatar
    Linus Torvalds committed
     *
     */
    
    
    /*
     * Lifetime rules for pci_dev:
     *  - The one in acpiphp_bridge has its refcount elevated by pci_get_slot()
     *    when the bridge is scanned and it loses a refcount when the bridge
     *    is removed.
    
     *  - When a P2P bridge is present, we elevate the refcount on the subordinate
     *    bus. It loses the refcount when the the driver unloads.
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    #include <linux/init.h>
    #include <linux/module.h>
    
    #include <linux/kernel.h>
    #include <linux/pci.h>
    
    #include <linux/pci_hotplug.h>
    
    #include <linux/pci-acpi.h>
    
    #include <linux/mutex.h>
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    #include "../pci.h"
    #include "acpiphp.h"
    
    static LIST_HEAD(bridge_list);
    
    #define MY_NAME "acpiphp_glue"
    
    static void handle_hotplug_event_bridge (acpi_handle, u32, void *);
    
    static void acpiphp_sanitize_bus(struct pci_bus *bus);
    
    static void acpiphp_set_hpp_values(struct pci_bus *bus);
    
    static void handle_hotplug_event_func(acpi_handle handle, u32 type, void *context);
    
    /* callback routine to check for the existence of a pci dock device */
    
    static acpi_status
    is_pci_dock_device(acpi_handle handle, u32 lvl, void *context, void **rv)
    {
    	int *count = (int *)context;
    
    	if (is_dock_device(handle)) {
    		(*count)++;
    		return AE_CTRL_TERMINATE;
    	} else {
    		return AE_OK;
    	}
    }
    
    /*
     * the _DCK method can do funny things... and sometimes not
     * hah-hah funny.
     *
     * TBD - figure out a way to only call fixups for
     * systems that require them.
     */
    static int post_dock_fixups(struct notifier_block *nb, unsigned long val,
    	void *v)
    {
    	struct acpiphp_func *func = container_of(nb, struct acpiphp_func, nb);
    	struct pci_bus *bus = func->slot->bridge->pci_bus;
    	u32 buses;
    
    	if (!bus->self)
    		return  NOTIFY_OK;
    
    	/* fixup bad _DCK function that rewrites
    	 * secondary bridge on slot
    	 */
    	pci_read_config_dword(bus->self,
    			PCI_PRIMARY_BUS,
    			&buses);
    
    	if (((buses >> 8) & 0xff) != bus->secondary) {
    		buses = (buses & 0xff000000)
    
    			| ((unsigned int)(bus->primary)     <<  0)
    			| ((unsigned int)(bus->secondary)   <<  8)
    			| ((unsigned int)(bus->subordinate) << 16);
    
    		pci_write_config_dword(bus->self, PCI_PRIMARY_BUS, buses);
    	}
    	return NOTIFY_OK;
    }
    
    
    
    static const struct acpi_dock_ops acpiphp_dock_ops = {
    
    	.handler = handle_hotplug_event_func,
    };
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    /* callback routine to register each ACPI PCI slot object */
    static acpi_status
    register_slot(acpi_handle handle, u32 lvl, void *context, void **rv)
    {
    	struct acpiphp_bridge *bridge = (struct acpiphp_bridge *)context;
    	struct acpiphp_slot *slot;
    	struct acpiphp_func *newfunc;
    	acpi_handle tmp;
    	acpi_status status = AE_OK;
    
    	int device, function, retval;
    
    	struct pci_bus *pbus = bridge->pci_bus;
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    
    	if (!acpi_pci_check_ejectable(pbus, handle) && !is_dock_device(handle))
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    		return AE_OK;
    
    
    	pdev = pbus->self;
    	if (pdev && pci_is_pcie(pdev)) {
    		tmp = acpi_find_root_bridge_handle(pdev);
    		if (tmp) {
    			struct acpi_pci_root *root = acpi_pci_find_root(tmp);
    
    			if (root && (root->osc_control_set &
    					OSC_PCI_EXPRESS_NATIVE_HP_CONTROL))
    				return AE_OK;
    		}
    	}
    
    
    	acpi_evaluate_integer(handle, "_ADR", NULL, &adr);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	device = (adr >> 16) & 0xffff;
    	function = adr & 0xffff;
    
    
    	newfunc = kzalloc(sizeof(struct acpiphp_func), GFP_KERNEL);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	if (!newfunc)
    		return AE_NO_MEMORY;
    
    	INIT_LIST_HEAD(&newfunc->sibling);
    	newfunc->handle = handle;
    	newfunc->function = function;
    
    
    	if (ACPI_SUCCESS(acpi_get_handle(handle, "_EJ0", &tmp)))
    
    		newfunc->flags = FUNC_HAS_EJ0;
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    	if (ACPI_SUCCESS(acpi_get_handle(handle, "_STA", &tmp)))
    		newfunc->flags |= FUNC_HAS_STA;
    
    	if (ACPI_SUCCESS(acpi_get_handle(handle, "_PS0", &tmp)))
    		newfunc->flags |= FUNC_HAS_PS0;
    
    	if (ACPI_SUCCESS(acpi_get_handle(handle, "_PS3", &tmp)))
    		newfunc->flags |= FUNC_HAS_PS3;
    
    
    	if (ACPI_SUCCESS(acpi_get_handle(handle, "_DCK", &tmp)))
    
    		newfunc->flags |= FUNC_HAS_DCK;
    
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	status = acpi_evaluate_integer(handle, "_SUN", NULL, &sun);
    
    	if (ACPI_FAILURE(status)) {
    		/*
    		 * use the count of the number of slots we've found
    		 * for the number of the slot
    		 */
    		sun = bridge->nr_slots+1;
    	}
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    	/* search for objects that share the same slot */
    	for (slot = bridge->slots; slot; slot = slot->next)
    		if (slot->device == device) {
    			if (slot->sun != sun)
    				warn("sibling found, but _SUN doesn't match!\n");
    			break;
    		}
    
    	if (!slot) {
    
    		slot = kzalloc(sizeof(struct acpiphp_slot), GFP_KERNEL);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    		if (!slot) {
    			kfree(newfunc);
    			return AE_NO_MEMORY;
    		}
    
    		slot->bridge = bridge;
    		slot->device = device;
    		slot->sun = sun;
    		INIT_LIST_HEAD(&slot->funcs);
    
    		mutex_init(&slot->crit_sect);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    		slot->next = bridge->slots;
    		bridge->slots = slot;
    
    		bridge->nr_slots++;
    
    
    		dbg("found ACPI PCI Hotplug slot %llu at PCI %04x:%02x:%02x\n",
    
    		    slot->sun, pci_domain_nr(pbus), pbus->number, device);
    
    		retval = acpiphp_register_hotplug_slot(slot);
    		if (retval) {
    
    Alex Chiang's avatar
    Alex Chiang committed
    			if (retval == -EBUSY)
    
    				warn("Slot %llu already registered by another "
    
    Alex Chiang's avatar
    Alex Chiang committed
    					"hotplug driver\n", slot->sun);
    			else
    				warn("acpiphp_register_hotplug_slot failed "
    					"(err code = 0x%x)\n", retval);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	}
    
    	newfunc->slot = slot;
    	list_add_tail(&newfunc->sibling, &slot->funcs);
    
    
    	pdev = pci_get_slot(pbus, PCI_DEVFN(device, function));
    	if (pdev) {
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    		slot->flags |= (SLOT_ENABLED | SLOT_POWEREDON);
    
    	if (is_dock_device(handle)) {
    		/* we don't want to call this device's _EJ0
    		 * because we want the dock notify handler
    		 * to call it after it calls _DCK
    
    		 */
    		newfunc->flags &= ~FUNC_HAS_EJ0;
    
    		if (register_hotplug_dock_device(handle,
    
    			&acpiphp_dock_ops, newfunc))
    
    			dbg("failed to register dock device\n");
    
    		/* we need to be notified when dock events happen
    		 * outside of the hotplug operation, since we may
    		 * need to do fixups before we can hotplug.
    		 */
    		newfunc->nb.notifier_call = post_dock_fixups;
    		if (register_dock_notifier(&newfunc->nb))
    			dbg("failed to register a dock notifier");
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	/* install notify handler */
    
    	if (!(newfunc->flags & FUNC_HAS_DCK)) {
    		status = acpi_install_notify_handler(handle,
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    					     ACPI_SYSTEM_NOTIFY,
    					     handle_hotplug_event_func,
    					     newfunc);
    
    
    		if (ACPI_FAILURE(status))
    			err("failed to register interrupt notify handler\n");
    	} else
    		status = AE_OK;
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    
    
     err_exit:
    	bridge->nr_slots--;
    	bridge->slots = slot->next;
    	kfree(slot);
    	kfree(newfunc);
    
    	return AE_OK;
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    }
    
    
    /* see if it's worth looking at this bridge */
    
    static int detect_ejectable_slots(acpi_handle handle)
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    {
    
    	int found = acpi_pci_detect_ejectable(handle);
    
    		acpi_walk_namespace(ACPI_TYPE_DEVICE, handle, (u32)1,
    
    				    is_pci_dock_device, NULL, (void *)&found, NULL);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    }
    
    /* initialize miscellaneous stuff for both root and PCI-to-PCI bridge */
    static void init_bridge_misc(struct acpiphp_bridge *bridge)
    {
    	acpi_status status;
    
    
    	/* must be added to the list prior to calling register_slot */
    	list_add(&bridge->list, &bridge_list);
    
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	/* register all slot objects under this bridge */
    	status = acpi_walk_namespace(ACPI_TYPE_DEVICE, bridge->handle, (u32)1,
    
    				     register_slot, NULL, bridge, NULL);
    
    	if (ACPI_FAILURE(status)) {
    		list_del(&bridge->list);
    		return;
    	}
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    	/* install notify handler */
    
    	if (bridge->type != BRIDGE_TYPE_HOST) {
    
    		if ((bridge->flags & BRIDGE_HAS_EJ0) && bridge->func) {
    			status = acpi_remove_notify_handler(bridge->func->handle,
    						ACPI_SYSTEM_NOTIFY,
    						handle_hotplug_event_func);
    			if (ACPI_FAILURE(status))
    				err("failed to remove notify handler\n");
    		}
    
    		status = acpi_install_notify_handler(bridge->handle,
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    					     ACPI_SYSTEM_NOTIFY,
    					     handle_hotplug_event_bridge,
    					     bridge);
    
    
    		if (ACPI_FAILURE(status)) {
    			err("failed to register interrupt notify handler\n");
    		}
    
    /* find acpiphp_func from acpiphp_bridge */
    static struct acpiphp_func *acpiphp_bridge_handle_to_function(acpi_handle handle)
    {
    	struct acpiphp_bridge *bridge;
    	struct acpiphp_slot *slot;
    	struct acpiphp_func *func;
    
    
    	list_for_each_entry(bridge, &bridge_list, list) {
    
    		for (slot = bridge->slots; slot; slot = slot->next) {
    
    			list_for_each_entry(func, &slot->funcs, sibling) {
    
    				if (func->handle == handle)
    					return func;
    			}
    		}
    	}
    
    	return NULL;
    }
    
    
    static inline void config_p2p_bridge_flags(struct acpiphp_bridge *bridge)
    {
    	acpi_handle dummy_handle;
    
    	if (ACPI_SUCCESS(acpi_get_handle(bridge->handle,
    					"_STA", &dummy_handle)))
    		bridge->flags |= BRIDGE_HAS_STA;
    
    	if (ACPI_SUCCESS(acpi_get_handle(bridge->handle,
    					"_EJ0", &dummy_handle)))
    		bridge->flags |= BRIDGE_HAS_EJ0;
    
    	if (ACPI_SUCCESS(acpi_get_handle(bridge->handle,
    					"_PS0", &dummy_handle)))
    		bridge->flags |= BRIDGE_HAS_PS0;
    
    	if (ACPI_SUCCESS(acpi_get_handle(bridge->handle,
    					"_PS3", &dummy_handle)))
    		bridge->flags |= BRIDGE_HAS_PS3;
    
    	/* is this ejectable p2p bridge? */
    	if (bridge->flags & BRIDGE_HAS_EJ0) {
    		struct acpiphp_func *func;
    
    		dbg("found ejectable p2p bridge\n");
    
    		/* make link between PCI bridge and PCI function */
    		func = acpiphp_bridge_handle_to_function(bridge->handle);
    		if (!func)
    			return;
    		bridge->func = func;
    		func->bridge = bridge;
    	}
    }
    
    
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    /* allocate and initialize host bridge data structure */
    
    static void add_host_bridge(acpi_handle *handle)
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    {
    	struct acpiphp_bridge *bridge;
    
    	struct acpi_pci_root *root = acpi_pci_find_root(handle);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    
    	bridge = kzalloc(sizeof(struct acpiphp_bridge), GFP_KERNEL);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	if (bridge == NULL)
    		return;
    
    	bridge->type = BRIDGE_TYPE_HOST;
    	bridge->handle = handle;
    
    
    	bridge->pci_bus = root->bus;
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    	spin_lock_init(&bridge->res_lock);
    
    	init_bridge_misc(bridge);
    }
    
    
    /* allocate and initialize PCI-to-PCI bridge data structure */
    
    static void add_p2p_bridge(acpi_handle *handle)
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    {
    	struct acpiphp_bridge *bridge;
    
    
    	bridge = kzalloc(sizeof(struct acpiphp_bridge), GFP_KERNEL);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	if (bridge == NULL) {
    		err("out of memory\n");
    		return;
    	}
    
    	bridge->type = BRIDGE_TYPE_P2P;
    	bridge->handle = handle;
    
    	config_p2p_bridge_flags(bridge);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    
    	bridge->pci_dev = acpi_get_pci_dev(handle);
    	bridge->pci_bus = bridge->pci_dev->subordinate;
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	if (!bridge->pci_bus) {
    		err("This is not a PCI-to-PCI bridge!\n");
    
    	/*
    	 * Grab a ref to the subordinate PCI bus in case the bus is
    	 * removed via PCI core logical hotplug. The ref pins the bus
    	 * (which we access during module unload).
    	 */
    	get_device(&bridge->pci_bus->dev);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	spin_lock_init(&bridge->res_lock);
    
    	init_bridge_misc(bridge);
    
    	pci_dev_put(bridge->pci_dev);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    }
    
    
    /* callback routine to find P2P bridges */
    static acpi_status
    find_p2p_bridge(acpi_handle handle, u32 lvl, void *context, void **rv)
    {
    	acpi_status status;
    	struct pci_dev *dev;
    
    
    	dev = acpi_get_pci_dev(handle);
    
    	if (!dev || !dev->subordinate)
    		goto out;
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    	/* check if this bridge has ejectable slots */
    
    	if ((detect_ejectable_slots(handle) > 0)) {
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    		dbg("found PCI-to-PCI bridge at PCI %s\n", pci_name(dev));
    
    		add_p2p_bridge(handle);
    
    	/* search P2P bridges under this p2p bridge */
    	status = acpi_walk_namespace(ACPI_TYPE_DEVICE, handle, (u32)1,
    
    				     find_p2p_bridge, NULL, NULL, NULL);
    
    	if (ACPI_FAILURE(status))
    
    		warn("find_p2p_bridge failed (error code = 0x%x)\n", status);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	return AE_OK;
    }
    
    
    /* find hot-pluggable slots, and then find P2P bridge */
    static int add_bridge(acpi_handle handle)
    {
    	acpi_status status;
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	acpi_handle dummy_handle;
    
    	/* if the bridge doesn't have _STA, we assume it is always there */
    	status = acpi_get_handle(handle, "_STA", &dummy_handle);
    	if (ACPI_SUCCESS(status)) {
    		status = acpi_evaluate_integer(handle, "_STA", NULL, &tmp);
    		if (ACPI_FAILURE(status)) {
    
    			dbg("%s: _STA evaluation failure\n", __func__);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    			return 0;
    		}
    		if ((tmp & ACPI_STA_FUNCTIONING) == 0)
    			/* don't register this object */
    			return 0;
    	}
    
    	/* check if this bridge has ejectable slots */
    
    	if (detect_ejectable_slots(handle) > 0) {
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    		dbg("found PCI host-bus bridge with hot-pluggable slots\n");
    
    		add_host_bridge(handle);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	}
    
    	/* search P2P bridges under this host bridge */
    	status = acpi_walk_namespace(ACPI_TYPE_DEVICE, handle, (u32)1,
    
    				     find_p2p_bridge, NULL, NULL, NULL);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    	if (ACPI_FAILURE(status))
    
    		warn("find_p2p_bridge failed (error code = 0x%x)\n", status);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    	return 0;
    }
    
    
    static struct acpiphp_bridge *acpiphp_handle_to_bridge(acpi_handle handle)
    {
    
    	struct acpiphp_bridge *bridge;
    
    	list_for_each_entry(bridge, &bridge_list, list)
    
    		if (bridge->handle == handle)
    			return bridge;
    
    	return NULL;
    }
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    
    static void cleanup_bridge(struct acpiphp_bridge *bridge)
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    {
    
    	struct acpiphp_slot *slot, *next;
    	struct acpiphp_func *func, *tmp;
    
    	acpi_handle handle = bridge->handle;
    
    
    	status = acpi_remove_notify_handler(handle, ACPI_SYSTEM_NOTIFY,
    					    handle_hotplug_event_bridge);
    	if (ACPI_FAILURE(status))
    		err("failed to remove notify handler\n");
    
    
    	if ((bridge->type != BRIDGE_TYPE_HOST) &&
    	    ((bridge->flags & BRIDGE_HAS_EJ0) && bridge->func)) {
    		status = acpi_install_notify_handler(bridge->func->handle,
    						ACPI_SYSTEM_NOTIFY,
    						handle_hotplug_event_func,
    						bridge->func);
    		if (ACPI_FAILURE(status))
    			err("failed to install interrupt notify handler\n");
    	}
    
    
    	slot = bridge->slots;
    	while (slot) {
    
    		next = slot->next;
    		list_for_each_entry_safe(func, tmp, &slot->funcs, sibling) {
    
    			if (is_dock_device(func->handle)) {
    				unregister_hotplug_dock_device(func->handle);
    				unregister_dock_notifier(&func->nb);
    			}
    
    			if (!(func->flags & FUNC_HAS_DCK)) {
    				status = acpi_remove_notify_handler(func->handle,
    
    						ACPI_SYSTEM_NOTIFY,
    						handle_hotplug_event_func);
    
    				if (ACPI_FAILURE(status))
    					err("failed to remove notify handler\n");
    			}
    
    			list_del(&func->sibling);
    
    		acpiphp_unregister_hotplug_slot(slot);
    		list_del(&slot->funcs);
    
    	/*
    	 * Only P2P bridges have a pci_dev
    	 */
    	if (bridge->pci_dev)
    		put_device(&bridge->pci_bus->dev);
    
    
    	pci_dev_put(bridge->pci_dev);
    	list_del(&bridge->list);
    	kfree(bridge);
    
    static acpi_status
    cleanup_p2p_bridge(acpi_handle handle, u32 lvl, void *context, void **rv)
    {
    	struct acpiphp_bridge *bridge;
    
    
    	/* cleanup p2p bridges under this P2P bridge
    	   in a depth-first manner */
    	acpi_walk_namespace(ACPI_TYPE_DEVICE, handle, (u32)1,
    
    				cleanup_p2p_bridge, NULL, NULL, NULL);
    
    	bridge = acpiphp_handle_to_bridge(handle);
    	if (bridge)
    		cleanup_bridge(bridge);
    
    
    	return AE_OK;
    }
    
    static void remove_bridge(acpi_handle handle)
    {
    	struct acpiphp_bridge *bridge;
    
    
    	/* cleanup p2p bridges under this host bridge
    	   in a depth-first manner */
    	acpi_walk_namespace(ACPI_TYPE_DEVICE, handle,
    
    				(u32)1, cleanup_p2p_bridge, NULL, NULL, NULL);
    
    	/*
    	 * On root bridges with hotplug slots directly underneath (ie,
    
    Lucas De Marchi's avatar
    Lucas De Marchi committed
    	 * no p2p bridge between), we call cleanup_bridge(). 
    
    	 *
    	 * The else clause cleans up root bridges that either had no
    	 * hotplug slots at all, or had a p2p bridge underneath.
    	 */
    
    	bridge = acpiphp_handle_to_bridge(handle);
    
    	else
    		acpi_remove_notify_handler(handle, ACPI_SYSTEM_NOTIFY,
    					   handle_hotplug_event_bridge);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    static int power_on_slot(struct acpiphp_slot *slot)
    {
    	acpi_status status;
    	struct acpiphp_func *func;
    	int retval = 0;
    
    	/* if already enabled, just skip */
    	if (slot->flags & SLOT_POWEREDON)
    		goto err_exit;
    
    
    	list_for_each_entry(func, &slot->funcs, sibling) {
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    		if (func->flags & FUNC_HAS_PS0) {
    
    			dbg("%s: executing _PS0\n", __func__);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    			status = acpi_evaluate_object(func->handle, "_PS0", NULL, NULL);
    			if (ACPI_FAILURE(status)) {
    
    				warn("%s: _PS0 failed\n", __func__);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    				retval = -1;
    				goto err_exit;
    			} else
    				break;
    		}
    	}
    
    	/* TBD: evaluate _STA to check if the slot is enabled */
    
    	slot->flags |= SLOT_POWEREDON;
    
     err_exit:
    	return retval;
    }
    
    
    static int power_off_slot(struct acpiphp_slot *slot)
    {
    	acpi_status status;
    	struct acpiphp_func *func;
    
    	int retval = 0;
    
    	/* if already disabled, just skip */
    	if ((slot->flags & SLOT_POWEREDON) == 0)
    		goto err_exit;
    
    
    	list_for_each_entry(func, &slot->funcs, sibling) {
    
    		if (func->flags & FUNC_HAS_PS3) {
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    			status = acpi_evaluate_object(func->handle, "_PS3", NULL, NULL);
    			if (ACPI_FAILURE(status)) {
    
    				warn("%s: _PS3 failed\n", __func__);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    				retval = -1;
    				goto err_exit;
    			} else
    				break;
    		}
    	}
    
    	/* TBD: evaluate _STA to check if the slot is disabled */
    
    	slot->flags &= (~SLOT_POWEREDON);
    
     err_exit:
    	return retval;
    }
    
    
    
     * acpiphp_max_busnr - return the highest reserved bus number under the given bus.
    
     * @bus: bus to start search with
     */
    static unsigned char acpiphp_max_busnr(struct pci_bus *bus)
    {
    	struct list_head *tmp;
    	unsigned char max, n;
    
    	/*
    	 * pci_bus_max_busnr will return the highest
    	 * reserved busnr for all these children.
    	 * that is equivalent to the bus->subordinate
    	 * value.  We don't want to use the parent's
    	 * bus->subordinate value because it could have
    	 * padding in it.
    	 */
    	max = bus->secondary;
    
    	list_for_each(tmp, &bus->children) {
    		n = pci_bus_max_busnr(pci_bus_b(tmp));
    		if (n > max)
    			max = n;
    	}
    	return max;
    }
    
    
    /**
     * acpiphp_bus_add - add a new bus to acpi subsystem
     * @func: acpiphp_func of the bridge
     */
    static int acpiphp_bus_add(struct acpiphp_func *func)
    {
    	acpi_handle phandle;
    	struct acpi_device *device, *pdevice;
    	int ret_val;
    
    	acpi_get_parent(func->handle, &phandle);
    	if (acpi_bus_get_device(phandle, &pdevice)) {
    		dbg("no parent device, assuming NULL\n");
    		pdevice = NULL;
    	}
    
    	if (!acpi_bus_get_device(func->handle, &device)) {
    		dbg("bus exists... trim\n");
    		/* this shouldn't be in here, so remove
    		 * the bus then re-add it...
    		 */
    		ret_val = acpi_bus_trim(device, 1);
    		dbg("acpi_bus_trim return %x\n", ret_val);
    	}
    
    	ret_val = acpi_bus_add(&device, pdevice, func->handle,
    		ACPI_BUS_TYPE_DEVICE);
    	if (ret_val) {
    		dbg("error adding bus, %x\n",
    			-ret_val);
    		goto acpiphp_bus_add_out;
    
    	}
    	ret_val = acpi_bus_start(device);
    
    acpiphp_bus_add_out:
    	return ret_val;
    }
    
    
    
    /**
     * acpiphp_bus_trim - trim a bus from acpi subsystem
     * @handle: handle to acpi namespace
     */
    
    static int acpiphp_bus_trim(acpi_handle handle)
    
    {
    	struct acpi_device *device;
    	int retval;
    
    	retval = acpi_bus_get_device(handle, &device);
    	if (retval) {
    		dbg("acpi_device not found\n");
    		return retval;
    	}
    
    	retval = acpi_bus_trim(device, 1);
    	if (retval)
    		err("cannot remove from acpi list\n");
    
    	return retval;
    }
    
    static void acpiphp_set_acpi_region(struct acpiphp_slot *slot)
    {
    	struct acpiphp_func *func;
    	union acpi_object params[2];
    	struct acpi_object_list arg_list;
    
    	list_for_each_entry(func, &slot->funcs, sibling) {
    		arg_list.count = 2;
    		arg_list.pointer = params;
    		params[0].type = ACPI_TYPE_INTEGER;
    		params[0].integer.value = ACPI_ADR_SPACE_PCI_CONFIG;
    		params[1].type = ACPI_TYPE_INTEGER;
    		params[1].integer.value = 1;
    		/* _REG is optional, we don't care about if there is failure */
    		acpi_evaluate_object(func->handle, "_REG", &arg_list, NULL);
    	}
    }
    
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    /**
     * enable_device - enable, configure a slot
     * @slot: slot to be enabled
     *
     * This function should be called per *physical slot*,
     * not per each slot object in ACPI namespace.
     */
    
    static int __ref enable_device(struct acpiphp_slot *slot)
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    {
    	struct pci_dev *dev;
    
    	struct pci_bus *bus = slot->bridge->pci_bus;
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	struct acpiphp_func *func;
    	int retval = 0;
    
    	acpi_status status;
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    	if (slot->flags & SLOT_ENABLED)
    		goto err_exit;
    
    
    	num = pci_scan_slot(bus, PCI_DEVFN(slot->device, 0));
    	if (num == 0) {
    
    		/* Maybe only part of funcs are added. */
    		dbg("No new device found\n");
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    		goto err_exit;
    	}
    
    
    	max = acpiphp_max_busnr(bus);
    
    	for (pass = 0; pass < 2; pass++) {
    		list_for_each_entry(dev, &bus->devices, bus_list) {
    			if (PCI_SLOT(dev->devfn) != slot->device)
    				continue;
    			if (dev->hdr_type == PCI_HEADER_TYPE_BRIDGE ||
    
    			    dev->hdr_type == PCI_HEADER_TYPE_CARDBUS) {
    
    				max = pci_scan_bridge(bus, dev, max, pass);
    
    				if (pass && dev->subordinate)
    
    					pci_bus_size_bridges(dev->subordinate);
    			}
    
    	list_for_each_entry(func, &slot->funcs, sibling)
    
    		acpiphp_bus_add(func);
    
    
    	pci_bus_assign_resources(bus);
    
    	acpiphp_set_acpi_region(slot);
    
    
    	list_for_each_entry(dev, &bus->devices, bus_list) {
    		/* Assume that newly added devices are powered on already. */
    		if (!dev->is_added)
    			dev->current_state = PCI_D0;
    	}
    
    
    	slot->flags |= SLOT_ENABLED;
    
    	list_for_each_entry(func, &slot->funcs, sibling) {
    
    		dev = pci_get_slot(bus, PCI_DEVFN(slot->device,
    						  func->function));
    
    		if (!dev) {
    			/* Do not set SLOT_ENABLED flag if some funcs
    			   are not added. */
    			slot->flags &= (~SLOT_ENABLED);
    
    		if (dev->hdr_type != PCI_HEADER_TYPE_BRIDGE &&
    		    dev->hdr_type != PCI_HEADER_TYPE_CARDBUS) {
    			pci_dev_put(dev);
    
    
    		status = find_p2p_bridge(func->handle, (u32)1, bus, NULL);
    		if (ACPI_FAILURE(status))
    			warn("find_p2p_bridge failed (error code = 0x%x)\n",
    				status);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	}
    
    
     err_exit:
    	return retval;
    }
    
    
    static void disable_bridges(struct pci_bus *bus)
    {
    	struct pci_dev *dev;
    	list_for_each_entry(dev, &bus->devices, bus_list) {
    		if (dev->subordinate) {
    			disable_bridges(dev->subordinate);
    			pci_disable_device(dev);
    		}
    	}
    }
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    /**
     * disable_device - disable a slot
    
     * @slot: ACPI PHP slot
    
    Linus Torvalds's avatar
    Linus Torvalds committed
     */
    static int disable_device(struct acpiphp_slot *slot)
    {
    	struct acpiphp_func *func;
    
    	struct pci_bus *bus = slot->bridge->pci_bus;
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    
    	/* The slot will be enabled when func 0 is added, so check
    	   func 0 before disable the slot. */
    	pdev = pci_get_slot(bus, PCI_DEVFN(slot->device, 0));
    	if (!pdev)
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    		goto err_exit;
    
    
    	list_for_each_entry(func, &slot->funcs, sibling) {
    
    		if (func->bridge) {
    			/* cleanup p2p bridges under this P2P bridge */
    			cleanup_p2p_bridge(func->bridge->handle,
    						(u32)1, NULL, NULL);
    			func->bridge = NULL;
    		}
    
    
    		pdev = pci_get_slot(slot->bridge->pci_bus,
    				    PCI_DEVFN(slot->device, func->function));
    		if (pdev) {
    			pci_stop_bus_device(pdev);
    			if (pdev->subordinate) {
    				disable_bridges(pdev->subordinate);
    				pci_disable_device(pdev);
    
    			pci_remove_bus_device(pdev);
    			pci_dev_put(pdev);
    
    	list_for_each_entry(func, &slot->funcs, sibling) {
    
    		acpiphp_bus_trim(func->handle);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	}
    
    	slot->flags &= (~SLOT_ENABLED);
    
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    }
    
    
    /**
     * get_slot_status - get ACPI slot status
    
     * @slot: ACPI PHP slot
    
    Linus Torvalds's avatar
    Linus Torvalds committed
     *
    
     * If a slot has _STA for each function and if any one of them
     * returned non-zero status, return it.
    
    Linus Torvalds's avatar
    Linus Torvalds committed
     *
    
     * If a slot doesn't have _STA and if any one of its functions'
     * configuration space is configured, return 0x0f as a _STA.
    
    Linus Torvalds's avatar
    Linus Torvalds committed
     *
    
     * Otherwise return 0.
    
    Linus Torvalds's avatar
    Linus Torvalds committed
     */
    static unsigned int get_slot_status(struct acpiphp_slot *slot)
    {
    	acpi_status status;
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	u32 dvid;
    	struct acpiphp_func *func;
    
    
    	list_for_each_entry(func, &slot->funcs, sibling) {
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    		if (func->flags & FUNC_HAS_STA) {
    			status = acpi_evaluate_integer(func->handle, "_STA", NULL, &sta);
    			if (ACPI_SUCCESS(status) && sta)
    				break;
    		} else {
    			pci_bus_read_config_dword(slot->bridge->pci_bus,
    						  PCI_DEVFN(slot->device,
    							    func->function),
    						  PCI_VENDOR_ID, &dvid);
    			if (dvid != 0xffffffff) {
    				sta = ACPI_STA_ALL;
    				break;
    			}
    		}
    	}
    
    	return (unsigned int)sta;
    }
    
    
    /**
     * acpiphp_eject_slot - physically eject the slot
    
     * @slot: ACPI PHP slot
    
    int acpiphp_eject_slot(struct acpiphp_slot *slot)
    
    {
    	acpi_status status;
    	struct acpiphp_func *func;
    	struct acpi_object_list arg_list;
    	union acpi_object arg;
    
    
    	list_for_each_entry(func, &slot->funcs, sibling) {
    
    		/* We don't want to call _EJ0 on non-existing functions. */
    		if ((func->flags & FUNC_HAS_EJ0)) {
    			/* _EJ0 method take one argument */
    			arg_list.count = 1;
    			arg_list.pointer = &arg;
    			arg.type = ACPI_TYPE_INTEGER;
    			arg.integer.value = 1;
    
    			status = acpi_evaluate_object(func->handle, "_EJ0", &arg_list, NULL);
    			if (ACPI_FAILURE(status)) {
    
    				warn("%s: _EJ0 failed\n", __func__);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    /**
     * acpiphp_check_bridge - re-enumerate devices