1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22#include <linux/input.h>
23#include <linux/slab.h>
24#include <linux/module.h>
25#include <sound/jack.h>
26#include <sound/core.h>
27#include <sound/control.h>
28
29struct snd_jack_kctl {
30 struct snd_kcontrol *kctl;
31 struct list_head list;
32 unsigned int mask_bits;
33};
34
35#ifdef CONFIG_SND_JACK_INPUT_DEV
36static int jack_switch_types[SND_JACK_SWITCH_TYPES] = {
37 SW_HEADPHONE_INSERT,
38 SW_MICROPHONE_INSERT,
39 SW_LINEOUT_INSERT,
40 SW_JACK_PHYSICAL_INSERT,
41 SW_VIDEOOUT_INSERT,
42 SW_LINEIN_INSERT,
43};
44#endif
45
46static int snd_jack_dev_disconnect(struct snd_device *device)
47{
48#ifdef CONFIG_SND_JACK_INPUT_DEV
49 struct snd_jack *jack = device->device_data;
50
51 if (!jack->input_dev)
52 return 0;
53
54
55
56 if (jack->registered)
57 input_unregister_device(jack->input_dev);
58 else
59 input_free_device(jack->input_dev);
60 jack->input_dev = NULL;
61#endif
62 return 0;
63}
64
65static int snd_jack_dev_free(struct snd_device *device)
66{
67 struct snd_jack *jack = device->device_data;
68 struct snd_card *card = device->card;
69 struct snd_jack_kctl *jack_kctl, *tmp_jack_kctl;
70
71 list_for_each_entry_safe(jack_kctl, tmp_jack_kctl, &jack->kctl_list, list) {
72 list_del_init(&jack_kctl->list);
73 snd_ctl_remove(card, jack_kctl->kctl);
74 }
75 if (jack->private_free)
76 jack->private_free(jack);
77
78 snd_jack_dev_disconnect(device);
79
80 kfree(jack->id);
81 kfree(jack);
82
83 return 0;
84}
85
86#ifdef CONFIG_SND_JACK_INPUT_DEV
87static int snd_jack_dev_register(struct snd_device *device)
88{
89 struct snd_jack *jack = device->device_data;
90 struct snd_card *card = device->card;
91 int err, i;
92
93 snprintf(jack->name, sizeof(jack->name), "%s %s",
94 card->shortname, jack->id);
95
96 if (!jack->input_dev)
97 return 0;
98
99 jack->input_dev->name = jack->name;
100
101
102 if (!jack->input_dev->dev.parent)
103 jack->input_dev->dev.parent = snd_card_get_device_link(card);
104
105
106 for (i = 0; i < ARRAY_SIZE(jack->key); i++) {
107 int testbit = SND_JACK_BTN_0 >> i;
108
109 if (!(jack->type & testbit))
110 continue;
111
112 if (!jack->key[i])
113 jack->key[i] = BTN_0 + i;
114
115 input_set_capability(jack->input_dev, EV_KEY, jack->key[i]);
116 }
117
118 err = input_register_device(jack->input_dev);
119 if (err == 0)
120 jack->registered = 1;
121
122 return err;
123}
124#endif
125
126static void snd_jack_kctl_private_free(struct snd_kcontrol *kctl)
127{
128 struct snd_jack_kctl *jack_kctl;
129
130 jack_kctl = kctl->private_data;
131 if (jack_kctl) {
132 list_del(&jack_kctl->list);
133 kfree(jack_kctl);
134 }
135}
136
137static void snd_jack_kctl_add(struct snd_jack *jack, struct snd_jack_kctl *jack_kctl)
138{
139 list_add_tail(&jack_kctl->list, &jack->kctl_list);
140}
141
142static struct snd_jack_kctl * snd_jack_kctl_new(struct snd_card *card, const char *name, unsigned int mask)
143{
144 struct snd_kcontrol *kctl;
145 struct snd_jack_kctl *jack_kctl;
146 int err;
147
148 kctl = snd_kctl_jack_new(name, card);
149 if (!kctl)
150 return NULL;
151
152 err = snd_ctl_add(card, kctl);
153 if (err < 0)
154 return NULL;
155
156 jack_kctl = kzalloc(sizeof(*jack_kctl), GFP_KERNEL);
157
158 if (!jack_kctl)
159 goto error;
160
161 jack_kctl->kctl = kctl;
162 jack_kctl->mask_bits = mask;
163
164 kctl->private_data = jack_kctl;
165 kctl->private_free = snd_jack_kctl_private_free;
166
167 return jack_kctl;
168error:
169 snd_ctl_free_one(kctl);
170 return NULL;
171}
172
173
174
175
176
177
178
179
180
181
182
183
184int snd_jack_add_new_kctl(struct snd_jack *jack, const char * name, int mask)
185{
186 struct snd_jack_kctl *jack_kctl;
187
188 jack_kctl = snd_jack_kctl_new(jack->card, name, mask);
189 if (!jack_kctl)
190 return -ENOMEM;
191
192 snd_jack_kctl_add(jack, jack_kctl);
193 return 0;
194}
195EXPORT_SYMBOL(snd_jack_add_new_kctl);
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212int snd_jack_new(struct snd_card *card, const char *id, int type,
213 struct snd_jack **jjack, bool initial_kctl, bool phantom_jack)
214{
215 struct snd_jack *jack;
216 struct snd_jack_kctl *jack_kctl = NULL;
217 int err;
218 static struct snd_device_ops ops = {
219 .dev_free = snd_jack_dev_free,
220#ifdef CONFIG_SND_JACK_INPUT_DEV
221 .dev_register = snd_jack_dev_register,
222 .dev_disconnect = snd_jack_dev_disconnect,
223#endif
224 };
225
226 if (initial_kctl) {
227 jack_kctl = snd_jack_kctl_new(card, id, type);
228 if (!jack_kctl)
229 return -ENOMEM;
230 }
231
232 jack = kzalloc(sizeof(struct snd_jack), GFP_KERNEL);
233 if (jack == NULL)
234 return -ENOMEM;
235
236 jack->id = kstrdup(id, GFP_KERNEL);
237
238
239 if (!phantom_jack) {
240#ifdef CONFIG_SND_JACK_INPUT_DEV
241 int i;
242
243 jack->input_dev = input_allocate_device();
244 if (jack->input_dev == NULL) {
245 err = -ENOMEM;
246 goto fail_input;
247 }
248
249 jack->input_dev->phys = "ALSA";
250
251 jack->type = type;
252
253 for (i = 0; i < SND_JACK_SWITCH_TYPES; i++)
254 if (type & (1 << i))
255 input_set_capability(jack->input_dev, EV_SW,
256 jack_switch_types[i]);
257
258#endif
259 }
260
261 err = snd_device_new(card, SNDRV_DEV_JACK, jack, &ops);
262 if (err < 0)
263 goto fail_input;
264
265 jack->card = card;
266 INIT_LIST_HEAD(&jack->kctl_list);
267
268 if (initial_kctl)
269 snd_jack_kctl_add(jack, jack_kctl);
270
271 *jjack = jack;
272
273 return 0;
274
275fail_input:
276#ifdef CONFIG_SND_JACK_INPUT_DEV
277 input_free_device(jack->input_dev);
278#endif
279 kfree(jack->id);
280 kfree(jack);
281 return err;
282}
283EXPORT_SYMBOL(snd_jack_new);
284
285#ifdef CONFIG_SND_JACK_INPUT_DEV
286
287
288
289
290
291
292
293
294
295
296void snd_jack_set_parent(struct snd_jack *jack, struct device *parent)
297{
298 WARN_ON(jack->registered);
299 if (!jack->input_dev)
300 return;
301
302 jack->input_dev->dev.parent = parent;
303}
304EXPORT_SYMBOL(snd_jack_set_parent);
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331int snd_jack_set_key(struct snd_jack *jack, enum snd_jack_types type,
332 int keytype)
333{
334 int key = fls(SND_JACK_BTN_0) - fls(type);
335
336 WARN_ON(jack->registered);
337
338 if (!keytype || key >= ARRAY_SIZE(jack->key))
339 return -EINVAL;
340
341 jack->type |= type;
342 jack->key[key] = keytype;
343 return 0;
344}
345EXPORT_SYMBOL(snd_jack_set_key);
346#endif
347
348
349
350
351
352
353
354void snd_jack_report(struct snd_jack *jack, int status)
355{
356 struct snd_jack_kctl *jack_kctl;
357#ifdef CONFIG_SND_JACK_INPUT_DEV
358 int i;
359#endif
360
361 if (!jack)
362 return;
363
364 list_for_each_entry(jack_kctl, &jack->kctl_list, list)
365 snd_kctl_jack_report(jack->card, jack_kctl->kctl,
366 status & jack_kctl->mask_bits);
367
368#ifdef CONFIG_SND_JACK_INPUT_DEV
369 if (!jack->input_dev)
370 return;
371
372 for (i = 0; i < ARRAY_SIZE(jack->key); i++) {
373 int testbit = SND_JACK_BTN_0 >> i;
374
375 if (jack->type & testbit)
376 input_report_key(jack->input_dev, jack->key[i],
377 status & testbit);
378 }
379
380 for (i = 0; i < ARRAY_SIZE(jack_switch_types); i++) {
381 int testbit = 1 << i;
382 if (jack->type & testbit)
383 input_report_switch(jack->input_dev,
384 jack_switch_types[i],
385 status & testbit);
386 }
387
388 input_sync(jack->input_dev);
389#endif
390}
391EXPORT_SYMBOL(snd_jack_report);
392