Skip to content
Snippets Groups Projects
acpiphp_glue.c 31.7 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);
    
    static DEFINE_MUTEX(bridge_mutex);
    
    static DEFINE_MUTEX(acpiphp_context_lock);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    #define MY_NAME "acpiphp_glue"
    
    
    static void handle_hotplug_event(acpi_handle handle, u32 type, void *data);
    
    static void acpiphp_sanitize_bus(struct pci_bus *bus);
    
    static void acpiphp_set_hpp_values(struct pci_bus *bus);
    
    static void hotplug_event(acpi_handle handle, u32 type, void *data);
    
    static void free_bridge(struct kref *kref);
    
    /* 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;
    	}
    }
    
    
    static void acpiphp_context_handler(acpi_handle handle, void *context)
    {
    	/* Intentionally empty. */
    }
    
    /**
     * acpiphp_init_context - Create hotplug context and grab a reference to it.
     * @handle: ACPI object handle to create the context for.
     *
     * Call under acpiphp_context_lock.
     */
    static struct acpiphp_context *acpiphp_init_context(acpi_handle handle)
    {
    	struct acpiphp_context *context;
    	acpi_status status;
    
    	context = kzalloc(sizeof(*context), GFP_KERNEL);
    	if (!context)
    		return NULL;
    
    	context->handle = handle;
    	context->refcount = 1;
    	status = acpi_attach_data(handle, acpiphp_context_handler, context);
    	if (ACPI_FAILURE(status)) {
    		kfree(context);
    		return NULL;
    	}
    	return context;
    }
    
    /**
     * acpiphp_get_context - Get hotplug context and grab a reference to it.
     * @handle: ACPI object handle to get the context for.
     *
     * Call under acpiphp_context_lock.
     */
    static struct acpiphp_context *acpiphp_get_context(acpi_handle handle)
    {
    	struct acpiphp_context *context = NULL;
    	acpi_status status;
    	void *data;
    
    	status = acpi_get_data(handle, acpiphp_context_handler, &data);
    	if (ACPI_SUCCESS(status)) {
    		context = data;
    		context->refcount++;
    	}
    	return context;
    }
    
    /**
     * acpiphp_put_context - Drop a reference to ACPI hotplug context.
     * @handle: ACPI object handle to put the context for.
     *
     * The context object is removed if there are no more references to it.
     *
     * Call under acpiphp_context_lock.
     */
    static void acpiphp_put_context(struct acpiphp_context *context)
    {
    	if (--context->refcount)
    		return;
    
    	WARN_ON(context->func || context->bridge);
    	acpi_detach_data(context->handle, acpiphp_context_handler);
    	kfree(context);
    }
    
    
    static inline void get_bridge(struct acpiphp_bridge *bridge)
    {
    	kref_get(&bridge->ref);
    }
    
    static inline void put_bridge(struct acpiphp_bridge *bridge)
    {
    	kref_put(&bridge->ref, free_bridge);
    }
    
    static void free_bridge(struct kref *kref)
    {
    
    	struct acpiphp_bridge *bridge;
    	struct acpiphp_slot *slot, *next;
    	struct acpiphp_func *func, *tmp;
    
    
    	bridge = container_of(kref, struct acpiphp_bridge, ref);
    
    	list_for_each_entry_safe(slot, next, &bridge->slots, node) {
    		list_for_each_entry_safe(func, tmp, &slot->funcs, sibling) {
    
    			context = func->context;
    			context->func = NULL;
    			acpiphp_put_context(context);
    
    	/* Release the reference acquired by acpiphp_enumerate_slots(). */
    
    		put_bridge(context->func->slot->bridge);
    
    	put_device(&bridge->pci_bus->dev);
    	pci_dev_put(bridge->pci_dev);
    
    	context->bridge = NULL;
    	acpiphp_put_context(context);
    
    /*
     * 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 void post_dock_fixups(acpi_handle not_used, u32 event, void *data)
    
    	struct acpiphp_context *context = data;
    	struct pci_bus *bus = context->func->slot->bridge->pci_bus;
    
    	u32 buses;
    
    	if (!bus->self)
    
    
    	/* 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->busn_res.start) {
    
    		buses = (buses & 0xff000000)
    
    			| ((unsigned int)(bus->primary)     <<  0)
    
    			| ((unsigned int)(bus->busn_res.start)   <<  8)
    			| ((unsigned int)(bus->busn_res.end) << 16);
    
    		pci_write_config_dword(bus->self, PCI_PRIMARY_BUS, buses);
    	}
    }
    
    
    
    static const struct acpi_dock_ops acpiphp_dock_ops = {
    
    	.fixup = post_dock_fixups,
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    
    /* Check whether the PCI device is managed by native PCIe hotplug driver */
    static bool device_is_managed_by_native_pciehp(struct pci_dev *pdev)
    {
    	u32 reg32;
    	acpi_handle tmp;
    	struct acpi_pci_root *root;
    
    	/* Check whether the PCIe port supports native PCIe hotplug */
    	if (pcie_capability_read_dword(pdev, PCI_EXP_SLTCAP, &reg32))
    		return false;
    	if (!(reg32 & PCI_EXP_SLTCAP_HPC))
    		return false;
    
    	/*
    	 * Check whether native PCIe hotplug has been enabled for
    	 * this PCIe hierarchy.
    	 */
    	tmp = acpi_find_root_bridge_handle(pdev);
    	if (!tmp)
    		return false;
    	root = acpi_pci_find_root(tmp);
    	if (!root)
    		return false;
    	if (!(root->osc_control_set & OSC_PCI_EXPRESS_NATIVE_HP_CONTROL))
    		return false;
    
    	return true;
    }
    
    
    static void acpiphp_dock_init(void *data)
    {
    
    	struct acpiphp_context *context = data;
    
    	get_bridge(context->func->slot->bridge);
    
    	struct acpiphp_context *context = data;
    
    	put_bridge(context->func->slot->bridge);
    
    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 *data,
    				 void **rv)
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    {
    
    	struct acpiphp_bridge *bridge = data;
    	struct acpiphp_context *context;
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	struct acpiphp_slot *slot;
    	struct acpiphp_func *newfunc;
    	acpi_status status = AE_OK;
    
    	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;
    
    
    	status = acpi_evaluate_integer(handle, "_ADR", NULL, &adr);
    	if (ACPI_FAILURE(status)) {
    		warn("can't evaluate _ADR (%#x)\n", status);
    		return AE_OK;
    	}
    
    	device = (adr >> 16) & 0xffff;
    	function = adr & 0xffff;
    
    
    	if (pdev && device_is_managed_by_native_pciehp(pdev))
    		return AE_OK;
    
    	newfunc = kzalloc(sizeof(struct acpiphp_func), GFP_KERNEL);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	if (!newfunc)
    		return AE_NO_MEMORY;
    
    	newfunc->handle = handle;
    	newfunc->function = function;
    
    	mutex_lock(&acpiphp_context_lock);
    	context = acpiphp_init_context(handle);
    	if (!context) {
    		mutex_unlock(&acpiphp_context_lock);
    		acpi_handle_err(handle, "No hotplug context\n");
    		kfree(newfunc);
    		return AE_NOT_EXIST;
    	}
    	newfunc->context = context;
    	context->func = newfunc;
    	mutex_unlock(&acpiphp_context_lock);
    
    
    	if (acpi_has_method(handle, "_EJ0"))
    
    		newfunc->flags = FUNC_HAS_EJ0;
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    
    	if (acpi_has_method(handle, "_STA"))
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    		newfunc->flags |= FUNC_HAS_STA;
    
    
    	if (acpi_has_method(handle, "_PS0"))
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    		newfunc->flags |= FUNC_HAS_PS0;
    
    
    	if (acpi_has_method(handle, "_PS3"))
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    		newfunc->flags |= FUNC_HAS_PS3;
    
    
    	if (acpi_has_method(handle, "_DCK"))
    
    		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 */
    
    	list_for_each_entry(slot, &bridge->slots, node)
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    		if (slot->device == device) {
    			if (slot->sun != sun)
    				warn("sibling found, but _SUN doesn't match!\n");
    
    
    	slot = kzalloc(sizeof(struct acpiphp_slot), GFP_KERNEL);
    	if (!slot) {
    		status = AE_NO_MEMORY;
    		goto err;
    	}
    
    	slot->bridge = bridge;
    	slot->device = device;
    	slot->sun = sun;
    	INIT_LIST_HEAD(&slot->funcs);
    	mutex_init(&slot->crit_sect);
    
    	mutex_lock(&bridge_mutex);
    	list_add_tail(&slot->node, &bridge->slots);
    	mutex_unlock(&bridge_mutex);
    	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);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    
    	retval = acpiphp_register_hotplug_slot(slot);
    	if (retval) {
    		if (retval == -EBUSY)
    			warn("Slot %llu already registered by another "
    				"hotplug driver\n", slot->sun);
    		else
    			warn("acpiphp_register_hotplug_slot failed "
    				"(err code = 0x%x)\n", retval);
    
    		bridge->nr_slots--;
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	newfunc->slot = slot;
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	list_add_tail(&newfunc->sibling, &slot->funcs);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    
    	if (pci_bus_read_dev_vendor_id(pbus, PCI_DEVFN(device, function),
    				       &val, 60*1000))
    
    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_init, acpiphp_dock_release))
    
    			dbg("failed to register dock device\n");
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	/* install notify handler */
    
    	if (!(newfunc->flags & FUNC_HAS_DCK)) {
    
    		status = acpi_install_notify_handler(handle, ACPI_SYSTEM_NOTIFY,
    						     handle_hotplug_event,
    						     context);
    		if (ACPI_SUCCESS(status))
    			context->handler_for_func = true;
    		else
    
    			err("failed to register interrupt notify handler\n");
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    
     err:
    	mutex_lock(&acpiphp_context_lock);
    	context->func = NULL;
    	acpiphp_put_context(context);
    	mutex_unlock(&acpiphp_context_lock);
    	kfree(newfunc);
    	return status;
    
    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);
    
    static struct acpiphp_bridge *acpiphp_handle_to_bridge(acpi_handle handle)
    {
    
    	struct acpiphp_context *context;
    	struct acpiphp_bridge *bridge = NULL;
    
    	mutex_lock(&acpiphp_context_lock);
    	context = acpiphp_get_context(handle);
    	if (context) {
    		bridge = context->bridge;
    		if (bridge)
    
    		acpiphp_put_context(context);
    	}
    	mutex_unlock(&acpiphp_context_lock);
    	return bridge;
    
    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;
    	struct acpiphp_func *func;
    
    	acpi_handle handle = bridge->handle;
    
    	if (!bridge->context->handler_for_func) {
    		status = acpi_remove_notify_handler(handle, ACPI_SYSTEM_NOTIFY,
    						    handle_hotplug_event);
    
    		if (ACPI_FAILURE(status))
    			err("failed to remove notify handler\n");
    	}
    
    	list_for_each_entry(slot, &bridge->slots, node) {
    		list_for_each_entry(func, &slot->funcs, sibling) {
    
    			if (is_dock_device(func->handle)) {
    				unregister_hotplug_dock_device(func->handle);
    			}
    
    			if (!(func->flags & FUNC_HAS_DCK)) {
    
    				func->context->handler_for_func = false;
    
    				status = acpi_remove_notify_handler(func->handle,
    
    							ACPI_SYSTEM_NOTIFY,
    							handle_hotplug_event);
    
    				if (ACPI_FAILURE(status))
    					err("failed to remove notify handler\n");
    			}
    
    		acpiphp_unregister_hotplug_slot(slot);
    
    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.
    	 */
    
    
    	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)
    {
    
    	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_scan(func->handle);
    
    	if (!ret_val)
    		ret_val = acpi_bus_get_device(func->handle, &device);
    
    	if (ret_val)
    		dbg("error adding bus, %x\n", -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;
    	}
    
    
    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);
    	}
    }
    
    
    static void check_hotplug_bridge(struct acpiphp_slot *slot, struct pci_dev *dev)
    {
    	struct acpiphp_func *func;
    
    	if (!dev->subordinate)
    		return;
    
    	/* quirk, or pcie could set it already */
    	if (dev->is_hotplug_bridge)
    		return;
    
    	if (PCI_SLOT(dev->devfn) != slot->device)
    		return;
    
    	list_for_each_entry(func, &slot->funcs, sibling) {
    		if (PCI_FUNC(dev->devfn) == func->function) {
    			/* check if this bridge has ejectable slots */
    			if ((detect_ejectable_slots(func->handle) > 0))
    				dev->is_hotplug_bridge = 1;
    			break;
    		}
    	}
    }
    
    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;
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
    	if (slot->flags & SLOT_ENABLED)
    		goto err_exit;
    
    
    	list_for_each_entry(func, &slot->funcs, sibling)
    		acpiphp_bus_add(func);
    
    
    	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) {
    					check_hotplug_bridge(slot, dev);
    
    					pcibios_resource_survey_bus(dev->subordinate);
    					__pci_bus_size_bridges(dev->subordinate,
    							       &add_list);
    
    	__pci_bus_assign_resources(bus, &add_list, NULL);
    
    	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);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	}
    
    
     err_exit:
    
    /* return first device in slot, acquiring a reference on it */
    static struct pci_dev *dev_in_slot(struct acpiphp_slot *slot)
    {
    	struct pci_bus *bus = slot->bridge->pci_bus;
    	struct pci_dev *dev;
    	struct pci_dev *ret = NULL;
    
    	down_read(&pci_bus_sem);
    	list_for_each_entry(dev, &bus->devices, bus_list)
    		if (PCI_SLOT(dev->devfn) == slot->device) {
    			ret = pci_dev_get(dev);
    			break;
    		}
    	up_read(&pci_bus_sem);
    
    	return ret;
    }
    
    
    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;
    
    	/*
    	 * enable_device() enumerates all functions in this device via
    	 * pci_scan_slot(), whether they have associated ACPI hotplug
    	 * methods (_EJ0, etc.) or not.  Therefore, we remove all functions
    	 * here.
    	 */
    	while ((pdev = dev_in_slot(slot))) {
    
    		pci_stop_and_remove_bus_device(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)
    
    	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)) {
    
    			if (ACPI_FAILURE(acpi_evaluate_ej0(func->handle)))
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    /**
     * acpiphp_check_bridge - re-enumerate devices
    
     * @bridge: where to begin re-enumeration
    
    Linus Torvalds's avatar
    Linus Torvalds committed
     *
     * Iterate over all slots under this bridge and make sure that if a
     * card is present they are enabled, and if not they are disabled.
     */
    static int acpiphp_check_bridge(struct acpiphp_bridge *bridge)
    {
    	struct acpiphp_slot *slot;
    	int retval = 0;
    	int enabled, disabled;
    
    	enabled = disabled = 0;
    
    
    	list_for_each_entry(slot, &bridge->slots, node) {
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    		unsigned int status = get_slot_status(slot);
    		if (slot->flags & SLOT_ENABLED) {
    			if (status == ACPI_STA_ALL)
    				continue;
    			retval = acpiphp_disable_slot(slot);
    			if (retval) {
    				err("Error occurred in disabling\n");
    				goto err_exit;
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    			}
    			disabled++;
    		} else {
    			if (status != ACPI_STA_ALL)
    				continue;
    			retval = acpiphp_enable_slot(slot);
    			if (retval) {
    				err("Error occurred in enabling\n");
    				goto err_exit;
    			}
    			enabled++;
    		}
    	}
    
    
    	dbg("%s: %d enabled, %d disabled\n", __func__, enabled, disabled);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    
     err_exit:
    	return retval;
    }
    
    
    static void acpiphp_set_hpp_values(struct pci_bus *bus)
    
    	list_for_each_entry(dev, &bus->devices, bus_list)
    		pci_configure_slot(dev);
    
    }
    
    /*
     * Remove devices for which we could not assign resources, call
     * arch specific code to fix-up the bus
     */
    static void acpiphp_sanitize_bus(struct pci_bus *bus)
    {
    
    	int i;
    	unsigned long type_mask = IORESOURCE_IO | IORESOURCE_MEM;
    
    
    	list_for_each_entry_safe(dev, tmp, &bus->devices, bus_list) {
    
    		for (i=0; i<PCI_BRIDGE_RESOURCES; i++) {
    			struct resource *res = &dev->resource[i];
    			if ((res->flags & type_mask) && !res->start &&
    					res->end) {
    				/* Could not assign a required resources
    				 * for this device, remove it */
    
    				pci_stop_and_remove_bus_device(dev);
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    /*
     * ACPI event handlers
     */
    
    
    static acpi_status
    check_sub_bridges(acpi_handle handle, u32 lvl, void *context, void **rv)
    {
    	struct acpiphp_bridge *bridge;
    	char objname[64];
    	struct acpi_buffer buffer = { .length = sizeof(objname),
    				      .pointer = objname };
    
    	bridge = acpiphp_handle_to_bridge(handle);
    	if (bridge) {
    		acpi_get_name(handle, ACPI_FULL_PATHNAME, &buffer);
    		dbg("%s: re-enumerating slots under %s\n",
    
    			__func__, objname);
    
    void acpiphp_check_host_bridge(acpi_handle handle)
    {
    	struct acpiphp_bridge *bridge;
    
    	bridge = acpiphp_handle_to_bridge(handle);
    	if (bridge) {
    		acpiphp_check_bridge(bridge);
    		put_bridge(bridge);
    	}
    
    	acpi_walk_namespace(ACPI_TYPE_DEVICE, handle,
    		ACPI_UINT32_MAX, check_sub_bridges, NULL, NULL, NULL);
    }
    
    
    static void hotplug_event(acpi_handle handle, u32 type, void *data)
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    {
    
    	struct acpiphp_context *context = data;
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	struct acpiphp_bridge *bridge;
    
    Linus Torvalds's avatar
    Linus Torvalds committed
    	char objname[64];
    	struct acpi_buffer buffer = { .length = sizeof(objname),
    				      .pointer = objname };
    
    	mutex_lock(&acpiphp_context_lock);