1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22#include <linux/slab.h>
23#include <linux/time.h>
24#include <linux/export.h>
25#include <linux/errno.h>
26#include <sound/core.h>
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44int snd_device_new(struct snd_card *card, snd_device_type_t type,
45 void *device_data, struct snd_device_ops *ops)
46{
47 struct snd_device *dev;
48
49 if (snd_BUG_ON(!card || !device_data || !ops))
50 return -ENXIO;
51 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
52 if (dev == NULL) {
53 snd_printk(KERN_ERR "Cannot allocate device\n");
54 return -ENOMEM;
55 }
56 dev->card = card;
57 dev->type = type;
58 dev->state = SNDRV_DEV_BUILD;
59 dev->device_data = device_data;
60 dev->ops = ops;
61 list_add(&dev->list, &card->devices);
62 return 0;
63}
64
65EXPORT_SYMBOL(snd_device_new);
66
67
68
69
70
71
72
73
74
75
76
77
78
79int snd_device_free(struct snd_card *card, void *device_data)
80{
81 struct snd_device *dev;
82
83 if (snd_BUG_ON(!card || !device_data))
84 return -ENXIO;
85 list_for_each_entry(dev, &card->devices, list) {
86 if (dev->device_data != device_data)
87 continue;
88
89 list_del(&dev->list);
90 if (dev->state == SNDRV_DEV_REGISTERED &&
91 dev->ops->dev_disconnect)
92 if (dev->ops->dev_disconnect(dev))
93 snd_printk(KERN_ERR
94 "device disconnect failure\n");
95 if (dev->ops->dev_free) {
96 if (dev->ops->dev_free(dev))
97 snd_printk(KERN_ERR "device free failure\n");
98 }
99 kfree(dev);
100 return 0;
101 }
102 snd_printd("device free %p (from %pF), not found\n", device_data,
103 __builtin_return_address(0));
104 return -ENXIO;
105}
106
107EXPORT_SYMBOL(snd_device_free);
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122int snd_device_disconnect(struct snd_card *card, void *device_data)
123{
124 struct snd_device *dev;
125
126 if (snd_BUG_ON(!card || !device_data))
127 return -ENXIO;
128 list_for_each_entry(dev, &card->devices, list) {
129 if (dev->device_data != device_data)
130 continue;
131 if (dev->state == SNDRV_DEV_REGISTERED &&
132 dev->ops->dev_disconnect) {
133 if (dev->ops->dev_disconnect(dev))
134 snd_printk(KERN_ERR "device disconnect failure\n");
135 dev->state = SNDRV_DEV_DISCONNECTED;
136 }
137 return 0;
138 }
139 snd_printd("device disconnect %p (from %pF), not found\n", device_data,
140 __builtin_return_address(0));
141 return -ENXIO;
142}
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157int snd_device_register(struct snd_card *card, void *device_data)
158{
159 struct snd_device *dev;
160 int err;
161
162 if (snd_BUG_ON(!card || !device_data))
163 return -ENXIO;
164 list_for_each_entry(dev, &card->devices, list) {
165 if (dev->device_data != device_data)
166 continue;
167 if (dev->state == SNDRV_DEV_BUILD && dev->ops->dev_register) {
168 if ((err = dev->ops->dev_register(dev)) < 0)
169 return err;
170 dev->state = SNDRV_DEV_REGISTERED;
171 return 0;
172 }
173 snd_printd("snd_device_register busy\n");
174 return -EBUSY;
175 }
176 snd_BUG();
177 return -ENXIO;
178}
179
180EXPORT_SYMBOL(snd_device_register);
181
182
183
184
185
186int snd_device_register_all(struct snd_card *card)
187{
188 struct snd_device *dev;
189 int err;
190
191 if (snd_BUG_ON(!card))
192 return -ENXIO;
193 list_for_each_entry(dev, &card->devices, list) {
194 if (dev->state == SNDRV_DEV_BUILD && dev->ops->dev_register) {
195 if ((err = dev->ops->dev_register(dev)) < 0)
196 return err;
197 dev->state = SNDRV_DEV_REGISTERED;
198 }
199 }
200 return 0;
201}
202
203
204
205
206
207int snd_device_disconnect_all(struct snd_card *card)
208{
209 struct snd_device *dev;
210 int err = 0;
211
212 if (snd_BUG_ON(!card))
213 return -ENXIO;
214 list_for_each_entry(dev, &card->devices, list) {
215 if (snd_device_disconnect(card, dev->device_data) < 0)
216 err = -ENXIO;
217 }
218 return err;
219}
220
221
222
223
224
225int snd_device_free_all(struct snd_card *card, snd_device_cmd_t cmd)
226{
227 struct snd_device *dev;
228 int err;
229 unsigned int range_low, range_high, type;
230
231 if (snd_BUG_ON(!card))
232 return -ENXIO;
233 range_low = (__force unsigned int)cmd * SNDRV_DEV_TYPE_RANGE_SIZE;
234 range_high = range_low + SNDRV_DEV_TYPE_RANGE_SIZE - 1;
235 __again:
236 list_for_each_entry(dev, &card->devices, list) {
237 type = (__force unsigned int)dev->type;
238 if (type >= range_low && type <= range_high) {
239 if ((err = snd_device_free(card, dev->device_data)) < 0)
240 return err;
241 goto __again;
242 }
243 }
244 return 0;
245}
246