| /* | 
 |  * 	PCI searching functions. | 
 |  * | 
 |  *	Copyright (C) 1993 -- 1997 Drew Eckhardt, Frederic Potter, | 
 |  *					David Mosberger-Tang | 
 |  *	Copyright (C) 1997 -- 2000 Martin Mares <mj@ucw.cz> | 
 |  *	Copyright (C) 2003 -- 2004 Greg Kroah-Hartman <greg@kroah.com> | 
 |  */ | 
 |  | 
 | #include <linux/init.h> | 
 | #include <linux/pci.h> | 
 | #include <linux/module.h> | 
 | #include <linux/interrupt.h> | 
 | #include "pci.h" | 
 |  | 
 | DECLARE_RWSEM(pci_bus_sem); | 
 | /* | 
 |  * find the upstream PCIE-to-PCI bridge of a PCI device | 
 |  * if the device is PCIE, return NULL | 
 |  * if the device isn't connected to a PCIE bridge (that is its parent is a | 
 |  * legacy PCI bridge and the bridge is directly connected to bus 0), return its | 
 |  * parent | 
 |  */ | 
 | struct pci_dev * | 
 | pci_find_upstream_pcie_bridge(struct pci_dev *pdev) | 
 | { | 
 | 	struct pci_dev *tmp = NULL; | 
 |  | 
 | 	if (pdev->is_pcie) | 
 | 		return NULL; | 
 | 	while (1) { | 
 | 		if (!pdev->bus->self) | 
 | 			break; | 
 | 		pdev = pdev->bus->self; | 
 | 		/* a p2p bridge */ | 
 | 		if (!pdev->is_pcie) { | 
 | 			tmp = pdev; | 
 | 			continue; | 
 | 		} | 
 | 		/* PCI device should connect to a PCIE bridge */ | 
 | 		if (pdev->pcie_type != PCI_EXP_TYPE_PCI_BRIDGE) { | 
 | 			/* Busted hardware? */ | 
 | 			WARN_ON_ONCE(1); | 
 | 			return NULL; | 
 | 		} | 
 | 		return pdev; | 
 | 	} | 
 |  | 
 | 	return tmp; | 
 | } | 
 |  | 
 | static struct pci_bus *pci_do_find_bus(struct pci_bus *bus, unsigned char busnr) | 
 | { | 
 | 	struct pci_bus* child; | 
 | 	struct list_head *tmp; | 
 |  | 
 | 	if(bus->number == busnr) | 
 | 		return bus; | 
 |  | 
 | 	list_for_each(tmp, &bus->children) { | 
 | 		child = pci_do_find_bus(pci_bus_b(tmp), busnr); | 
 | 		if(child) | 
 | 			return child; | 
 | 	} | 
 | 	return NULL; | 
 | } | 
 |  | 
 | /** | 
 |  * pci_find_bus - locate PCI bus from a given domain and bus number | 
 |  * @domain: number of PCI domain to search | 
 |  * @busnr: number of desired PCI bus | 
 |  * | 
 |  * Given a PCI bus number and domain number, the desired PCI bus is located | 
 |  * in the global list of PCI buses.  If the bus is found, a pointer to its | 
 |  * data structure is returned.  If no bus is found, %NULL is returned. | 
 |  */ | 
 | struct pci_bus * pci_find_bus(int domain, int busnr) | 
 | { | 
 | 	struct pci_bus *bus = NULL; | 
 | 	struct pci_bus *tmp_bus; | 
 |  | 
 | 	while ((bus = pci_find_next_bus(bus)) != NULL)  { | 
 | 		if (pci_domain_nr(bus) != domain) | 
 | 			continue; | 
 | 		tmp_bus = pci_do_find_bus(bus, busnr); | 
 | 		if (tmp_bus) | 
 | 			return tmp_bus; | 
 | 	} | 
 | 	return NULL; | 
 | } | 
 |  | 
 | /** | 
 |  * pci_find_next_bus - begin or continue searching for a PCI bus | 
 |  * @from: Previous PCI bus found, or %NULL for new search. | 
 |  * | 
 |  * Iterates through the list of known PCI busses.  A new search is | 
 |  * initiated by passing %NULL as the @from argument.  Otherwise if | 
 |  * @from is not %NULL, searches continue from next device on the | 
 |  * global list. | 
 |  */ | 
 | struct pci_bus *  | 
 | pci_find_next_bus(const struct pci_bus *from) | 
 | { | 
 | 	struct list_head *n; | 
 | 	struct pci_bus *b = NULL; | 
 |  | 
 | 	WARN_ON(in_interrupt()); | 
 | 	down_read(&pci_bus_sem); | 
 | 	n = from ? from->node.next : pci_root_buses.next; | 
 | 	if (n != &pci_root_buses) | 
 | 		b = pci_bus_b(n); | 
 | 	up_read(&pci_bus_sem); | 
 | 	return b; | 
 | } | 
 |  | 
 | #ifdef CONFIG_PCI_LEGACY | 
 |  | 
 | /** | 
 |  * pci_find_slot - locate PCI device from a given PCI slot | 
 |  * @bus: number of PCI bus on which desired PCI device resides | 
 |  * @devfn: encodes number of PCI slot in which the desired PCI  | 
 |  * device resides and the logical device number within that slot  | 
 |  * in case of multi-function devices. | 
 |  * | 
 |  * Given a PCI bus and slot/function number, the desired PCI device  | 
 |  * is located in system global list of PCI devices.  If the device | 
 |  * is found, a pointer to its data structure is returned.  If no  | 
 |  * device is found, %NULL is returned. | 
 |  */ | 
 | struct pci_dev * | 
 | pci_find_slot(unsigned int bus, unsigned int devfn) | 
 | { | 
 | 	struct pci_dev *dev = NULL; | 
 |  | 
 | 	while ((dev = pci_find_device(PCI_ANY_ID, PCI_ANY_ID, dev)) != NULL) { | 
 | 		if (dev->bus->number == bus && dev->devfn == devfn) | 
 | 			return dev; | 
 | 	} | 
 | 	return NULL; | 
 | } | 
 |  | 
 | #endif /* CONFIG_PCI_LEGACY */ | 
 |  | 
 | /** | 
 |  * pci_get_slot - locate PCI device for a given PCI slot | 
 |  * @bus: PCI bus on which desired PCI device resides | 
 |  * @devfn: encodes number of PCI slot in which the desired PCI  | 
 |  * device resides and the logical device number within that slot  | 
 |  * in case of multi-function devices. | 
 |  * | 
 |  * Given a PCI bus and slot/function number, the desired PCI device  | 
 |  * is located in the list of PCI devices. | 
 |  * If the device is found, its reference count is increased and this | 
 |  * function returns a pointer to its data structure.  The caller must | 
 |  * decrement the reference count by calling pci_dev_put(). | 
 |  * If no device is found, %NULL is returned. | 
 |  */ | 
 | struct pci_dev * pci_get_slot(struct pci_bus *bus, unsigned int devfn) | 
 | { | 
 | 	struct list_head *tmp; | 
 | 	struct pci_dev *dev; | 
 |  | 
 | 	WARN_ON(in_interrupt()); | 
 | 	down_read(&pci_bus_sem); | 
 |  | 
 | 	list_for_each(tmp, &bus->devices) { | 
 | 		dev = pci_dev_b(tmp); | 
 | 		if (dev->devfn == devfn) | 
 | 			goto out; | 
 | 	} | 
 |  | 
 | 	dev = NULL; | 
 |  out: | 
 | 	pci_dev_get(dev); | 
 | 	up_read(&pci_bus_sem); | 
 | 	return dev; | 
 | } | 
 |  | 
 | /** | 
 |  * pci_get_bus_and_slot - locate PCI device from a given PCI bus & slot | 
 |  * @bus: number of PCI bus on which desired PCI device resides | 
 |  * @devfn: encodes number of PCI slot in which the desired PCI | 
 |  * device resides and the logical device number within that slot | 
 |  * in case of multi-function devices. | 
 |  * | 
 |  * Note: the bus/slot search is limited to PCI domain (segment) 0. | 
 |  * | 
 |  * Given a PCI bus and slot/function number, the desired PCI device | 
 |  * is located in system global list of PCI devices.  If the device | 
 |  * is found, a pointer to its data structure is returned.  If no | 
 |  * device is found, %NULL is returned. The returned device has its | 
 |  * reference count bumped by one. | 
 |  */ | 
 |  | 
 | struct pci_dev * pci_get_bus_and_slot(unsigned int bus, unsigned int devfn) | 
 | { | 
 | 	struct pci_dev *dev = NULL; | 
 |  | 
 | 	while ((dev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, dev)) != NULL) { | 
 | 		if (pci_domain_nr(dev->bus) == 0 && | 
 | 		   (dev->bus->number == bus && dev->devfn == devfn)) | 
 | 			return dev; | 
 | 	} | 
 | 	return NULL; | 
 | } | 
 |  | 
 | #ifdef CONFIG_PCI_LEGACY | 
 | /** | 
 |  * pci_find_subsys - begin or continue searching for a PCI device by vendor/subvendor/device/subdevice id | 
 |  * @vendor: PCI vendor id to match, or %PCI_ANY_ID to match all vendor ids | 
 |  * @device: PCI device id to match, or %PCI_ANY_ID to match all device ids | 
 |  * @ss_vendor: PCI subsystem vendor id to match, or %PCI_ANY_ID to match all vendor ids | 
 |  * @ss_device: PCI subsystem device id to match, or %PCI_ANY_ID to match all device ids | 
 |  * @from: Previous PCI device found in search, or %NULL for new search. | 
 |  * | 
 |  * Iterates through the list of known PCI devices.  If a PCI device is | 
 |  * found with a matching @vendor, @device, @ss_vendor and @ss_device, a | 
 |  * pointer to its device structure is returned.  Otherwise, %NULL is returned. | 
 |  * A new search is initiated by passing %NULL as the @from argument. | 
 |  * Otherwise if @from is not %NULL, searches continue from next device | 
 |  * on the global list. | 
 |  * | 
 |  * NOTE: Do not use this function any more; use pci_get_subsys() instead, as | 
 |  * the PCI device returned by this function can disappear at any moment in | 
 |  * time. | 
 |  */ | 
 | static struct pci_dev * pci_find_subsys(unsigned int vendor, | 
 | 				        unsigned int device, | 
 | 					unsigned int ss_vendor, | 
 | 					unsigned int ss_device, | 
 | 					const struct pci_dev *from) | 
 | { | 
 | 	struct list_head *n; | 
 | 	struct pci_dev *dev; | 
 |  | 
 | 	WARN_ON(in_interrupt()); | 
 |  | 
 | 	/* | 
 | 	 * pci_find_subsys() can be called on the ide_setup() path, super-early | 
 | 	 * in boot.  But the down_read() will enable local interrupts, which | 
 | 	 * can cause some machines to crash.  So here we detect and flag that | 
 | 	 * situation and bail out early. | 
 | 	 */ | 
 | 	if (unlikely(no_pci_devices())) | 
 | 		return NULL; | 
 | 	down_read(&pci_bus_sem); | 
 | 	n = from ? from->global_list.next : pci_devices.next; | 
 |  | 
 | 	while (n && (n != &pci_devices)) { | 
 | 		dev = pci_dev_g(n); | 
 | 		if ((vendor == PCI_ANY_ID || dev->vendor == vendor) && | 
 | 		    (device == PCI_ANY_ID || dev->device == device) && | 
 | 		    (ss_vendor == PCI_ANY_ID || dev->subsystem_vendor == ss_vendor) && | 
 | 		    (ss_device == PCI_ANY_ID || dev->subsystem_device == ss_device)) | 
 | 			goto exit; | 
 | 		n = n->next; | 
 | 	} | 
 | 	dev = NULL; | 
 | exit: | 
 | 	up_read(&pci_bus_sem); | 
 | 	return dev; | 
 | } | 
 |  | 
 | /** | 
 |  * pci_find_device - begin or continue searching for a PCI device by vendor/device id | 
 |  * @vendor: PCI vendor id to match, or %PCI_ANY_ID to match all vendor ids | 
 |  * @device: PCI device id to match, or %PCI_ANY_ID to match all device ids | 
 |  * @from: Previous PCI device found in search, or %NULL for new search. | 
 |  * | 
 |  * Iterates through the list of known PCI devices.  If a PCI device is found | 
 |  * with a matching @vendor and @device, a pointer to its device structure is | 
 |  * returned.  Otherwise, %NULL is returned. | 
 |  * A new search is initiated by passing %NULL as the @from argument. | 
 |  * Otherwise if @from is not %NULL, searches continue from next device | 
 |  * on the global list. | 
 |  *  | 
 |  * NOTE: Do not use this function any more; use pci_get_device() instead, as | 
 |  * the PCI device returned by this function can disappear at any moment in | 
 |  * time. | 
 |  */ | 
 | struct pci_dev * | 
 | pci_find_device(unsigned int vendor, unsigned int device, const struct pci_dev *from) | 
 | { | 
 | 	return pci_find_subsys(vendor, device, PCI_ANY_ID, PCI_ANY_ID, from); | 
 | } | 
 | #endif /* CONFIG_PCI_LEGACY */ | 
 |  | 
 | /** | 
 |  * pci_get_subsys - begin or continue searching for a PCI device by vendor/subvendor/device/subdevice id | 
 |  * @vendor: PCI vendor id to match, or %PCI_ANY_ID to match all vendor ids | 
 |  * @device: PCI device id to match, or %PCI_ANY_ID to match all device ids | 
 |  * @ss_vendor: PCI subsystem vendor id to match, or %PCI_ANY_ID to match all vendor ids | 
 |  * @ss_device: PCI subsystem device id to match, or %PCI_ANY_ID to match all device ids | 
 |  * @from: Previous PCI device found in search, or %NULL for new search. | 
 |  * | 
 |  * Iterates through the list of known PCI devices.  If a PCI device is found | 
 |  * with a matching @vendor, @device, @ss_vendor and @ss_device, a pointer to its | 
 |  * device structure is returned, and the reference count to the device is | 
 |  * incremented.  Otherwise, %NULL is returned.  A new search is initiated by | 
 |  * passing %NULL as the @from argument.  Otherwise if @from is not %NULL, | 
 |  * searches continue from next device on the global list. | 
 |  * The reference count for @from is always decremented if it is not %NULL. | 
 |  */ | 
 | struct pci_dev *  | 
 | pci_get_subsys(unsigned int vendor, unsigned int device, | 
 | 	       unsigned int ss_vendor, unsigned int ss_device, | 
 | 	       struct pci_dev *from) | 
 | { | 
 | 	struct list_head *n; | 
 | 	struct pci_dev *dev; | 
 |  | 
 | 	WARN_ON(in_interrupt()); | 
 |  | 
 | 	/* | 
 | 	 * pci_get_subsys() can potentially be called by drivers super-early | 
 | 	 * in boot.  But the down_read() will enable local interrupts, which | 
 | 	 * can cause some machines to crash.  So here we detect and flag that | 
 | 	 * situation and bail out early. | 
 | 	 */ | 
 | 	if (unlikely(no_pci_devices())) | 
 | 		return NULL; | 
 | 	down_read(&pci_bus_sem); | 
 | 	n = from ? from->global_list.next : pci_devices.next; | 
 |  | 
 | 	while (n && (n != &pci_devices)) { | 
 | 		dev = pci_dev_g(n); | 
 | 		if ((vendor == PCI_ANY_ID || dev->vendor == vendor) && | 
 | 		    (device == PCI_ANY_ID || dev->device == device) && | 
 | 		    (ss_vendor == PCI_ANY_ID || dev->subsystem_vendor == ss_vendor) && | 
 | 		    (ss_device == PCI_ANY_ID || dev->subsystem_device == ss_device)) | 
 | 			goto exit; | 
 | 		n = n->next; | 
 | 	} | 
 | 	dev = NULL; | 
 | exit: | 
 | 	dev = pci_dev_get(dev); | 
 | 	up_read(&pci_bus_sem); | 
 | 	pci_dev_put(from); | 
 | 	return dev; | 
 | } | 
 |  | 
 | /** | 
 |  * pci_get_device - begin or continue searching for a PCI device by vendor/device id | 
 |  * @vendor: PCI vendor id to match, or %PCI_ANY_ID to match all vendor ids | 
 |  * @device: PCI device id to match, or %PCI_ANY_ID to match all device ids | 
 |  * @from: Previous PCI device found in search, or %NULL for new search. | 
 |  * | 
 |  * Iterates through the list of known PCI devices.  If a PCI device is | 
 |  * found with a matching @vendor and @device, the reference count to the | 
 |  * device is incremented and a pointer to its device structure is returned. | 
 |  * Otherwise, %NULL is returned.  A new search is initiated by passing %NULL | 
 |  * as the @from argument.  Otherwise if @from is not %NULL, searches continue | 
 |  * from next device on the global list.  The reference count for @from is | 
 |  * always decremented if it is not %NULL. | 
 |  */ | 
 | struct pci_dev * | 
 | pci_get_device(unsigned int vendor, unsigned int device, struct pci_dev *from) | 
 | { | 
 | 	return pci_get_subsys(vendor, device, PCI_ANY_ID, PCI_ANY_ID, from); | 
 | } | 
 |  | 
 | /** | 
 |  * pci_get_device_reverse - begin or continue searching for a PCI device by vendor/device id | 
 |  * @vendor: PCI vendor id to match, or %PCI_ANY_ID to match all vendor ids | 
 |  * @device: PCI device id to match, or %PCI_ANY_ID to match all device ids | 
 |  * @from: Previous PCI device found in search, or %NULL for new search. | 
 |  * | 
 |  * Iterates through the list of known PCI devices in the reverse order of | 
 |  * pci_get_device. | 
 |  * If a PCI device is found with a matching @vendor and @device, the reference | 
 |  * count to the  device is incremented and a pointer to its device structure | 
 |  * is returned Otherwise, %NULL is returned.  A new search is initiated by | 
 |  * passing %NULL as the @from argument.  Otherwise if @from is not %NULL, | 
 |  * searches continue from next device on the global list.  The reference | 
 |  * count for @from is always decremented if it is not %NULL. | 
 |  */ | 
 | struct pci_dev * | 
 | pci_get_device_reverse(unsigned int vendor, unsigned int device, struct pci_dev *from) | 
 | { | 
 | 	struct list_head *n; | 
 | 	struct pci_dev *dev; | 
 |  | 
 | 	WARN_ON(in_interrupt()); | 
 | 	down_read(&pci_bus_sem); | 
 | 	n = from ? from->global_list.prev : pci_devices.prev; | 
 |  | 
 | 	while (n && (n != &pci_devices)) { | 
 | 		dev = pci_dev_g(n); | 
 | 		if ((vendor == PCI_ANY_ID || dev->vendor == vendor) && | 
 | 		    (device == PCI_ANY_ID || dev->device == device)) | 
 | 			goto exit; | 
 | 		n = n->prev; | 
 | 	} | 
 | 	dev = NULL; | 
 | exit: | 
 | 	dev = pci_dev_get(dev); | 
 | 	up_read(&pci_bus_sem); | 
 | 	pci_dev_put(from); | 
 | 	return dev; | 
 | } | 
 |  | 
 | /** | 
 |  * pci_get_class - begin or continue searching for a PCI device by class | 
 |  * @class: search for a PCI device with this class designation | 
 |  * @from: Previous PCI device found in search, or %NULL for new search. | 
 |  * | 
 |  * Iterates through the list of known PCI devices.  If a PCI device is | 
 |  * found with a matching @class, the reference count to the device is | 
 |  * incremented and a pointer to its device structure is returned. | 
 |  * Otherwise, %NULL is returned. | 
 |  * A new search is initiated by passing %NULL as the @from argument. | 
 |  * Otherwise if @from is not %NULL, searches continue from next device | 
 |  * on the global list.  The reference count for @from is always decremented | 
 |  * if it is not %NULL. | 
 |  */ | 
 | struct pci_dev *pci_get_class(unsigned int class, struct pci_dev *from) | 
 | { | 
 | 	struct list_head *n; | 
 | 	struct pci_dev *dev; | 
 |  | 
 | 	WARN_ON(in_interrupt()); | 
 | 	down_read(&pci_bus_sem); | 
 | 	n = from ? from->global_list.next : pci_devices.next; | 
 |  | 
 | 	while (n && (n != &pci_devices)) { | 
 | 		dev = pci_dev_g(n); | 
 | 		if (dev->class == class) | 
 | 			goto exit; | 
 | 		n = n->next; | 
 | 	} | 
 | 	dev = NULL; | 
 | exit: | 
 | 	dev = pci_dev_get(dev); | 
 | 	up_read(&pci_bus_sem); | 
 | 	pci_dev_put(from); | 
 | 	return dev; | 
 | } | 
 |  | 
 | const struct pci_device_id *pci_find_present(const struct pci_device_id *ids) | 
 | { | 
 | 	struct pci_dev *dev; | 
 | 	const struct pci_device_id *found = NULL; | 
 |  | 
 | 	WARN_ON(in_interrupt()); | 
 | 	down_read(&pci_bus_sem); | 
 | 	while (ids->vendor || ids->subvendor || ids->class_mask) { | 
 | 		list_for_each_entry(dev, &pci_devices, global_list) { | 
 | 			if ((found = pci_match_one_device(ids, dev)) != NULL) | 
 | 				goto exit; | 
 | 		} | 
 | 		ids++; | 
 | 	} | 
 | exit: | 
 | 	up_read(&pci_bus_sem); | 
 | 	return found; | 
 | } | 
 |  | 
 | /** | 
 |  * pci_dev_present - Returns 1 if device matching the device list is present, 0 if not. | 
 |  * @ids: A pointer to a null terminated list of struct pci_device_id structures | 
 |  * that describe the type of PCI device the caller is trying to find. | 
 |  * | 
 |  * Obvious fact: You do not have a reference to any device that might be found | 
 |  * by this function, so if that device is removed from the system right after | 
 |  * this function is finished, the value will be stale.  Use this function to | 
 |  * find devices that are usually built into a system, or for a general hint as | 
 |  * to if another device happens to be present at this specific moment in time. | 
 |  */ | 
 | int pci_dev_present(const struct pci_device_id *ids) | 
 | { | 
 | 	return pci_find_present(ids) == NULL ? 0 : 1; | 
 | } | 
 |  | 
 | EXPORT_SYMBOL(pci_dev_present); | 
 | EXPORT_SYMBOL(pci_find_present); | 
 |  | 
 | #ifdef CONFIG_PCI_LEGACY | 
 | EXPORT_SYMBOL(pci_find_device); | 
 | EXPORT_SYMBOL(pci_find_slot); | 
 | #endif /* CONFIG_PCI_LEGACY */ | 
 |  | 
 | /* For boot time work */ | 
 | EXPORT_SYMBOL(pci_find_bus); | 
 | EXPORT_SYMBOL(pci_find_next_bus); | 
 | /* For everyone */ | 
 | EXPORT_SYMBOL(pci_get_device); | 
 | EXPORT_SYMBOL(pci_get_device_reverse); | 
 | EXPORT_SYMBOL(pci_get_subsys); | 
 | EXPORT_SYMBOL(pci_get_slot); | 
 | EXPORT_SYMBOL(pci_get_bus_and_slot); | 
 | EXPORT_SYMBOL(pci_get_class); |