blob: f84f3e505788f36d0ecaee4eb33b13cf60263383 [file] [log] [blame]
Johannes Bergf3d94782006-06-21 15:42:43 +02001/*
2 * soundbus
3 *
4 * Copyright 2006 Johannes Berg <johannes@sipsolutions.net>
5 *
6 * GPL v2, can be found in COPYING.
7 */
8
9#include <linux/module.h>
10#include "soundbus.h"
11
12MODULE_AUTHOR("Johannes Berg <johannes@sipsolutions.net>");
13MODULE_LICENSE("GPL");
14MODULE_DESCRIPTION("Apple Soundbus");
15
16struct soundbus_dev *soundbus_dev_get(struct soundbus_dev *dev)
17{
18 struct device *tmp;
19
20 if (!dev)
21 return NULL;
22 tmp = get_device(&dev->ofdev.dev);
23 if (tmp)
24 return to_soundbus_device(tmp);
25 else
26 return NULL;
27}
28EXPORT_SYMBOL_GPL(soundbus_dev_get);
29
30void soundbus_dev_put(struct soundbus_dev *dev)
31{
32 if (dev)
33 put_device(&dev->ofdev.dev);
34}
35EXPORT_SYMBOL_GPL(soundbus_dev_put);
36
37static int soundbus_probe(struct device *dev)
38{
39 int error = -ENODEV;
40 struct soundbus_driver *drv;
41 struct soundbus_dev *soundbus_dev;
42
43 drv = to_soundbus_driver(dev->driver);
44 soundbus_dev = to_soundbus_device(dev);
45
46 if (!drv->probe)
47 return error;
48
49 soundbus_dev_get(soundbus_dev);
50
51 error = drv->probe(soundbus_dev);
52 if (error)
53 soundbus_dev_put(soundbus_dev);
54
55 return error;
56}
57
58
Kay Sievers7eff2e72007-08-14 15:15:12 +020059static int soundbus_uevent(struct device *dev, struct kobj_uevent_env *env)
Johannes Bergf3d94782006-06-21 15:42:43 +020060{
61 struct soundbus_dev * soundbus_dev;
62 struct of_device * of;
Stephen Rothwella7edd0e2007-04-03 10:52:17 +100063 const char *compat;
Kay Sievers7eff2e72007-08-14 15:15:12 +020064 int retval = 0;
Eric Rannaudbf624562007-03-30 22:23:12 -070065 int cplen, seen = 0;
Johannes Bergf3d94782006-06-21 15:42:43 +020066
67 if (!dev)
68 return -ENODEV;
69
70 soundbus_dev = to_soundbus_device(dev);
71 if (!soundbus_dev)
72 return -ENODEV;
73
74 of = &soundbus_dev->ofdev;
75
76 /* stuff we want to pass to /sbin/hotplug */
Kay Sievers7eff2e72007-08-14 15:15:12 +020077 retval = add_uevent_var(env, "OF_NAME=%s", of->node->name);
Eric Rannaudbf624562007-03-30 22:23:12 -070078 if (retval)
79 return retval;
Johannes Bergf3d94782006-06-21 15:42:43 +020080
Kay Sievers7eff2e72007-08-14 15:15:12 +020081 retval = add_uevent_var(env, "OF_TYPE=%s", of->node->type);
Eric Rannaudbf624562007-03-30 22:23:12 -070082 if (retval)
83 return retval;
Johannes Bergf3d94782006-06-21 15:42:43 +020084
85 /* Since the compatible field can contain pretty much anything
86 * it's not really legal to split it out with commas. We split it
87 * up using a number of environment variables instead. */
88
Stephen Rothwellc4f55b32007-04-03 22:39:14 +100089 compat = of_get_property(of->node, "compatible", &cplen);
Johannes Bergf3d94782006-06-21 15:42:43 +020090 while (compat && cplen > 0) {
Kay Sievers7eff2e72007-08-14 15:15:12 +020091 int tmp = env->buflen;
92 retval = add_uevent_var(env, "OF_COMPATIBLE_%d=%s", seen, compat);
Eric Rannaudbf624562007-03-30 22:23:12 -070093 if (retval)
94 return retval;
Kay Sievers7eff2e72007-08-14 15:15:12 +020095 compat += env->buflen - tmp;
96 cplen -= env->buflen - tmp;
Eric Rannaudbf624562007-03-30 22:23:12 -070097 seen += 1;
Johannes Bergf3d94782006-06-21 15:42:43 +020098 }
99
Kay Sievers7eff2e72007-08-14 15:15:12 +0200100 retval = add_uevent_var(env, "OF_COMPATIBLE_N=%d", seen);
Eric Rannaudbf624562007-03-30 22:23:12 -0700101 if (retval)
102 return retval;
Kay Sievers7eff2e72007-08-14 15:15:12 +0200103 retval = add_uevent_var(env, "MODALIAS=%s", soundbus_dev->modalias);
Johannes Bergf3d94782006-06-21 15:42:43 +0200104
Eric Rannaudbf624562007-03-30 22:23:12 -0700105 return retval;
Johannes Bergf3d94782006-06-21 15:42:43 +0200106}
107
108static int soundbus_device_remove(struct device *dev)
109{
110 struct soundbus_dev * soundbus_dev = to_soundbus_device(dev);
111 struct soundbus_driver * drv = to_soundbus_driver(dev->driver);
112
113 if (dev->driver && drv->remove)
114 drv->remove(soundbus_dev);
115 soundbus_dev_put(soundbus_dev);
116
117 return 0;
118}
119
120static void soundbus_device_shutdown(struct device *dev)
121{
122 struct soundbus_dev * soundbus_dev = to_soundbus_device(dev);
123 struct soundbus_driver * drv = to_soundbus_driver(dev->driver);
124
125 if (dev->driver && drv->shutdown)
126 drv->shutdown(soundbus_dev);
127}
128
129#ifdef CONFIG_PM
130
131static int soundbus_device_suspend(struct device *dev, pm_message_t state)
132{
133 struct soundbus_dev * soundbus_dev = to_soundbus_device(dev);
134 struct soundbus_driver * drv = to_soundbus_driver(dev->driver);
135
136 if (dev->driver && drv->suspend)
137 return drv->suspend(soundbus_dev, state);
138 return 0;
139}
140
141static int soundbus_device_resume(struct device * dev)
142{
143 struct soundbus_dev * soundbus_dev = to_soundbus_device(dev);
144 struct soundbus_driver * drv = to_soundbus_driver(dev->driver);
145
146 if (dev->driver && drv->resume)
147 return drv->resume(soundbus_dev);
148 return 0;
149}
150
151#endif /* CONFIG_PM */
152
Johannes Bergf3d94782006-06-21 15:42:43 +0200153static struct bus_type soundbus_bus_type = {
154 .name = "aoa-soundbus",
155 .probe = soundbus_probe,
156 .uevent = soundbus_uevent,
157 .remove = soundbus_device_remove,
158 .shutdown = soundbus_device_shutdown,
159#ifdef CONFIG_PM
160 .suspend = soundbus_device_suspend,
161 .resume = soundbus_device_resume,
162#endif
163 .dev_attrs = soundbus_dev_attrs,
164};
165
Johannes Bergf3d94782006-06-21 15:42:43 +0200166int soundbus_add_one(struct soundbus_dev *dev)
167{
168 static int devcount;
169
170 /* sanity checks */
171 if (!dev->attach_codec ||
172 !dev->ofdev.node ||
173 dev->pcmname ||
174 dev->pcmid != -1) {
175 printk(KERN_ERR "soundbus: adding device failed sanity check!\n");
176 return -EINVAL;
177 }
178
179 snprintf(dev->ofdev.dev.bus_id, BUS_ID_SIZE, "soundbus:%x", ++devcount);
180 dev->ofdev.dev.bus = &soundbus_bus_type;
181 return of_device_register(&dev->ofdev);
182}
183EXPORT_SYMBOL_GPL(soundbus_add_one);
184
185void soundbus_remove_one(struct soundbus_dev *dev)
186{
187 of_device_unregister(&dev->ofdev);
188}
189EXPORT_SYMBOL_GPL(soundbus_remove_one);
190
191int soundbus_register_driver(struct soundbus_driver *drv)
192{
193 /* initialize common driver fields */
194 drv->driver.name = drv->name;
195 drv->driver.bus = &soundbus_bus_type;
196
197 /* register with core */
198 return driver_register(&drv->driver);
199}
200EXPORT_SYMBOL_GPL(soundbus_register_driver);
201
202void soundbus_unregister_driver(struct soundbus_driver *drv)
203{
204 driver_unregister(&drv->driver);
205}
206EXPORT_SYMBOL_GPL(soundbus_unregister_driver);
207
Benjamin Herrenschmidta08bc4c2006-07-10 04:44:35 -0700208static int __init soundbus_init(void)
209{
210 return bus_register(&soundbus_bus_type);
211}
212
213static void __exit soundbus_exit(void)
214{
215 bus_unregister(&soundbus_bus_type);
216}
217
218subsys_initcall(soundbus_init);
Johannes Bergf3d94782006-06-21 15:42:43 +0200219module_exit(soundbus_exit);