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 isa_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,
142 struct bus_type ebus_bus_type = {
144 .match = of_platform_bus_match,
145 .probe = of_device_probe,
146 .remove = of_device_remove,
147 .suspend = of_device_suspend,
148 .resume = of_device_resume,
153 struct bus_type sbus_bus_type = {
155 .match = of_platform_bus_match,
156 .probe = of_device_probe,
157 .remove = of_device_remove,
158 .suspend = of_device_suspend,
159 .resume = of_device_resume,
163 static int __init of_bus_driver_init(void)
169 err = bus_register(&isa_bus_type);
171 err = bus_register(&ebus_bus_type);
175 err = bus_register(&sbus_bus_type);
180 postcore_initcall(of_bus_driver_init);
182 int of_register_driver(struct of_platform_driver *drv, struct bus_type *bus)
184 /* initialize common driver fields */
185 drv->driver.name = drv->name;
186 drv->driver.bus = bus;
188 /* register with core */
189 return driver_register(&drv->driver);
192 void of_unregister_driver(struct of_platform_driver *drv)
194 driver_unregister(&drv->driver);
198 static ssize_t dev_show_devspec(struct device *dev, struct device_attribute *attr, char *buf)
200 struct of_device *ofdev;
202 ofdev = to_of_device(dev);
203 return sprintf(buf, "%s", ofdev->node->full_name);
206 static DEVICE_ATTR(devspec, S_IRUGO, dev_show_devspec, NULL);
209 * of_release_dev - free an of device structure when all users of it are finished.
210 * @dev: device that's been disconnected
212 * Will be called only by the device core when all users of this of device are
215 void of_release_dev(struct device *dev)
217 struct of_device *ofdev;
219 ofdev = to_of_device(dev);
224 int of_device_register(struct of_device *ofdev)
228 BUG_ON(ofdev->node == NULL);
230 rc = device_register(&ofdev->dev);
234 device_create_file(&ofdev->dev, &dev_attr_devspec);
239 void of_device_unregister(struct of_device *ofdev)
241 device_remove_file(&ofdev->dev, &dev_attr_devspec);
242 device_unregister(&ofdev->dev);
245 struct of_device* of_platform_device_create(struct device_node *np,
247 struct device *parent,
248 struct bus_type *bus)
250 struct of_device *dev;
252 dev = kmalloc(sizeof(*dev), GFP_KERNEL);
255 memset(dev, 0, sizeof(*dev));
257 dev->dev.parent = parent;
259 dev->dev.release = of_release_dev;
261 strlcpy(dev->dev.bus_id, bus_id, BUS_ID_SIZE);
263 if (of_device_register(dev) != 0) {
271 EXPORT_SYMBOL(of_match_device);
272 EXPORT_SYMBOL(of_register_driver);
273 EXPORT_SYMBOL(of_unregister_driver);
274 EXPORT_SYMBOL(of_device_register);
275 EXPORT_SYMBOL(of_device_unregister);
276 EXPORT_SYMBOL(of_dev_get);
277 EXPORT_SYMBOL(of_dev_put);
278 EXPORT_SYMBOL(of_platform_device_create);
279 EXPORT_SYMBOL(of_release_dev);