1 #include <linux/config.h>
2 #include <linux/string.h>
3 #include <linux/kernel.h>
4 #include <linux/init.h>
5 #include <linux/module.h>
6 #include <linux/mod_devicetable.h>
7 #include <linux/slab.h>
10 #include <asm/of_device.h>
13 * of_match_device - Tell if an of_device structure has a matching
15 * @ids: array of of device match structures to search in
16 * @dev: the of device structure to match against
18 * Used by a driver to check whether an of_device present in the
19 * system is in its list of supported devices.
21 const struct of_device_id *of_match_device(const struct of_device_id *matches,
22 const struct of_device *dev)
26 while (matches->name[0] || matches->type[0] || matches->compatible[0]) {
29 match &= dev->node->name
30 && !strcmp(matches->name, dev->node->name);
32 match &= dev->node->type
33 && !strcmp(matches->type, dev->node->type);
34 if (matches->compatible[0])
35 match &= of_device_is_compatible(dev->node,
44 static int of_platform_bus_match(struct device *dev, struct device_driver *drv)
46 struct of_device * of_dev = to_of_device(dev);
47 struct of_platform_driver * of_drv = to_of_platform_driver(drv);
48 const struct of_device_id * matches = of_drv->match_table;
53 return of_match_device(matches, of_dev) != NULL;
56 struct of_device *of_dev_get(struct of_device *dev)
62 tmp = get_device(&dev->dev);
64 return to_of_device(tmp);
69 void of_dev_put(struct of_device *dev)
72 put_device(&dev->dev);
76 static int of_device_probe(struct device *dev)
79 struct of_platform_driver *drv;
80 struct of_device *of_dev;
81 const struct of_device_id *match;
83 drv = to_of_platform_driver(dev->driver);
84 of_dev = to_of_device(dev);
91 match = of_match_device(drv->match_table, of_dev);
93 error = drv->probe(of_dev, match);
100 static int of_device_remove(struct device *dev)
102 struct of_device * of_dev = to_of_device(dev);
103 struct of_platform_driver * drv = to_of_platform_driver(dev->driver);
105 if (dev->driver && drv->remove)
110 static int of_device_suspend(struct device *dev, pm_message_t state)
112 struct of_device * of_dev = to_of_device(dev);
113 struct of_platform_driver * drv = to_of_platform_driver(dev->driver);
116 if (dev->driver && drv->suspend)
117 error = drv->suspend(of_dev, state);
121 static int of_device_resume(struct device * dev)
123 struct of_device * of_dev = to_of_device(dev);
124 struct of_platform_driver * drv = to_of_platform_driver(dev->driver);
127 if (dev->driver && drv->resume)
128 error = drv->resume(of_dev);
133 struct bus_type ebus_bus_type = {
135 .match = of_platform_bus_match,
136 .probe = of_device_probe,
137 .remove = of_device_remove,
138 .suspend = of_device_suspend,
139 .resume = of_device_resume,
141 EXPORT_SYMBOL(ebus_bus_type);
145 struct bus_type sbus_bus_type = {
147 .match = of_platform_bus_match,
148 .probe = of_device_probe,
149 .remove = of_device_remove,
150 .suspend = of_device_suspend,
151 .resume = of_device_resume,
153 EXPORT_SYMBOL(sbus_bus_type);
156 static int __init of_bus_driver_init(void)
162 err = bus_register(&ebus_bus_type);
166 err = bus_register(&sbus_bus_type);
171 postcore_initcall(of_bus_driver_init);
173 int of_register_driver(struct of_platform_driver *drv, struct bus_type *bus)
175 /* initialize common driver fields */
176 drv->driver.name = drv->name;
177 drv->driver.bus = bus;
179 /* register with core */
180 return driver_register(&drv->driver);
183 void of_unregister_driver(struct of_platform_driver *drv)
185 driver_unregister(&drv->driver);
189 static ssize_t dev_show_devspec(struct device *dev, struct device_attribute *attr, char *buf)
191 struct of_device *ofdev;
193 ofdev = to_of_device(dev);
194 return sprintf(buf, "%s", ofdev->node->full_name);
197 static DEVICE_ATTR(devspec, S_IRUGO, dev_show_devspec, NULL);
200 * of_release_dev - free an of device structure when all users of it are finished.
201 * @dev: device that's been disconnected
203 * Will be called only by the device core when all users of this of device are
206 void of_release_dev(struct device *dev)
208 struct of_device *ofdev;
210 ofdev = to_of_device(dev);
215 int of_device_register(struct of_device *ofdev)
219 BUG_ON(ofdev->node == NULL);
221 rc = device_register(&ofdev->dev);
225 device_create_file(&ofdev->dev, &dev_attr_devspec);
230 void of_device_unregister(struct of_device *ofdev)
232 device_remove_file(&ofdev->dev, &dev_attr_devspec);
233 device_unregister(&ofdev->dev);
236 struct of_device* of_platform_device_create(struct device_node *np,
238 struct device *parent,
239 struct bus_type *bus)
241 struct of_device *dev;
243 dev = kmalloc(sizeof(*dev), GFP_KERNEL);
246 memset(dev, 0, sizeof(*dev));
248 dev->dev.parent = parent;
250 dev->dev.release = of_release_dev;
252 strlcpy(dev->dev.bus_id, bus_id, BUS_ID_SIZE);
254 if (of_device_register(dev) != 0) {
262 EXPORT_SYMBOL(of_match_device);
263 EXPORT_SYMBOL(of_register_driver);
264 EXPORT_SYMBOL(of_unregister_driver);
265 EXPORT_SYMBOL(of_device_register);
266 EXPORT_SYMBOL(of_device_unregister);
267 EXPORT_SYMBOL(of_dev_get);
268 EXPORT_SYMBOL(of_dev_put);
269 EXPORT_SYMBOL(of_platform_device_create);
270 EXPORT_SYMBOL(of_release_dev);