1/*
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
59static int soundbus_uevent(struct device *dev, char **envp, int num_envp,
60			   char *buffer, int buffer_size)
61{
62	struct soundbus_dev * soundbus_dev;
63	struct of_device * of;
64	const char *compat;
65	int retval = 0, i = 0, length = 0;
66	int cplen, seen = 0;
67
68	if (!dev)
69		return -ENODEV;
70
71	soundbus_dev = to_soundbus_device(dev);
72	if (!soundbus_dev)
73		return -ENODEV;
74
75	of = &soundbus_dev->ofdev;
76
77	/* stuff we want to pass to /sbin/hotplug */
78	retval = add_uevent_var(envp, num_envp, &i,
79				buffer, buffer_size, &length,
80				"OF_NAME=%s", of->node->name);
81	if (retval)
82		return retval;
83
84	retval = add_uevent_var(envp, num_envp, &i,
85				buffer, buffer_size, &length,
86				"OF_TYPE=%s", of->node->type);
87	if (retval)
88		return retval;
89
90	/* Since the compatible field can contain pretty much anything
91	 * it's not really legal to split it out with commas. We split it
92	 * up using a number of environment variables instead. */
93
94	compat = of_get_property(of->node, "compatible", &cplen);
95	while (compat && cplen > 0) {
96		int tmp = length;
97		retval = add_uevent_var(envp, num_envp, &i,
98					buffer, buffer_size, &length,
99					"OF_COMPATIBLE_%d=%s", seen, compat);
100		if (retval)
101			return retval;
102		compat += length - tmp;
103		cplen -= length - tmp;
104		seen += 1;
105	}
106
107	retval = add_uevent_var(envp, num_envp, &i,
108				buffer, buffer_size, &length,
109				"OF_COMPATIBLE_N=%d", seen);
110	if (retval)
111		return retval;
112	retval = add_uevent_var(envp, num_envp, &i,
113				buffer, buffer_size, &length,
114				"MODALIAS=%s", soundbus_dev->modalias);
115
116	envp[i] = NULL;
117
118	return retval;
119}
120
121static int soundbus_device_remove(struct device *dev)
122{
123	struct soundbus_dev * soundbus_dev = to_soundbus_device(dev);
124	struct soundbus_driver * drv = to_soundbus_driver(dev->driver);
125
126	if (dev->driver && drv->remove)
127		drv->remove(soundbus_dev);
128	soundbus_dev_put(soundbus_dev);
129
130	return 0;
131}
132
133static void soundbus_device_shutdown(struct device *dev)
134{
135	struct soundbus_dev * soundbus_dev = to_soundbus_device(dev);
136	struct soundbus_driver * drv = to_soundbus_driver(dev->driver);
137
138	if (dev->driver && drv->shutdown)
139		drv->shutdown(soundbus_dev);
140}
141
142#ifdef CONFIG_PM
143
144static int soundbus_device_suspend(struct device *dev, pm_message_t state)
145{
146	struct soundbus_dev * soundbus_dev = to_soundbus_device(dev);
147	struct soundbus_driver * drv = to_soundbus_driver(dev->driver);
148
149	if (dev->driver && drv->suspend)
150		return drv->suspend(soundbus_dev, state);
151	return 0;
152}
153
154static int soundbus_device_resume(struct device * dev)
155{
156	struct soundbus_dev * soundbus_dev = to_soundbus_device(dev);
157	struct soundbus_driver * drv = to_soundbus_driver(dev->driver);
158
159	if (dev->driver && drv->resume)
160		return drv->resume(soundbus_dev);
161	return 0;
162}
163
164#endif /* CONFIG_PM */
165
166static struct bus_type soundbus_bus_type = {
167	.name		= "aoa-soundbus",
168	.probe		= soundbus_probe,
169	.uevent		= soundbus_uevent,
170	.remove		= soundbus_device_remove,
171	.shutdown	= soundbus_device_shutdown,
172#ifdef CONFIG_PM
173	.suspend	= soundbus_device_suspend,
174	.resume		= soundbus_device_resume,
175#endif
176	.dev_attrs	= soundbus_dev_attrs,
177};
178
179int soundbus_add_one(struct soundbus_dev *dev)
180{
181	static int devcount;
182
183	/* sanity checks */
184	if (!dev->attach_codec ||
185	    !dev->ofdev.node ||
186	    dev->pcmname ||
187	    dev->pcmid != -1) {
188		printk(KERN_ERR "soundbus: adding device failed sanity check!\n");
189		return -EINVAL;
190	}
191
192	snprintf(dev->ofdev.dev.bus_id, BUS_ID_SIZE, "soundbus:%x", ++devcount);
193	dev->ofdev.dev.bus = &soundbus_bus_type;
194	return of_device_register(&dev->ofdev);
195}
196EXPORT_SYMBOL_GPL(soundbus_add_one);
197
198void soundbus_remove_one(struct soundbus_dev *dev)
199{
200	of_device_unregister(&dev->ofdev);
201}
202EXPORT_SYMBOL_GPL(soundbus_remove_one);
203
204int soundbus_register_driver(struct soundbus_driver *drv)
205{
206	/* initialize common driver fields */
207	drv->driver.name = drv->name;
208	drv->driver.bus = &soundbus_bus_type;
209
210	/* register with core */
211	return driver_register(&drv->driver);
212}
213EXPORT_SYMBOL_GPL(soundbus_register_driver);
214
215void soundbus_unregister_driver(struct soundbus_driver *drv)
216{
217	driver_unregister(&drv->driver);
218}
219EXPORT_SYMBOL_GPL(soundbus_unregister_driver);
220
221static int __init soundbus_init(void)
222{
223	return bus_register(&soundbus_bus_type);
224}
225
226static void __exit soundbus_exit(void)
227{
228	bus_unregister(&soundbus_bus_type);
229}
230
231subsys_initcall(soundbus_init);
232module_exit(soundbus_exit);
233