Linux驱动probe函数调用

转自：http://blog.csdn.net/wbcuc/article/details/8618363

 

参考：

http://blog.chinaunix.net/space.php?uid=15887868&do=blog&id=2758294

http://www.cnblogs.com/hoys/archive/2011/04/01/2002299.html
1，driver_register把驱动注册到总线

[cpp] view plain copy print ?

1. /**
2. * driver_register - register driver with bus
3. * @drv: driver to register
4. * We pass off most of the work to the bus_add_driver() call,
5. * since most of the things we have to do deal with the bus
6. * structures.
7. */ 
8. int driver_register(struct device_driver *drv) 
9. { 
10. …………………… 
11.     if ((drv->bus->probe && drv->probe) || 
12.         (drv->bus->remove && drv->remove) || 
13.         (drv->bus->shutdown && drv->shutdown)) 
14.  
15.     ret = bus_add_driver(drv);//把drv驱动，注册到总线 
16. …………………… 
17. } 

/**
 * driver_register - register driver with bus
 * @drv: driver to register
 * We pass off most of the work to the bus_add_driver() call,
 * since most of the things we have to do deal with the bus
 * structures.
 */
int driver_register(struct device_driver *drv)
{
……………………
	if ((drv->bus->probe && drv->probe) ||
	    (drv->bus->remove && drv->remove) ||
	    (drv->bus->shutdown && drv->shutdown))

	ret = bus_add_driver(drv);//把drv驱动，注册到总线
……………………
}

2，驱动注册到总线的实现函数

[cpp] view plain copy print ?

1. /**
2. * bus_add_driver - Add a driver to the bus.        -----在总线上加入一个驱动
3. * @drv: driver.
4. */ 
5. int bus_add_driver(struct device_driver *drv) 
6. { 
7. ……………… 
8.     if (drv->bus->p->drivers_autoprobe) { 
9.         error = driver_attach(drv);      //驱动的匹配函数 
10. ……………… 
11. } 

/**
 * bus_add_driver - Add a driver to the bus.        -----在总线上加入一个驱动
 * @drv: driver.
 */
int bus_add_driver(struct device_driver *drv)
{
………………
	if (drv->bus->p->drivers_autoprobe) {
		error = driver_attach(drv);      //驱动的匹配函数
………………
}

3，driver_attach()

[cpp] view plain copy print ?

1. /**
2. * driver_attach - try to bind driver to devices.
3. * @drv: driver.
4. *
5. * Walk the list of devices that the bus has on it and try to
6. * match the driver with each one.  If driver_probe_device()
7. * returns 0 and the @dev->driver is set, we've found a
8. * compatible pair.
9. */ 
10. int driver_attach(struct device_driver *drv) 
11. { 
12.     return bus_for_each_dev(drv->bus, NULL, drv, __driver_attach);//注意这里的__driver_attach 
13. } 
14. EXPORT_SYMBOL_GPL(driver_attach); 

/**
 * driver_attach - try to bind driver to devices.
 * @drv: driver.
 *
 * Walk the list of devices that the bus has on it and try to
 * match the driver with each one.  If driver_probe_device()
 * returns 0 and the @dev->driver is set, we've found a
 * compatible pair.
 */
int driver_attach(struct device_driver *drv)
{
	return bus_for_each_dev(drv->bus, NULL, drv, __driver_attach);//注意这里的__driver_attach
}
EXPORT_SYMBOL_GPL(driver_attach);

上面真正起作用的是__driver_attach：

[cpp] view plain copy print ?

1. static int __driver_attach(struct device *dev, void *data) 
2. { 
3.     struct device_driver *drv = data; 
4.  
5.     /*
6.      * Lock device and try to bind to it. We drop the error
7.      * here and always return 0, because we need to keep trying
8.      * to bind to devices and some drivers will return an error
9.      * simply if it didn't support the device.
10.      *
11.      * driver_probe_device() will spit a warning if there
12.      * is an error.
13.      */ 
14.  
15.     if (!driver_match_device(drv, dev)) 
16.         return 0; 
17.  
18.     if (dev->parent) /* Needed for USB */ 
19.         device_lock(dev->parent); 
20.     device_lock(dev); 
21.     if (!dev->driver) 
22.         driver_probe_device(drv, dev);//看下这个函数的实现过程 
23.     device_unlock(dev); 
24.     if (dev->parent) 
25.         device_unlock(dev->parent); 
26.  
27.     return 0; 
28. } 
29. int driver_probe_device(structdevice_driver *drv, struct device *dev) 
30. { 
31. ... 
32. //1.先是判断bus是否match： 
33. if (drv->bus->match && !drv->bus->match(dev, drv)) 
34.    goto done; 
35. //2.再具体执行probe： 
36. ret = really_probe(dev, drv); 
37. ... 
38. } 

static int __driver_attach(struct device *dev, void *data)
{
	struct device_driver *drv = data;

	/*
	 * Lock device and try to bind to it. We drop the error
	 * here and always return 0, because we need to keep trying
	 * to bind to devices and some drivers will return an error
	 * simply if it didn't support the device.
	 *
	 * driver_probe_device() will spit a warning if there
	 * is an error.
	 */

	if (!driver_match_device(drv, dev))
		return 0;

	if (dev->parent)	/* Needed for USB */
		device_lock(dev->parent);
	device_lock(dev);
	if (!dev->driver)
		driver_probe_device(drv, dev);//看下这个函数的实现过程
	device_unlock(dev);
	if (dev->parent)
		device_unlock(dev->parent);

	return 0;
}
int driver_probe_device(structdevice_driver *drv, struct device *dev)
{
...
//1.先是判断bus是否match：
if (drv->bus->match && !drv->bus->match(dev, drv))
   goto done;
//2.再具体执行probe：
ret = really_probe(dev, drv);
...
}

4,really_probe是我们真正要找的函数

[cpp] view plain copy print ?

1. static int really_probe(struct device *dev, struct device_driver *drv) 
2. { 
3. …………………… 
4. //1.先是调用的驱动所属总线的probe函数： 
5.     if (dev->bus->probe) { 
6.         ret = dev->bus->probe(dev); 
7.         if (ret) 
8.             goto probe_failed; 
9.     }  
10. //2.再调用的驱动中的probe函数： 
11.     else if (drv->probe) { 
12.         ret = drv->probe(dev); 
13.         if (ret) 
14.             goto probe_failed; 
15.     } 
16.  
17.     driver_bound(dev); 
18.     ret = 1; 
19.     pr_debug("bus: '%s': %s: bound device %s to driver %s\n", 
20.          drv->bus->name, __func__, dev_name(dev), drv->name);//这个信息可以看到我们注册的总 驱动、设备和总线  信息 
21.     goto done; 
22. ……………… 
23. } 

static int really_probe(struct device *dev, struct device_driver *drv)
{
……………………
//1.先是调用的驱动所属总线的probe函数：
	if (dev->bus->probe) {
		ret = dev->bus->probe(dev);
		if (ret)
			goto probe_failed;
	} 
//2.再调用的驱动中的probe函数：
	else if (drv->probe) {
		ret = drv->probe(dev);
		if (ret)
			goto probe_failed;
	}

	driver_bound(dev);
	ret = 1;
	pr_debug("bus: '%s': %s: bound device %s to driver %s\n",
		 drv->bus->name, __func__, dev_name(dev), drv->name);//这个信息可以看到我们注册的总 驱动、设备和总线  信息
	goto done;
………………
}

5.drv->bus->match(dev, drv)

driver_probe_device(struct device_driver *drv, struct device *dev)会通过drv->bus->match()来匹配PCIE设备与相应的设备驱动。对于内核为2.6.27的bus驱动“pci_express”来说，是通过调用pcie_port_bus_match()实现驱动match的。

[cpp] view plain copy print ?

1. static int pcie_port_bus_match(struct device *dev, struct device_driver *drv) 
2. { 
3.     struct pcie_device *pciedev; 
4.     struct pcie_port_service_driver *driver; 
5.  
6.     if (drv->bus != &pcie_port_bus_type || dev->bus != &pcie_port_bus_type) 
7.         return 0; 
8.      
9.     pciedev = to_pcie_device(dev); 
10.     driver = to_service_driver(drv); 
11.     if (   (driver->id_table->vendor != PCI_ANY_ID &&  
12.         driver->id_table->vendor != pciedev->id.vendor) || 
13.            (driver->id_table->device != PCI_ANY_ID && 
14.         driver->id_table->device != pciedev->id.device) ||  
15.            (driver->id_table->port_type != PCIE_ANY_PORT && 
16.         driver->id_table->port_type != pciedev->id.port_type) || 
17.         driver->id_table->service_type != pciedev->id.service_type ) 
18.         return 0;  
19.          // driver与pciedev的id_table匹配成功，才match成功； 
20.     return 1; 
21. } 

static int pcie_port_bus_match(struct device *dev, struct device_driver *drv)
{
	struct pcie_device *pciedev;
	struct pcie_port_service_driver *driver;

	if (drv->bus != &pcie_port_bus_type || dev->bus != &pcie_port_bus_type)
		return 0;
	
	pciedev = to_pcie_device(dev);
	driver = to_service_driver(drv);
	if (   (driver->id_table->vendor != PCI_ANY_ID && 
		driver->id_table->vendor != pciedev->id.vendor) ||
	       (driver->id_table->device != PCI_ANY_ID &&
		driver->id_table->device != pciedev->id.device) ||	
	       (driver->id_table->port_type != PCIE_ANY_PORT &&
		driver->id_table->port_type != pciedev->id.port_type) ||
		driver->id_table->service_type != pciedev->id.service_type )
		return 0; 
         // driver与pciedev的id_table匹配成功，才match成功；
	return 1;
}

[cpp] view plain copy print ?

1. // id_table的结构定义如下，match时只关注vendor,device,port_type,service_type 
2. struct pcie_port_service_id { 
3.     __u32 vendor, device;       /* Vendor and device ID or PCI_ANY_ID*/ 
4.     __u32 subvendor, subdevice; /* Subsystem ID's or PCI_ANY_ID */ 
5.     __u32 class, class_mask;    /* (class,subclass,prog-if) triplet */ 
6.     __u32 port_type, service_type;  /* Port Entity */ 
7.     kernel_ulong_t driver_data; 
8. }; 

// id_table的结构定义如下，match时只关注vendor,device,port_type,service_type
struct pcie_port_service_id {
	__u32 vendor, device;		/* Vendor and device ID or PCI_ANY_ID*/
	__u32 subvendor, subdevice;	/* Subsystem ID's or PCI_ANY_ID */
	__u32 class, class_mask;	/* (class,subclass,prog-if) triplet */
	__u32 port_type, service_type;	/* Port Entity */
	kernel_ulong_t driver_data;
};

打印出的驱动设备信息如：

………………

[    0.588087] bus: 'platform': really_probe: bound device power.0to driverpower  //总线：platform  设备：power.0  驱动：power
[    0.661226] bus: 'platform': really_probe: bound device s3c24xx-pwm.0 to driver s3c24xx-pwm
[    0.678552] bus: 'platform': really_probe: bound device s3c24xx-pwm.1 to driver s3c24xx-pwm
[    0.695971] bus: 'platform': really_probe: bound device s3c24xx-pwm.2 to driver s3c24xx-pwm
[    0.713389 bus: 'platform': really_probe: bound device s3c24xx-pwm.3 to driver