i2c-stub: Support multiple chips
[linux-2.6] / drivers / of / platform.c
1 /*
2  *    Copyright (C) 2006 Benjamin Herrenschmidt, IBM Corp.
3  *                       <benh@kernel.crashing.org>
4  *    and                Arnd Bergmann, IBM Corp.
5  *    Merged from powerpc/kernel/of_platform.c and
6  *    sparc{,64}/kernel/of_device.c by Stephen Rothwell
7  *
8  *  This program is free software; you can redistribute it and/or
9  *  modify it under the terms of the GNU General Public License
10  *  as published by the Free Software Foundation; either version
11  *  2 of the License, or (at your option) any later version.
12  *
13  */
14 #include <linux/errno.h>
15 #include <linux/device.h>
16 #include <linux/of_device.h>
17 #include <linux/of_platform.h>
18
19 static int of_platform_bus_match(struct device *dev, struct device_driver *drv)
20 {
21         struct of_device *of_dev = to_of_device(dev);
22         struct of_platform_driver *of_drv = to_of_platform_driver(drv);
23         const struct of_device_id *matches = of_drv->match_table;
24
25         if (!matches)
26                 return 0;
27
28         return of_match_device(matches, of_dev) != NULL;
29 }
30
31 static int of_platform_device_probe(struct device *dev)
32 {
33         int error = -ENODEV;
34         struct of_platform_driver *drv;
35         struct of_device *of_dev;
36         const struct of_device_id *match;
37
38         drv = to_of_platform_driver(dev->driver);
39         of_dev = to_of_device(dev);
40
41         if (!drv->probe)
42                 return error;
43
44         of_dev_get(of_dev);
45
46         match = of_match_device(drv->match_table, of_dev);
47         if (match)
48                 error = drv->probe(of_dev, match);
49         if (error)
50                 of_dev_put(of_dev);
51
52         return error;
53 }
54
55 static int of_platform_device_remove(struct device *dev)
56 {
57         struct of_device *of_dev = to_of_device(dev);
58         struct of_platform_driver *drv = to_of_platform_driver(dev->driver);
59
60         if (dev->driver && drv->remove)
61                 drv->remove(of_dev);
62         return 0;
63 }
64
65 static int of_platform_device_suspend(struct device *dev, pm_message_t state)
66 {
67         struct of_device *of_dev = to_of_device(dev);
68         struct of_platform_driver *drv = to_of_platform_driver(dev->driver);
69         int error = 0;
70
71         if (dev->driver && drv->suspend)
72                 error = drv->suspend(of_dev, state);
73         return error;
74 }
75
76 static int of_platform_device_resume(struct device * dev)
77 {
78         struct of_device *of_dev = to_of_device(dev);
79         struct of_platform_driver *drv = to_of_platform_driver(dev->driver);
80         int error = 0;
81
82         if (dev->driver && drv->resume)
83                 error = drv->resume(of_dev);
84         return error;
85 }
86
87 int of_bus_type_init(struct bus_type *bus, const char *name)
88 {
89         bus->name = name;
90         bus->match = of_platform_bus_match;
91         bus->probe = of_platform_device_probe;
92         bus->remove = of_platform_device_remove;
93         bus->suspend = of_platform_device_suspend;
94         bus->resume = of_platform_device_resume;
95         return bus_register(bus);
96 }