1
2
3
4
5
6
7
8#include <linux/module.h>
9#include "soundbus.h"
10
11MODULE_AUTHOR("Johannes Berg <johannes@sipsolutions.net>");
12MODULE_LICENSE("GPL");
13MODULE_DESCRIPTION("Apple Soundbus");
14
15struct soundbus_dev *soundbus_dev_get(struct soundbus_dev *dev)
16{
17 struct device *tmp;
18
19 if (!dev)
20 return NULL;
21 tmp = get_device(&dev->ofdev.dev);
22 if (tmp)
23 return to_soundbus_device(tmp);
24 else
25 return NULL;
26}
27EXPORT_SYMBOL_GPL(soundbus_dev_get);
28
29void soundbus_dev_put(struct soundbus_dev *dev)
30{
31 if (dev)
32 put_device(&dev->ofdev.dev);
33}
34EXPORT_SYMBOL_GPL(soundbus_dev_put);
35
36static int soundbus_probe(struct device *dev)
37{
38 int error = -ENODEV;
39 struct soundbus_driver *drv;
40 struct soundbus_dev *soundbus_dev;
41
42 drv = to_soundbus_driver(dev->driver);
43 soundbus_dev = to_soundbus_device(dev);
44
45 if (!drv->probe)
46 return error;
47
48 soundbus_dev_get(soundbus_dev);
49
50 error = drv->probe(soundbus_dev);
51 if (error)
52 soundbus_dev_put(soundbus_dev);
53
54 return error;
55}
56
57
58static int soundbus_uevent(struct device *dev, struct kobj_uevent_env *env)
59{
60 struct soundbus_dev * soundbus_dev;
61 struct platform_device * of;
62 const char *compat;
63 int retval = 0;
64 int cplen, seen = 0;
65
66 if (!dev)
67 return -ENODEV;
68
69 soundbus_dev = to_soundbus_device(dev);
70 if (!soundbus_dev)
71 return -ENODEV;
72
73 of = &soundbus_dev->ofdev;
74
75
76 retval = add_uevent_var(env, "OF_NAME=%pOFn", of->dev.of_node);
77 if (retval)
78 return retval;
79
80 retval = add_uevent_var(env, "OF_TYPE=%s", of_node_get_device_type(of->dev.of_node));
81 if (retval)
82 return retval;
83
84
85
86
87
88 compat = of_get_property(of->dev.of_node, "compatible", &cplen);
89 while (compat && cplen > 0) {
90 int tmp = env->buflen;
91 retval = add_uevent_var(env, "OF_COMPATIBLE_%d=%s", seen, compat);
92 if (retval)
93 return retval;
94 compat += env->buflen - tmp;
95 cplen -= env->buflen - tmp;
96 seen += 1;
97 }
98
99 retval = add_uevent_var(env, "OF_COMPATIBLE_N=%d", seen);
100 if (retval)
101 return retval;
102 retval = add_uevent_var(env, "MODALIAS=%s", soundbus_dev->modalias);
103
104 return retval;
105}
106
107static int soundbus_device_remove(struct device *dev)
108{
109 struct soundbus_dev * soundbus_dev = to_soundbus_device(dev);
110 struct soundbus_driver * drv = to_soundbus_driver(dev->driver);
111
112 if (dev->driver && drv->remove)
113 drv->remove(soundbus_dev);
114 soundbus_dev_put(soundbus_dev);
115
116 return 0;
117}
118
119static void soundbus_device_shutdown(struct device *dev)
120{
121 struct soundbus_dev * soundbus_dev = to_soundbus_device(dev);
122 struct soundbus_driver * drv = to_soundbus_driver(dev->driver);
123
124 if (dev->driver && drv->shutdown)
125 drv->shutdown(soundbus_dev);
126}
127
128
129ATTRIBUTE_GROUPS(soundbus_dev);
130static struct bus_type soundbus_bus_type = {
131 .name = "aoa-soundbus",
132 .probe = soundbus_probe,
133 .uevent = soundbus_uevent,
134 .remove = soundbus_device_remove,
135 .shutdown = soundbus_device_shutdown,
136 .dev_groups = soundbus_dev_groups,
137};
138
139int soundbus_add_one(struct soundbus_dev *dev)
140{
141 static int devcount;
142
143
144 if (!dev->attach_codec ||
145 !dev->ofdev.dev.of_node ||
146 dev->pcmname ||
147 dev->pcmid != -1) {
148 printk(KERN_ERR "soundbus: adding device failed sanity check!\n");
149 return -EINVAL;
150 }
151
152 dev_set_name(&dev->ofdev.dev, "soundbus:%x", ++devcount);
153 dev->ofdev.dev.bus = &soundbus_bus_type;
154 return of_device_register(&dev->ofdev);
155}
156EXPORT_SYMBOL_GPL(soundbus_add_one);
157
158void soundbus_remove_one(struct soundbus_dev *dev)
159{
160 of_device_unregister(&dev->ofdev);
161}
162EXPORT_SYMBOL_GPL(soundbus_remove_one);
163
164int soundbus_register_driver(struct soundbus_driver *drv)
165{
166
167 drv->driver.name = drv->name;
168 drv->driver.bus = &soundbus_bus_type;
169
170
171 return driver_register(&drv->driver);
172}
173EXPORT_SYMBOL_GPL(soundbus_register_driver);
174
175void soundbus_unregister_driver(struct soundbus_driver *drv)
176{
177 driver_unregister(&drv->driver);
178}
179EXPORT_SYMBOL_GPL(soundbus_unregister_driver);
180
181static int __init soundbus_init(void)
182{
183 return bus_register(&soundbus_bus_type);
184}
185
186static void __exit soundbus_exit(void)
187{
188 bus_unregister(&soundbus_bus_type);
189}
190
191subsys_initcall(soundbus_init);
192module_exit(soundbus_exit);
193