1
2
3
4
5
6
7
8#include <linux/input.h>
9#include <linux/slab.h>
10#include <linux/module.h>
11#include <linux/ctype.h>
12#include <linux/mm.h>
13#include <linux/debugfs.h>
14#include <sound/jack.h>
15#include <sound/core.h>
16#include <sound/control.h>
17
18struct snd_jack_kctl {
19 struct snd_kcontrol *kctl;
20 struct list_head list;
21 unsigned int mask_bits;
22 struct snd_jack *jack;
23 bool sw_inject_enable;
24#ifdef CONFIG_SND_JACK_INJECTION_DEBUG
25 struct dentry *jack_debugfs_root;
26#endif
27};
28
29#ifdef CONFIG_SND_JACK_INPUT_DEV
30static const int jack_switch_types[SND_JACK_SWITCH_TYPES] = {
31 SW_HEADPHONE_INSERT,
32 SW_MICROPHONE_INSERT,
33 SW_LINEOUT_INSERT,
34 SW_JACK_PHYSICAL_INSERT,
35 SW_VIDEOOUT_INSERT,
36 SW_LINEIN_INSERT,
37};
38#endif
39
40static int snd_jack_dev_disconnect(struct snd_device *device)
41{
42#ifdef CONFIG_SND_JACK_INPUT_DEV
43 struct snd_jack *jack = device->device_data;
44
45 if (!jack->input_dev)
46 return 0;
47
48
49
50 if (jack->registered)
51 input_unregister_device(jack->input_dev);
52 else
53 input_free_device(jack->input_dev);
54 jack->input_dev = NULL;
55#endif
56 return 0;
57}
58
59static int snd_jack_dev_free(struct snd_device *device)
60{
61 struct snd_jack *jack = device->device_data;
62 struct snd_card *card = device->card;
63 struct snd_jack_kctl *jack_kctl, *tmp_jack_kctl;
64
65 list_for_each_entry_safe(jack_kctl, tmp_jack_kctl, &jack->kctl_list, list) {
66 list_del_init(&jack_kctl->list);
67 snd_ctl_remove(card, jack_kctl->kctl);
68 }
69 if (jack->private_free)
70 jack->private_free(jack);
71
72 snd_jack_dev_disconnect(device);
73
74 kfree(jack->id);
75 kfree(jack);
76
77 return 0;
78}
79
80#ifdef CONFIG_SND_JACK_INPUT_DEV
81static int snd_jack_dev_register(struct snd_device *device)
82{
83 struct snd_jack *jack = device->device_data;
84 struct snd_card *card = device->card;
85 int err, i;
86
87 snprintf(jack->name, sizeof(jack->name), "%s %s",
88 card->shortname, jack->id);
89
90 if (!jack->input_dev)
91 return 0;
92
93 jack->input_dev->name = jack->name;
94
95
96 if (!jack->input_dev->dev.parent)
97 jack->input_dev->dev.parent = snd_card_get_device_link(card);
98
99
100 for (i = 0; i < ARRAY_SIZE(jack->key); i++) {
101 int testbit = SND_JACK_BTN_0 >> i;
102
103 if (!(jack->type & testbit))
104 continue;
105
106 if (!jack->key[i])
107 jack->key[i] = BTN_0 + i;
108
109 input_set_capability(jack->input_dev, EV_KEY, jack->key[i]);
110 }
111
112 err = input_register_device(jack->input_dev);
113 if (err == 0)
114 jack->registered = 1;
115
116 return err;
117}
118#endif
119
120#ifdef CONFIG_SND_JACK_INJECTION_DEBUG
121static void snd_jack_inject_report(struct snd_jack_kctl *jack_kctl, int status)
122{
123 struct snd_jack *jack;
124#ifdef CONFIG_SND_JACK_INPUT_DEV
125 int i;
126#endif
127 if (!jack_kctl)
128 return;
129
130 jack = jack_kctl->jack;
131
132 if (jack_kctl->sw_inject_enable)
133 snd_kctl_jack_report(jack->card, jack_kctl->kctl,
134 status & jack_kctl->mask_bits);
135
136#ifdef CONFIG_SND_JACK_INPUT_DEV
137 if (!jack->input_dev)
138 return;
139
140 for (i = 0; i < ARRAY_SIZE(jack->key); i++) {
141 int testbit = ((SND_JACK_BTN_0 >> i) & jack_kctl->mask_bits);
142
143 if (jack->type & testbit)
144 input_report_key(jack->input_dev, jack->key[i],
145 status & testbit);
146 }
147
148 for (i = 0; i < ARRAY_SIZE(jack_switch_types); i++) {
149 int testbit = ((1 << i) & jack_kctl->mask_bits);
150
151 if (jack->type & testbit)
152 input_report_switch(jack->input_dev,
153 jack_switch_types[i],
154 status & testbit);
155 }
156
157 input_sync(jack->input_dev);
158#endif
159}
160
161static ssize_t sw_inject_enable_read(struct file *file,
162 char __user *to, size_t count, loff_t *ppos)
163{
164 struct snd_jack_kctl *jack_kctl = file->private_data;
165 int len, ret;
166 char buf[128];
167
168 len = scnprintf(buf, sizeof(buf), "%s: %s\t\t%s: %i\n", "Jack", jack_kctl->kctl->id.name,
169 "Inject Enabled", jack_kctl->sw_inject_enable);
170 ret = simple_read_from_buffer(to, count, ppos, buf, len);
171
172 return ret;
173}
174
175static ssize_t sw_inject_enable_write(struct file *file,
176 const char __user *from, size_t count, loff_t *ppos)
177{
178 struct snd_jack_kctl *jack_kctl = file->private_data;
179 int ret, err;
180 unsigned long enable;
181 char buf[8] = { 0 };
182
183 ret = simple_write_to_buffer(buf, sizeof(buf) - 1, ppos, from, count);
184 err = kstrtoul(buf, 0, &enable);
185 if (err)
186 return err;
187
188 if (jack_kctl->sw_inject_enable == (!!enable))
189 return ret;
190
191 jack_kctl->sw_inject_enable = !!enable;
192
193 if (!jack_kctl->sw_inject_enable)
194 snd_jack_report(jack_kctl->jack, jack_kctl->jack->hw_status_cache);
195
196 return ret;
197}
198
199static ssize_t jackin_inject_write(struct file *file,
200 const char __user *from, size_t count, loff_t *ppos)
201{
202 struct snd_jack_kctl *jack_kctl = file->private_data;
203 int ret, err;
204 unsigned long enable;
205 char buf[8] = { 0 };
206
207 if (!jack_kctl->sw_inject_enable)
208 return -EINVAL;
209
210 ret = simple_write_to_buffer(buf, sizeof(buf) - 1, ppos, from, count);
211 err = kstrtoul(buf, 0, &enable);
212 if (err)
213 return err;
214
215 snd_jack_inject_report(jack_kctl, !!enable ? jack_kctl->mask_bits : 0);
216
217 return ret;
218}
219
220static ssize_t jack_kctl_id_read(struct file *file,
221 char __user *to, size_t count, loff_t *ppos)
222{
223 struct snd_jack_kctl *jack_kctl = file->private_data;
224 char buf[64];
225 int len, ret;
226
227 len = scnprintf(buf, sizeof(buf), "%s\n", jack_kctl->kctl->id.name);
228 ret = simple_read_from_buffer(to, count, ppos, buf, len);
229
230 return ret;
231}
232
233
234static const char * const jack_events_name[] = {
235 "HEADPHONE(0x0001)", "MICROPHONE(0x0002)", "LINEOUT(0x0004)",
236 "MECHANICAL(0x0008)", "VIDEOOUT(0x0010)", "LINEIN(0x0020)",
237 "", "", "", "BTN_5(0x0200)", "BTN_4(0x0400)", "BTN_3(0x0800)",
238 "BTN_2(0x1000)", "BTN_1(0x2000)", "BTN_0(0x4000)", "",
239};
240
241
242static int parse_mask_bits(unsigned int mask_bits, char *buf, size_t buf_size)
243{
244 int i;
245
246 scnprintf(buf, buf_size, "0x%04x", mask_bits);
247
248 for (i = 0; i < ARRAY_SIZE(jack_events_name); i++)
249 if (mask_bits & (1 << i)) {
250 strlcat(buf, " ", buf_size);
251 strlcat(buf, jack_events_name[i], buf_size);
252 }
253 strlcat(buf, "\n", buf_size);
254
255 return strlen(buf);
256}
257
258static ssize_t jack_kctl_mask_bits_read(struct file *file,
259 char __user *to, size_t count, loff_t *ppos)
260{
261 struct snd_jack_kctl *jack_kctl = file->private_data;
262 char buf[256];
263 int len, ret;
264
265 len = parse_mask_bits(jack_kctl->mask_bits, buf, sizeof(buf));
266 ret = simple_read_from_buffer(to, count, ppos, buf, len);
267
268 return ret;
269}
270
271static ssize_t jack_kctl_status_read(struct file *file,
272 char __user *to, size_t count, loff_t *ppos)
273{
274 struct snd_jack_kctl *jack_kctl = file->private_data;
275 char buf[16];
276 int len, ret;
277
278 len = scnprintf(buf, sizeof(buf), "%s\n", jack_kctl->kctl->private_value ?
279 "Plugged" : "Unplugged");
280 ret = simple_read_from_buffer(to, count, ppos, buf, len);
281
282 return ret;
283}
284
285#ifdef CONFIG_SND_JACK_INPUT_DEV
286static ssize_t jack_type_read(struct file *file,
287 char __user *to, size_t count, loff_t *ppos)
288{
289 struct snd_jack_kctl *jack_kctl = file->private_data;
290 char buf[256];
291 int len, ret;
292
293 len = parse_mask_bits(jack_kctl->jack->type, buf, sizeof(buf));
294 ret = simple_read_from_buffer(to, count, ppos, buf, len);
295
296 return ret;
297}
298
299static const struct file_operations jack_type_fops = {
300 .open = simple_open,
301 .read = jack_type_read,
302 .llseek = default_llseek,
303};
304#endif
305
306static const struct file_operations sw_inject_enable_fops = {
307 .open = simple_open,
308 .read = sw_inject_enable_read,
309 .write = sw_inject_enable_write,
310 .llseek = default_llseek,
311};
312
313static const struct file_operations jackin_inject_fops = {
314 .open = simple_open,
315 .write = jackin_inject_write,
316 .llseek = default_llseek,
317};
318
319static const struct file_operations jack_kctl_id_fops = {
320 .open = simple_open,
321 .read = jack_kctl_id_read,
322 .llseek = default_llseek,
323};
324
325static const struct file_operations jack_kctl_mask_bits_fops = {
326 .open = simple_open,
327 .read = jack_kctl_mask_bits_read,
328 .llseek = default_llseek,
329};
330
331static const struct file_operations jack_kctl_status_fops = {
332 .open = simple_open,
333 .read = jack_kctl_status_read,
334 .llseek = default_llseek,
335};
336
337static int snd_jack_debugfs_add_inject_node(struct snd_jack *jack,
338 struct snd_jack_kctl *jack_kctl)
339{
340 char *tname;
341 int i;
342
343
344 if (strstr(jack_kctl->kctl->id.name, "Phantom"))
345 return 0;
346
347 tname = kstrdup(jack_kctl->kctl->id.name, GFP_KERNEL);
348 if (!tname)
349 return -ENOMEM;
350
351
352 for (i = 0; tname[i]; i++)
353 if (!isalnum(tname[i]))
354 tname[i] = '_';
355
356 jack_kctl->jack_debugfs_root = debugfs_create_dir(tname, jack->card->debugfs_root);
357 kfree(tname);
358
359 debugfs_create_file("sw_inject_enable", 0644, jack_kctl->jack_debugfs_root, jack_kctl,
360 &sw_inject_enable_fops);
361
362 debugfs_create_file("jackin_inject", 0200, jack_kctl->jack_debugfs_root, jack_kctl,
363 &jackin_inject_fops);
364
365 debugfs_create_file("kctl_id", 0444, jack_kctl->jack_debugfs_root, jack_kctl,
366 &jack_kctl_id_fops);
367
368 debugfs_create_file("mask_bits", 0444, jack_kctl->jack_debugfs_root, jack_kctl,
369 &jack_kctl_mask_bits_fops);
370
371 debugfs_create_file("status", 0444, jack_kctl->jack_debugfs_root, jack_kctl,
372 &jack_kctl_status_fops);
373
374#ifdef CONFIG_SND_JACK_INPUT_DEV
375 debugfs_create_file("type", 0444, jack_kctl->jack_debugfs_root, jack_kctl,
376 &jack_type_fops);
377#endif
378 return 0;
379}
380
381static void snd_jack_debugfs_clear_inject_node(struct snd_jack_kctl *jack_kctl)
382{
383 debugfs_remove(jack_kctl->jack_debugfs_root);
384 jack_kctl->jack_debugfs_root = NULL;
385}
386#else
387static int snd_jack_debugfs_add_inject_node(struct snd_jack *jack,
388 struct snd_jack_kctl *jack_kctl)
389{
390 return 0;
391}
392
393static void snd_jack_debugfs_clear_inject_node(struct snd_jack_kctl *jack_kctl)
394{
395}
396#endif
397
398static void snd_jack_kctl_private_free(struct snd_kcontrol *kctl)
399{
400 struct snd_jack_kctl *jack_kctl;
401
402 jack_kctl = kctl->private_data;
403 if (jack_kctl) {
404 snd_jack_debugfs_clear_inject_node(jack_kctl);
405 list_del(&jack_kctl->list);
406 kfree(jack_kctl);
407 }
408}
409
410static void snd_jack_kctl_add(struct snd_jack *jack, struct snd_jack_kctl *jack_kctl)
411{
412 jack_kctl->jack = jack;
413 list_add_tail(&jack_kctl->list, &jack->kctl_list);
414 snd_jack_debugfs_add_inject_node(jack, jack_kctl);
415}
416
417static struct snd_jack_kctl * snd_jack_kctl_new(struct snd_card *card, const char *name, unsigned int mask)
418{
419 struct snd_kcontrol *kctl;
420 struct snd_jack_kctl *jack_kctl;
421 int err;
422
423 kctl = snd_kctl_jack_new(name, card);
424 if (!kctl)
425 return NULL;
426
427 err = snd_ctl_add(card, kctl);
428 if (err < 0)
429 return NULL;
430
431 jack_kctl = kzalloc(sizeof(*jack_kctl), GFP_KERNEL);
432
433 if (!jack_kctl)
434 goto error;
435
436 jack_kctl->kctl = kctl;
437 jack_kctl->mask_bits = mask;
438
439 kctl->private_data = jack_kctl;
440 kctl->private_free = snd_jack_kctl_private_free;
441
442 return jack_kctl;
443error:
444 snd_ctl_free_one(kctl);
445 return NULL;
446}
447
448
449
450
451
452
453
454
455
456
457
458
459int snd_jack_add_new_kctl(struct snd_jack *jack, const char * name, int mask)
460{
461 struct snd_jack_kctl *jack_kctl;
462
463 jack_kctl = snd_jack_kctl_new(jack->card, name, mask);
464 if (!jack_kctl)
465 return -ENOMEM;
466
467 snd_jack_kctl_add(jack, jack_kctl);
468 return 0;
469}
470EXPORT_SYMBOL(snd_jack_add_new_kctl);
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487int snd_jack_new(struct snd_card *card, const char *id, int type,
488 struct snd_jack **jjack, bool initial_kctl, bool phantom_jack)
489{
490 struct snd_jack *jack;
491 struct snd_jack_kctl *jack_kctl = NULL;
492 int err;
493 static const struct snd_device_ops ops = {
494 .dev_free = snd_jack_dev_free,
495#ifdef CONFIG_SND_JACK_INPUT_DEV
496 .dev_register = snd_jack_dev_register,
497 .dev_disconnect = snd_jack_dev_disconnect,
498#endif
499 };
500
501 if (initial_kctl) {
502 jack_kctl = snd_jack_kctl_new(card, id, type);
503 if (!jack_kctl)
504 return -ENOMEM;
505 }
506
507 jack = kzalloc(sizeof(struct snd_jack), GFP_KERNEL);
508 if (jack == NULL)
509 return -ENOMEM;
510
511 jack->id = kstrdup(id, GFP_KERNEL);
512 if (jack->id == NULL) {
513 kfree(jack);
514 return -ENOMEM;
515 }
516
517
518 if (!phantom_jack) {
519#ifdef CONFIG_SND_JACK_INPUT_DEV
520 int i;
521
522 jack->input_dev = input_allocate_device();
523 if (jack->input_dev == NULL) {
524 err = -ENOMEM;
525 goto fail_input;
526 }
527
528 jack->input_dev->phys = "ALSA";
529
530 jack->type = type;
531
532 for (i = 0; i < SND_JACK_SWITCH_TYPES; i++)
533 if (type & (1 << i))
534 input_set_capability(jack->input_dev, EV_SW,
535 jack_switch_types[i]);
536
537#endif
538 }
539
540 err = snd_device_new(card, SNDRV_DEV_JACK, jack, &ops);
541 if (err < 0)
542 goto fail_input;
543
544 jack->card = card;
545 INIT_LIST_HEAD(&jack->kctl_list);
546
547 if (initial_kctl)
548 snd_jack_kctl_add(jack, jack_kctl);
549
550 *jjack = jack;
551
552 return 0;
553
554fail_input:
555#ifdef CONFIG_SND_JACK_INPUT_DEV
556 input_free_device(jack->input_dev);
557#endif
558 kfree(jack->id);
559 kfree(jack);
560 return err;
561}
562EXPORT_SYMBOL(snd_jack_new);
563
564#ifdef CONFIG_SND_JACK_INPUT_DEV
565
566
567
568
569
570
571
572
573
574
575void snd_jack_set_parent(struct snd_jack *jack, struct device *parent)
576{
577 WARN_ON(jack->registered);
578 if (!jack->input_dev)
579 return;
580
581 jack->input_dev->dev.parent = parent;
582}
583EXPORT_SYMBOL(snd_jack_set_parent);
584
585
586
587
588
589
590
591
592
593
594
595
596
597
598
599
600
601
602
603
604
605
606
607
608
609
610int snd_jack_set_key(struct snd_jack *jack, enum snd_jack_types type,
611 int keytype)
612{
613 int key = fls(SND_JACK_BTN_0) - fls(type);
614
615 WARN_ON(jack->registered);
616
617 if (!keytype || key >= ARRAY_SIZE(jack->key))
618 return -EINVAL;
619
620 jack->type |= type;
621 jack->key[key] = keytype;
622 return 0;
623}
624EXPORT_SYMBOL(snd_jack_set_key);
625#endif
626
627
628
629
630
631
632
633void snd_jack_report(struct snd_jack *jack, int status)
634{
635 struct snd_jack_kctl *jack_kctl;
636 unsigned int mask_bits = 0;
637#ifdef CONFIG_SND_JACK_INPUT_DEV
638 int i;
639#endif
640
641 if (!jack)
642 return;
643
644 jack->hw_status_cache = status;
645
646 list_for_each_entry(jack_kctl, &jack->kctl_list, list)
647 if (jack_kctl->sw_inject_enable)
648 mask_bits |= jack_kctl->mask_bits;
649 else
650 snd_kctl_jack_report(jack->card, jack_kctl->kctl,
651 status & jack_kctl->mask_bits);
652
653#ifdef CONFIG_SND_JACK_INPUT_DEV
654 if (!jack->input_dev)
655 return;
656
657 for (i = 0; i < ARRAY_SIZE(jack->key); i++) {
658 int testbit = ((SND_JACK_BTN_0 >> i) & ~mask_bits);
659
660 if (jack->type & testbit)
661 input_report_key(jack->input_dev, jack->key[i],
662 status & testbit);
663 }
664
665 for (i = 0; i < ARRAY_SIZE(jack_switch_types); i++) {
666 int testbit = ((1 << i) & ~mask_bits);
667
668 if (jack->type & testbit)
669 input_report_switch(jack->input_dev,
670 jack_switch_types[i],
671 status & testbit);
672 }
673
674 input_sync(jack->input_dev);
675#endif
676}
677EXPORT_SYMBOL(snd_jack_report);
678