|
|
|
@@ -7,7 +7,6 @@
|
|
|
|
|
#include <linux/module.h>
|
|
|
|
|
#include <linux/init.h>
|
|
|
|
|
#include <linux/device.h>
|
|
|
|
|
#include <linux/pci-dynids.h>
|
|
|
|
|
#include "pci.h"
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
@@ -19,35 +18,11 @@
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
#ifdef CONFIG_HOTPLUG
|
|
|
|
|
/**
|
|
|
|
|
* pci_device_probe_dynamic()
|
|
|
|
|
*
|
|
|
|
|
* Walk the dynamic ID list looking for a match.
|
|
|
|
|
* returns 0 and sets pci_dev->driver when drv claims pci_dev, else error.
|
|
|
|
|
*/
|
|
|
|
|
static int
|
|
|
|
|
pci_device_probe_dynamic(struct pci_driver *drv, struct pci_dev *pci_dev)
|
|
|
|
|
{
|
|
|
|
|
int error = -ENODEV;
|
|
|
|
|
struct list_head *pos;
|
|
|
|
|
struct dynid *dynid;
|
|
|
|
|
|
|
|
|
|
spin_lock(&drv->dynids.lock);
|
|
|
|
|
list_for_each(pos, &drv->dynids.list) {
|
|
|
|
|
dynid = list_entry(pos, struct dynid, node);
|
|
|
|
|
if (pci_match_one_device(&dynid->id, pci_dev)) {
|
|
|
|
|
spin_unlock(&drv->dynids.lock);
|
|
|
|
|
error = drv->probe(pci_dev, &dynid->id);
|
|
|
|
|
if (error >= 0) {
|
|
|
|
|
pci_dev->driver = drv;
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
return error;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
spin_unlock(&drv->dynids.lock);
|
|
|
|
|
return error;
|
|
|
|
|
}
|
|
|
|
|
struct pci_dynid {
|
|
|
|
|
struct list_head node;
|
|
|
|
|
struct pci_device_id id;
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* store_new_id
|
|
|
|
@@ -58,8 +33,7 @@ pci_device_probe_dynamic(struct pci_driver *drv, struct pci_dev *pci_dev)
|
|
|
|
|
static inline ssize_t
|
|
|
|
|
store_new_id(struct device_driver *driver, const char *buf, size_t count)
|
|
|
|
|
{
|
|
|
|
|
struct dynid *dynid;
|
|
|
|
|
struct bus_type * bus;
|
|
|
|
|
struct pci_dynid *dynid;
|
|
|
|
|
struct pci_driver *pdrv = to_pci_driver(driver);
|
|
|
|
|
__u32 vendor=PCI_ANY_ID, device=PCI_ANY_ID, subvendor=PCI_ANY_ID,
|
|
|
|
|
subdevice=PCI_ANY_ID, class=0, class_mask=0;
|
|
|
|
@@ -91,37 +65,22 @@ store_new_id(struct device_driver *driver, const char *buf, size_t count)
|
|
|
|
|
list_add_tail(&pdrv->dynids.list, &dynid->node);
|
|
|
|
|
spin_unlock(&pdrv->dynids.lock);
|
|
|
|
|
|
|
|
|
|
bus = get_bus(pdrv->driver.bus);
|
|
|
|
|
if (bus) {
|
|
|
|
|
if (get_driver(&pdrv->driver)) {
|
|
|
|
|
down_write(&bus->subsys.rwsem);
|
|
|
|
|
driver_attach(&pdrv->driver);
|
|
|
|
|
up_write(&bus->subsys.rwsem);
|
|
|
|
|
put_driver(&pdrv->driver);
|
|
|
|
|
}
|
|
|
|
|
put_bus(bus);
|
|
|
|
|
if (get_driver(&pdrv->driver)) {
|
|
|
|
|
driver_attach(&pdrv->driver);
|
|
|
|
|
put_driver(&pdrv->driver);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return count;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static DRIVER_ATTR(new_id, S_IWUSR, NULL, store_new_id);
|
|
|
|
|
static inline void
|
|
|
|
|
pci_init_dynids(struct pci_dynids *dynids)
|
|
|
|
|
{
|
|
|
|
|
spin_lock_init(&dynids->lock);
|
|
|
|
|
INIT_LIST_HEAD(&dynids->list);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void
|
|
|
|
|
pci_free_dynids(struct pci_driver *drv)
|
|
|
|
|
{
|
|
|
|
|
struct list_head *pos, *n;
|
|
|
|
|
struct dynid *dynid;
|
|
|
|
|
struct pci_dynid *dynid, *n;
|
|
|
|
|
|
|
|
|
|
spin_lock(&drv->dynids.lock);
|
|
|
|
|
list_for_each_safe(pos, n, &drv->dynids.list) {
|
|
|
|
|
dynid = list_entry(pos, struct dynid, node);
|
|
|
|
|
list_for_each_entry_safe(dynid, n, &drv->dynids.list, node) {
|
|
|
|
|
list_del(&dynid->node);
|
|
|
|
|
kfree(dynid);
|
|
|
|
|
}
|
|
|
|
@@ -138,83 +97,70 @@ pci_create_newid_file(struct pci_driver *drv)
|
|
|
|
|
return error;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static int
|
|
|
|
|
pci_bus_match_dynids(const struct pci_dev *pci_dev, struct pci_driver *pci_drv)
|
|
|
|
|
{
|
|
|
|
|
struct list_head *pos;
|
|
|
|
|
struct dynid *dynid;
|
|
|
|
|
|
|
|
|
|
spin_lock(&pci_drv->dynids.lock);
|
|
|
|
|
list_for_each(pos, &pci_drv->dynids.list) {
|
|
|
|
|
dynid = list_entry(pos, struct dynid, node);
|
|
|
|
|
if (pci_match_one_device(&dynid->id, pci_dev)) {
|
|
|
|
|
spin_unlock(&pci_drv->dynids.lock);
|
|
|
|
|
return 1;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
spin_unlock(&pci_drv->dynids.lock);
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
#else /* !CONFIG_HOTPLUG */
|
|
|
|
|
static inline int pci_device_probe_dynamic(struct pci_driver *drv, struct pci_dev *pci_dev)
|
|
|
|
|
{
|
|
|
|
|
return -ENODEV;
|
|
|
|
|
}
|
|
|
|
|
static inline void pci_init_dynids(struct pci_dynids *dynids) {}
|
|
|
|
|
static inline void pci_free_dynids(struct pci_driver *drv) {}
|
|
|
|
|
static inline int pci_create_newid_file(struct pci_driver *drv)
|
|
|
|
|
{
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
static inline int pci_bus_match_dynids(const struct pci_dev *pci_dev, struct pci_driver *pci_drv)
|
|
|
|
|
{
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* pci_match_device - Tell if a PCI device structure has a matching
|
|
|
|
|
* PCI device id structure
|
|
|
|
|
* pci_match_id - See if a pci device matches a given pci_id table
|
|
|
|
|
* @ids: array of PCI device id structures to search in
|
|
|
|
|
* @dev: the PCI device structure to match against
|
|
|
|
|
*
|
|
|
|
|
* @dev: the PCI device structure to match against.
|
|
|
|
|
*
|
|
|
|
|
* Used by a driver to check whether a PCI device present in the
|
|
|
|
|
* system is in its list of supported devices.Returns the matching
|
|
|
|
|
* system is in its list of supported devices. Returns the matching
|
|
|
|
|
* pci_device_id structure or %NULL if there is no match.
|
|
|
|
|
*
|
|
|
|
|
* Depreciated, don't use this as it will not catch any dynamic ids
|
|
|
|
|
* that a driver might want to check for.
|
|
|
|
|
*/
|
|
|
|
|
const struct pci_device_id *
|
|
|
|
|
pci_match_device(const struct pci_device_id *ids, const struct pci_dev *dev)
|
|
|
|
|
const struct pci_device_id *pci_match_id(const struct pci_device_id *ids,
|
|
|
|
|
struct pci_dev *dev)
|
|
|
|
|
{
|
|
|
|
|
while (ids->vendor || ids->subvendor || ids->class_mask) {
|
|
|
|
|
if (pci_match_one_device(ids, dev))
|
|
|
|
|
return ids;
|
|
|
|
|
ids++;
|
|
|
|
|
if (ids) {
|
|
|
|
|
while (ids->vendor || ids->subvendor || ids->class_mask) {
|
|
|
|
|
if (pci_match_one_device(ids, dev))
|
|
|
|
|
return ids;
|
|
|
|
|
ids++;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
return NULL;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* pci_device_probe_static()
|
|
|
|
|
*
|
|
|
|
|
* returns 0 and sets pci_dev->driver when drv claims pci_dev, else error.
|
|
|
|
|
* pci_match_device - Tell if a PCI device structure has a matching
|
|
|
|
|
* PCI device id structure
|
|
|
|
|
* @ids: array of PCI device id structures to search in
|
|
|
|
|
* @dev: the PCI device structure to match against
|
|
|
|
|
* @drv: the PCI driver to match against
|
|
|
|
|
*
|
|
|
|
|
* Used by a driver to check whether a PCI device present in the
|
|
|
|
|
* system is in its list of supported devices. Returns the matching
|
|
|
|
|
* pci_device_id structure or %NULL if there is no match.
|
|
|
|
|
*/
|
|
|
|
|
static int
|
|
|
|
|
pci_device_probe_static(struct pci_driver *drv, struct pci_dev *pci_dev)
|
|
|
|
|
{
|
|
|
|
|
int error = -ENODEV;
|
|
|
|
|
const struct pci_device_id *pci_match_device(struct pci_driver *drv,
|
|
|
|
|
struct pci_dev *dev)
|
|
|
|
|
{
|
|
|
|
|
const struct pci_device_id *id;
|
|
|
|
|
struct pci_dynid *dynid;
|
|
|
|
|
|
|
|
|
|
if (!drv->id_table)
|
|
|
|
|
return error;
|
|
|
|
|
id = pci_match_device(drv->id_table, pci_dev);
|
|
|
|
|
id = pci_match_id(drv->id_table, dev);
|
|
|
|
|
if (id)
|
|
|
|
|
error = drv->probe(pci_dev, id);
|
|
|
|
|
if (error >= 0) {
|
|
|
|
|
pci_dev->driver = drv;
|
|
|
|
|
error = 0;
|
|
|
|
|
return id;
|
|
|
|
|
|
|
|
|
|
/* static ids didn't match, lets look at the dynamic ones */
|
|
|
|
|
spin_lock(&drv->dynids.lock);
|
|
|
|
|
list_for_each_entry(dynid, &drv->dynids.list, node) {
|
|
|
|
|
if (pci_match_one_device(&dynid->id, dev)) {
|
|
|
|
|
spin_unlock(&drv->dynids.lock);
|
|
|
|
|
return &dynid->id;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
return error;
|
|
|
|
|
spin_unlock(&drv->dynids.lock);
|
|
|
|
|
return NULL;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
@@ -225,13 +171,20 @@ pci_device_probe_static(struct pci_driver *drv, struct pci_dev *pci_dev)
|
|
|
|
|
*/
|
|
|
|
|
static int
|
|
|
|
|
__pci_device_probe(struct pci_driver *drv, struct pci_dev *pci_dev)
|
|
|
|
|
{
|
|
|
|
|
{
|
|
|
|
|
const struct pci_device_id *id;
|
|
|
|
|
int error = 0;
|
|
|
|
|
|
|
|
|
|
if (!pci_dev->driver && drv->probe) {
|
|
|
|
|
error = pci_device_probe_static(drv, pci_dev);
|
|
|
|
|
if (error == -ENODEV)
|
|
|
|
|
error = pci_device_probe_dynamic(drv, pci_dev);
|
|
|
|
|
error = -ENODEV;
|
|
|
|
|
|
|
|
|
|
id = pci_match_device(drv, pci_dev);
|
|
|
|
|
if (id)
|
|
|
|
|
error = drv->probe(pci_dev, id);
|
|
|
|
|
if (error >= 0) {
|
|
|
|
|
pci_dev->driver = drv;
|
|
|
|
|
error = 0;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
return error;
|
|
|
|
|
}
|
|
|
|
@@ -371,12 +324,6 @@ static struct kobj_type pci_driver_kobj_type = {
|
|
|
|
|
.sysfs_ops = &pci_driver_sysfs_ops,
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
static int
|
|
|
|
|
pci_populate_driver_dir(struct pci_driver *drv)
|
|
|
|
|
{
|
|
|
|
|
return pci_create_newid_file(drv);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* pci_register_driver - register a new pci driver
|
|
|
|
|
* @drv: the driver structure to register
|
|
|
|
@@ -401,13 +348,15 @@ int pci_register_driver(struct pci_driver *drv)
|
|
|
|
|
drv->driver.shutdown = pci_device_shutdown;
|
|
|
|
|
drv->driver.owner = drv->owner;
|
|
|
|
|
drv->driver.kobj.ktype = &pci_driver_kobj_type;
|
|
|
|
|
pci_init_dynids(&drv->dynids);
|
|
|
|
|
|
|
|
|
|
spin_lock_init(&drv->dynids.lock);
|
|
|
|
|
INIT_LIST_HEAD(&drv->dynids.list);
|
|
|
|
|
|
|
|
|
|
/* register with core */
|
|
|
|
|
error = driver_register(&drv->driver);
|
|
|
|
|
|
|
|
|
|
if (!error)
|
|
|
|
|
pci_populate_driver_dir(drv);
|
|
|
|
|
error = pci_create_newid_file(drv);
|
|
|
|
|
|
|
|
|
|
return error;
|
|
|
|
|
}
|
|
|
|
@@ -463,21 +412,17 @@ pci_dev_driver(const struct pci_dev *dev)
|
|
|
|
|
* system is in its list of supported devices.Returns the matching
|
|
|
|
|
* pci_device_id structure or %NULL if there is no match.
|
|
|
|
|
*/
|
|
|
|
|
static int pci_bus_match(struct device * dev, struct device_driver * drv)
|
|
|
|
|
static int pci_bus_match(struct device *dev, struct device_driver *drv)
|
|
|
|
|
{
|
|
|
|
|
const struct pci_dev * pci_dev = to_pci_dev(dev);
|
|
|
|
|
struct pci_driver * pci_drv = to_pci_driver(drv);
|
|
|
|
|
const struct pci_device_id * ids = pci_drv->id_table;
|
|
|
|
|
struct pci_dev *pci_dev = to_pci_dev(dev);
|
|
|
|
|
struct pci_driver *pci_drv = to_pci_driver(drv);
|
|
|
|
|
const struct pci_device_id *found_id;
|
|
|
|
|
|
|
|
|
|
if (!ids)
|
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
|
|
found_id = pci_match_device(ids, pci_dev);
|
|
|
|
|
found_id = pci_match_device(pci_drv, pci_dev);
|
|
|
|
|
if (found_id)
|
|
|
|
|
return 1;
|
|
|
|
|
|
|
|
|
|
return pci_bus_match_dynids(pci_dev, pci_drv);
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
@@ -536,6 +481,7 @@ static int __init pci_driver_init(void)
|
|
|
|
|
|
|
|
|
|
postcore_initcall(pci_driver_init);
|
|
|
|
|
|
|
|
|
|
EXPORT_SYMBOL(pci_match_id);
|
|
|
|
|
EXPORT_SYMBOL(pci_match_device);
|
|
|
|
|
EXPORT_SYMBOL(pci_register_driver);
|
|
|
|
|
EXPORT_SYMBOL(pci_unregister_driver);
|
|
|
|
|