Commit | Line | Data |
---|---|---|
d6869352 | 1 | // SPDX-License-Identifier: GPL-2.0-only |
f3d9478b JB |
2 | /* |
3 | * soundbus | |
4 | * | |
5 | * Copyright 2006 Johannes Berg <johannes@sipsolutions.net> | |
f3d9478b JB |
6 | */ |
7 | ||
8 | #include <linux/module.h> | |
fdfc374a RH |
9 | #include <linux/of.h> |
10 | #include <linux/of_platform.h> | |
f3d9478b JB |
11 | #include "soundbus.h" |
12 | ||
13 | MODULE_AUTHOR("Johannes Berg <johannes@sipsolutions.net>"); | |
14 | MODULE_LICENSE("GPL"); | |
15 | MODULE_DESCRIPTION("Apple Soundbus"); | |
16 | ||
17 | struct soundbus_dev *soundbus_dev_get(struct soundbus_dev *dev) | |
18 | { | |
19 | struct device *tmp; | |
20 | ||
21 | if (!dev) | |
22 | return NULL; | |
23 | tmp = get_device(&dev->ofdev.dev); | |
24 | if (tmp) | |
25 | return to_soundbus_device(tmp); | |
26 | else | |
27 | return NULL; | |
28 | } | |
29 | EXPORT_SYMBOL_GPL(soundbus_dev_get); | |
30 | ||
31 | void soundbus_dev_put(struct soundbus_dev *dev) | |
32 | { | |
33 | if (dev) | |
34 | put_device(&dev->ofdev.dev); | |
35 | } | |
36 | EXPORT_SYMBOL_GPL(soundbus_dev_put); | |
37 | ||
38 | static int soundbus_probe(struct device *dev) | |
39 | { | |
40 | int error = -ENODEV; | |
41 | struct soundbus_driver *drv; | |
42 | struct soundbus_dev *soundbus_dev; | |
43 | ||
44 | drv = to_soundbus_driver(dev->driver); | |
45 | soundbus_dev = to_soundbus_device(dev); | |
46 | ||
47 | if (!drv->probe) | |
48 | return error; | |
49 | ||
50 | soundbus_dev_get(soundbus_dev); | |
51 | ||
52 | error = drv->probe(soundbus_dev); | |
53 | if (error) | |
54 | soundbus_dev_put(soundbus_dev); | |
55 | ||
56 | return error; | |
57 | } | |
58 | ||
59 | ||
2a81ada3 | 60 | static int soundbus_uevent(const struct device *dev, struct kobj_uevent_env *env) |
f3d9478b | 61 | { |
2a81ada3 GKH |
62 | const struct soundbus_dev * soundbus_dev; |
63 | const struct platform_device * of; | |
a7edd0e6 | 64 | const char *compat; |
7eff2e7a | 65 | int retval = 0; |
bf62456e | 66 | int cplen, seen = 0; |
f3d9478b JB |
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 */ | |
192a7122 | 78 | retval = add_uevent_var(env, "OF_NAME=%pOFn", of->dev.of_node); |
bf62456e ER |
79 | if (retval) |
80 | return retval; | |
81 | ||
c12faa2b | 82 | retval = add_uevent_var(env, "OF_TYPE=%s", of_node_get_device_type(of->dev.of_node)); |
bf62456e ER |
83 | if (retval) |
84 | return retval; | |
f3d9478b JB |
85 | |
86 | /* Since the compatible field can contain pretty much anything | |
87 | * it's not really legal to split it out with commas. We split it | |
88 | * up using a number of environment variables instead. */ | |
89 | ||
61c7a080 | 90 | compat = of_get_property(of->dev.of_node, "compatible", &cplen); |
f3d9478b | 91 | while (compat && cplen > 0) { |
7eff2e7a KS |
92 | int tmp = env->buflen; |
93 | retval = add_uevent_var(env, "OF_COMPATIBLE_%d=%s", seen, compat); | |
bf62456e ER |
94 | if (retval) |
95 | return retval; | |
7eff2e7a KS |
96 | compat += env->buflen - tmp; |
97 | cplen -= env->buflen - tmp; | |
bf62456e | 98 | seen += 1; |
f3d9478b JB |
99 | } |
100 | ||
7eff2e7a | 101 | retval = add_uevent_var(env, "OF_COMPATIBLE_N=%d", seen); |
bf62456e ER |
102 | if (retval) |
103 | return retval; | |
7eff2e7a | 104 | retval = add_uevent_var(env, "MODALIAS=%s", soundbus_dev->modalias); |
f3d9478b | 105 | |
bf62456e | 106 | return retval; |
f3d9478b JB |
107 | } |
108 | ||
fc7a6209 | 109 | static void soundbus_device_remove(struct device *dev) |
f3d9478b JB |
110 | { |
111 | struct soundbus_dev * soundbus_dev = to_soundbus_device(dev); | |
112 | struct soundbus_driver * drv = to_soundbus_driver(dev->driver); | |
113 | ||
114 | if (dev->driver && drv->remove) | |
115 | drv->remove(soundbus_dev); | |
116 | soundbus_dev_put(soundbus_dev); | |
f3d9478b JB |
117 | } |
118 | ||
119 | static 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 | ||
a038b979 QL |
128 | /* soundbus_dev_attrs is declared in sysfs.c */ |
129 | ATTRIBUTE_GROUPS(soundbus_dev); | |
f3d9478b JB |
130 | static 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, | |
a038b979 | 136 | .dev_groups = soundbus_dev_groups, |
f3d9478b JB |
137 | }; |
138 | ||
f3d9478b JB |
139 | int soundbus_add_one(struct soundbus_dev *dev) |
140 | { | |
141 | static int devcount; | |
142 | ||
143 | /* sanity checks */ | |
144 | if (!dev->attach_codec || | |
61c7a080 | 145 | !dev->ofdev.dev.of_node || |
f3d9478b JB |
146 | dev->pcmname || |
147 | dev->pcmid != -1) { | |
148 | printk(KERN_ERR "soundbus: adding device failed sanity check!\n"); | |
149 | return -EINVAL; | |
150 | } | |
151 | ||
bb072bf0 | 152 | dev_set_name(&dev->ofdev.dev, "soundbus:%x", ++devcount); |
f3d9478b JB |
153 | dev->ofdev.dev.bus = &soundbus_bus_type; |
154 | return of_device_register(&dev->ofdev); | |
155 | } | |
156 | EXPORT_SYMBOL_GPL(soundbus_add_one); | |
157 | ||
158 | void soundbus_remove_one(struct soundbus_dev *dev) | |
159 | { | |
160 | of_device_unregister(&dev->ofdev); | |
161 | } | |
162 | EXPORT_SYMBOL_GPL(soundbus_remove_one); | |
163 | ||
164 | int soundbus_register_driver(struct soundbus_driver *drv) | |
165 | { | |
166 | /* initialize common driver fields */ | |
167 | drv->driver.name = drv->name; | |
168 | drv->driver.bus = &soundbus_bus_type; | |
169 | ||
170 | /* register with core */ | |
171 | return driver_register(&drv->driver); | |
172 | } | |
173 | EXPORT_SYMBOL_GPL(soundbus_register_driver); | |
174 | ||
175 | void soundbus_unregister_driver(struct soundbus_driver *drv) | |
176 | { | |
177 | driver_unregister(&drv->driver); | |
178 | } | |
179 | EXPORT_SYMBOL_GPL(soundbus_unregister_driver); | |
180 | ||
a08bc4cb BH |
181 | static int __init soundbus_init(void) |
182 | { | |
183 | return bus_register(&soundbus_bus_type); | |
184 | } | |
185 | ||
186 | static void __exit soundbus_exit(void) | |
187 | { | |
188 | bus_unregister(&soundbus_bus_type); | |
189 | } | |
190 | ||
191 | subsys_initcall(soundbus_init); | |
f3d9478b | 192 | module_exit(soundbus_exit); |