1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * soundbus
4  *
5  * Copyright 2006 Johannes Berg <johannes@sipsolutions.net>
6  */
7 
8 #include <linux/module.h>
9 #include "soundbus.h"
10 
11 MODULE_AUTHOR("Johannes Berg <johannes@sipsolutions.net>");
12 MODULE_LICENSE("GPL");
13 MODULE_DESCRIPTION("Apple Soundbus");
14 
soundbus_dev_get(struct soundbus_dev * dev)15 struct 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 }
27 EXPORT_SYMBOL_GPL(soundbus_dev_get);
28 
soundbus_dev_put(struct soundbus_dev * dev)29 void soundbus_dev_put(struct soundbus_dev *dev)
30 {
31 	if (dev)
32 		put_device(&dev->ofdev.dev);
33 }
34 EXPORT_SYMBOL_GPL(soundbus_dev_put);
35 
soundbus_probe(struct device * dev)36 static 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 
soundbus_uevent(struct device * dev,struct kobj_uevent_env * env)58 static 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 	/* stuff we want to pass to /sbin/hotplug */
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 	/* Since the compatible field can contain pretty much anything
85 	 * it's not really legal to split it out with commas. We split it
86 	 * up using a number of environment variables instead. */
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 
soundbus_device_remove(struct device * dev)107 static void 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 
soundbus_device_shutdown(struct device * dev)117 static void soundbus_device_shutdown(struct device *dev)
118 {
119 	struct soundbus_dev * soundbus_dev = to_soundbus_device(dev);
120 	struct soundbus_driver * drv = to_soundbus_driver(dev->driver);
121 
122 	if (dev->driver && drv->shutdown)
123 		drv->shutdown(soundbus_dev);
124 }
125 
126 /* soundbus_dev_attrs is declared in sysfs.c */
127 ATTRIBUTE_GROUPS(soundbus_dev);
128 static struct bus_type soundbus_bus_type = {
129 	.name		= "aoa-soundbus",
130 	.probe		= soundbus_probe,
131 	.uevent		= soundbus_uevent,
132 	.remove		= soundbus_device_remove,
133 	.shutdown	= soundbus_device_shutdown,
134 	.dev_groups	= soundbus_dev_groups,
135 };
136 
soundbus_add_one(struct soundbus_dev * dev)137 int soundbus_add_one(struct soundbus_dev *dev)
138 {
139 	static int devcount;
140 
141 	/* sanity checks */
142 	if (!dev->attach_codec ||
143 	    !dev->ofdev.dev.of_node ||
144 	    dev->pcmname ||
145 	    dev->pcmid != -1) {
146 		printk(KERN_ERR "soundbus: adding device failed sanity check!\n");
147 		return -EINVAL;
148 	}
149 
150 	dev_set_name(&dev->ofdev.dev, "soundbus:%x", ++devcount);
151 	dev->ofdev.dev.bus = &soundbus_bus_type;
152 	return of_device_register(&dev->ofdev);
153 }
154 EXPORT_SYMBOL_GPL(soundbus_add_one);
155 
soundbus_remove_one(struct soundbus_dev * dev)156 void soundbus_remove_one(struct soundbus_dev *dev)
157 {
158 	of_device_unregister(&dev->ofdev);
159 }
160 EXPORT_SYMBOL_GPL(soundbus_remove_one);
161 
soundbus_register_driver(struct soundbus_driver * drv)162 int soundbus_register_driver(struct soundbus_driver *drv)
163 {
164 	/* initialize common driver fields */
165 	drv->driver.name = drv->name;
166 	drv->driver.bus = &soundbus_bus_type;
167 
168 	/* register with core */
169 	return driver_register(&drv->driver);
170 }
171 EXPORT_SYMBOL_GPL(soundbus_register_driver);
172 
soundbus_unregister_driver(struct soundbus_driver * drv)173 void soundbus_unregister_driver(struct soundbus_driver *drv)
174 {
175 	driver_unregister(&drv->driver);
176 }
177 EXPORT_SYMBOL_GPL(soundbus_unregister_driver);
178 
soundbus_init(void)179 static int __init soundbus_init(void)
180 {
181 	return bus_register(&soundbus_bus_type);
182 }
183 
soundbus_exit(void)184 static void __exit soundbus_exit(void)
185 {
186 	bus_unregister(&soundbus_bus_type);
187 }
188 
189 subsys_initcall(soundbus_init);
190 module_exit(soundbus_exit);
191