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, struct kobj_uevent_env *env)
60{
61	struct soundbus_dev * soundbus_dev;
62	struct platform_device * of;
63	const char *compat;
64	int retval = 0;
65	int cplen, seen = 0;
66
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 */
77	retval = add_uevent_var(env, "OF_NAME=%s", of->dev.of_node->name);
78	if (retval)
79		return retval;
80
81	retval = add_uevent_var(env, "OF_TYPE=%s", of->dev.of_node->type);
82	if (retval)
83		return retval;
84
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
89	compat = of_get_property(of->dev.of_node, "compatible", &cplen);
90	while (compat && cplen > 0) {
91		int tmp = env->buflen;
92		retval = add_uevent_var(env, "OF_COMPATIBLE_%d=%s", seen, compat);
93		if (retval)
94			return retval;
95		compat += env->buflen - tmp;
96		cplen -= env->buflen - tmp;
97		seen += 1;
98	}
99
100	retval = add_uevent_var(env, "OF_COMPATIBLE_N=%d", seen);
101	if (retval)
102		return retval;
103	retval = add_uevent_var(env, "MODALIAS=%s", soundbus_dev->modalias);
104
105	return retval;
106}
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
153static 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
166int soundbus_add_one(struct soundbus_dev *dev)
167{
168	static int devcount;
169
170	/* sanity checks */
171	if (!dev->attach_codec ||
172	    !dev->ofdev.dev.of_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	dev_set_name(&dev->ofdev.dev, "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
208static 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);
219module_exit(soundbus_exit);
220