1
2
3
4
5
6
7
8#include <linux/init.h>
9#include <linux/slab.h>
10#include <linux/export.h>
11#include <sound/core.h>
12#include <sound/control.h>
13#include <sound/jack.h>
14#include <sound/hda_codec.h>
15#include "hda_local.h"
16#include "hda_auto_parser.h"
17#include "hda_jack.h"
18
19
20
21
22
23
24
25
26
27
28
29bool is_jack_detectable(struct hda_codec *codec, hda_nid_t nid)
30{
31 if (codec->no_jack_detect)
32 return false;
33 if (!(snd_hda_query_pin_caps(codec, nid) & AC_PINCAP_PRES_DETECT))
34 return false;
35 if (get_defcfg_misc(snd_hda_codec_get_pincfg(codec, nid)) &
36 AC_DEFCFG_MISC_NO_PRESENCE)
37 return false;
38 if (!(get_wcaps(codec, nid) & AC_WCAP_UNSOL_CAP) &&
39 !codec->jackpoll_interval)
40 return false;
41 return true;
42}
43EXPORT_SYMBOL_GPL(is_jack_detectable);
44
45
46static u32 read_pin_sense(struct hda_codec *codec, hda_nid_t nid, int dev_id)
47{
48 u32 pincap;
49 u32 val;
50
51 if (!codec->no_trigger_sense) {
52 pincap = snd_hda_query_pin_caps(codec, nid);
53 if (pincap & AC_PINCAP_TRIG_REQ)
54 snd_hda_codec_read(codec, nid, 0,
55 AC_VERB_SET_PIN_SENSE, 0);
56 }
57 val = snd_hda_codec_read(codec, nid, 0,
58 AC_VERB_GET_PIN_SENSE, dev_id);
59 if (codec->inv_jack_detect)
60 val ^= AC_PINSENSE_PRESENCE;
61 return val;
62}
63
64
65
66
67
68
69
70struct hda_jack_tbl *
71snd_hda_jack_tbl_get_mst(struct hda_codec *codec, hda_nid_t nid, int dev_id)
72{
73 struct hda_jack_tbl *jack = codec->jacktbl.list;
74 int i;
75
76 if (!nid || !jack)
77 return NULL;
78 for (i = 0; i < codec->jacktbl.used; i++, jack++)
79 if (jack->nid == nid && jack->dev_id == dev_id)
80 return jack;
81 return NULL;
82}
83EXPORT_SYMBOL_GPL(snd_hda_jack_tbl_get_mst);
84
85
86
87
88
89
90
91struct hda_jack_tbl *
92snd_hda_jack_tbl_get_from_tag(struct hda_codec *codec,
93 unsigned char tag, int dev_id)
94{
95 struct hda_jack_tbl *jack = codec->jacktbl.list;
96 int i;
97
98 if (!tag || !jack)
99 return NULL;
100 for (i = 0; i < codec->jacktbl.used; i++, jack++)
101 if (jack->tag == tag && jack->dev_id == dev_id)
102 return jack;
103 return NULL;
104}
105EXPORT_SYMBOL_GPL(snd_hda_jack_tbl_get_from_tag);
106
107static struct hda_jack_tbl *
108any_jack_tbl_get_from_nid(struct hda_codec *codec, hda_nid_t nid)
109{
110 struct hda_jack_tbl *jack = codec->jacktbl.list;
111 int i;
112
113 if (!nid || !jack)
114 return NULL;
115 for (i = 0; i < codec->jacktbl.used; i++, jack++)
116 if (jack->nid == nid)
117 return jack;
118 return NULL;
119}
120
121
122
123
124
125
126
127static struct hda_jack_tbl *
128snd_hda_jack_tbl_new(struct hda_codec *codec, hda_nid_t nid, int dev_id)
129{
130 struct hda_jack_tbl *jack =
131 snd_hda_jack_tbl_get_mst(codec, nid, dev_id);
132 struct hda_jack_tbl *existing_nid_jack =
133 any_jack_tbl_get_from_nid(codec, nid);
134
135 WARN_ON(dev_id != 0 && !codec->dp_mst);
136
137 if (jack)
138 return jack;
139 jack = snd_array_new(&codec->jacktbl);
140 if (!jack)
141 return NULL;
142 jack->nid = nid;
143 jack->dev_id = dev_id;
144 jack->jack_dirty = 1;
145 if (existing_nid_jack) {
146 jack->tag = existing_nid_jack->tag;
147
148
149
150
151
152
153 jack->jack_detect = existing_nid_jack->jack_detect;
154 } else {
155 jack->tag = codec->jacktbl.used;
156 }
157
158 return jack;
159}
160
161void snd_hda_jack_tbl_clear(struct hda_codec *codec)
162{
163 struct hda_jack_tbl *jack = codec->jacktbl.list;
164 int i;
165
166 for (i = 0; i < codec->jacktbl.used; i++, jack++) {
167 struct hda_jack_callback *cb, *next;
168
169
170 if (!codec->bus->shutdown && jack->jack)
171 snd_device_free(codec->card, jack->jack);
172
173 for (cb = jack->callback; cb; cb = next) {
174 next = cb->next;
175 kfree(cb);
176 }
177 }
178 snd_array_free(&codec->jacktbl);
179}
180
181#define get_jack_plug_state(sense) !!(sense & AC_PINSENSE_PRESENCE)
182
183
184static void jack_detect_update(struct hda_codec *codec,
185 struct hda_jack_tbl *jack)
186{
187 if (!jack->jack_dirty)
188 return;
189
190 if (jack->phantom_jack)
191 jack->pin_sense = AC_PINSENSE_PRESENCE;
192 else
193 jack->pin_sense = read_pin_sense(codec, jack->nid,
194 jack->dev_id);
195
196
197 if (jack->gating_jack &&
198 !snd_hda_jack_detect_mst(codec, jack->gating_jack, jack->dev_id))
199 jack->pin_sense &= ~AC_PINSENSE_PRESENCE;
200
201 jack->jack_dirty = 0;
202
203
204 if (jack->gated_jack) {
205 struct hda_jack_tbl *gated =
206 snd_hda_jack_tbl_get_mst(codec, jack->gated_jack,
207 jack->dev_id);
208 if (gated) {
209 gated->jack_dirty = 1;
210 jack_detect_update(codec, gated);
211 }
212 }
213}
214
215
216
217
218
219
220
221
222void snd_hda_jack_set_dirty_all(struct hda_codec *codec)
223{
224 struct hda_jack_tbl *jack = codec->jacktbl.list;
225 int i;
226
227 for (i = 0; i < codec->jacktbl.used; i++, jack++)
228 if (jack->nid)
229 jack->jack_dirty = 1;
230}
231EXPORT_SYMBOL_GPL(snd_hda_jack_set_dirty_all);
232
233
234
235
236
237
238
239
240
241
242u32 snd_hda_jack_pin_sense(struct hda_codec *codec, hda_nid_t nid, int dev_id)
243{
244 struct hda_jack_tbl *jack =
245 snd_hda_jack_tbl_get_mst(codec, nid, dev_id);
246 if (jack) {
247 jack_detect_update(codec, jack);
248 return jack->pin_sense;
249 }
250 return read_pin_sense(codec, nid, dev_id);
251}
252EXPORT_SYMBOL_GPL(snd_hda_jack_pin_sense);
253
254
255
256
257
258
259
260
261
262
263int snd_hda_jack_detect_state_mst(struct hda_codec *codec,
264 hda_nid_t nid, int dev_id)
265{
266 struct hda_jack_tbl *jack =
267 snd_hda_jack_tbl_get_mst(codec, nid, dev_id);
268 if (jack && jack->phantom_jack)
269 return HDA_JACK_PHANTOM;
270 else if (snd_hda_jack_pin_sense(codec, nid, dev_id) &
271 AC_PINSENSE_PRESENCE)
272 return HDA_JACK_PRESENT;
273 else
274 return HDA_JACK_NOT_PRESENT;
275}
276EXPORT_SYMBOL_GPL(snd_hda_jack_detect_state_mst);
277
278
279
280
281
282
283
284
285
286
287
288
289struct hda_jack_callback *
290snd_hda_jack_detect_enable_callback_mst(struct hda_codec *codec, hda_nid_t nid,
291 int dev_id, hda_jack_callback_fn func)
292{
293 struct hda_jack_tbl *jack;
294 struct hda_jack_callback *callback = NULL;
295 int err;
296
297 jack = snd_hda_jack_tbl_new(codec, nid, dev_id);
298 if (!jack)
299 return ERR_PTR(-ENOMEM);
300 if (func) {
301 callback = kzalloc(sizeof(*callback), GFP_KERNEL);
302 if (!callback)
303 return ERR_PTR(-ENOMEM);
304 callback->func = func;
305 callback->nid = jack->nid;
306 callback->dev_id = jack->dev_id;
307 callback->next = jack->callback;
308 jack->callback = callback;
309 }
310
311 if (jack->jack_detect)
312 return callback;
313 jack->jack_detect = 1;
314 if (codec->jackpoll_interval > 0)
315 return callback;
316 err = snd_hda_codec_write_cache(codec, nid, 0,
317 AC_VERB_SET_UNSOLICITED_ENABLE,
318 AC_USRSP_EN | jack->tag);
319 if (err < 0)
320 return ERR_PTR(err);
321 return callback;
322}
323EXPORT_SYMBOL_GPL(snd_hda_jack_detect_enable_callback_mst);
324
325
326
327
328
329
330
331
332
333
334int snd_hda_jack_detect_enable(struct hda_codec *codec, hda_nid_t nid,
335 int dev_id)
336{
337 return PTR_ERR_OR_ZERO(snd_hda_jack_detect_enable_callback_mst(codec,
338 nid,
339 dev_id,
340 NULL));
341}
342EXPORT_SYMBOL_GPL(snd_hda_jack_detect_enable);
343
344
345
346
347
348
349
350
351
352int snd_hda_jack_set_gating_jack(struct hda_codec *codec, hda_nid_t gated_nid,
353 hda_nid_t gating_nid)
354{
355 struct hda_jack_tbl *gated = snd_hda_jack_tbl_new(codec, gated_nid, 0);
356 struct hda_jack_tbl *gating =
357 snd_hda_jack_tbl_new(codec, gating_nid, 0);
358
359 WARN_ON(codec->dp_mst);
360
361 if (!gated || !gating)
362 return -EINVAL;
363
364 gated->gating_jack = gating_nid;
365 gating->gated_jack = gated_nid;
366
367 return 0;
368}
369EXPORT_SYMBOL_GPL(snd_hda_jack_set_gating_jack);
370
371
372
373
374
375void snd_hda_jack_report_sync(struct hda_codec *codec)
376{
377 struct hda_jack_tbl *jack;
378 int i, state;
379
380
381 jack = codec->jacktbl.list;
382 for (i = 0; i < codec->jacktbl.used; i++, jack++)
383 if (jack->nid)
384 jack_detect_update(codec, jack);
385
386
387
388
389 jack = codec->jacktbl.list;
390 for (i = 0; i < codec->jacktbl.used; i++, jack++)
391 if (jack->nid) {
392 if (!jack->jack || jack->block_report)
393 continue;
394 state = jack->button_state;
395 if (get_jack_plug_state(jack->pin_sense))
396 state |= jack->type;
397 snd_jack_report(jack->jack, state);
398 if (jack->button_state) {
399 snd_jack_report(jack->jack,
400 state & ~jack->button_state);
401 jack->button_state = 0;
402 }
403 }
404}
405EXPORT_SYMBOL_GPL(snd_hda_jack_report_sync);
406
407
408static int get_input_jack_type(struct hda_codec *codec, hda_nid_t nid)
409{
410 unsigned int def_conf = snd_hda_codec_get_pincfg(codec, nid);
411 switch (get_defcfg_device(def_conf)) {
412 case AC_JACK_LINE_OUT:
413 case AC_JACK_SPEAKER:
414 return SND_JACK_LINEOUT;
415 case AC_JACK_HP_OUT:
416 return SND_JACK_HEADPHONE;
417 case AC_JACK_SPDIF_OUT:
418 case AC_JACK_DIG_OTHER_OUT:
419 return SND_JACK_AVOUT;
420 case AC_JACK_MIC_IN:
421 return SND_JACK_MICROPHONE;
422 default:
423 return SND_JACK_LINEIN;
424 }
425}
426
427static void hda_free_jack_priv(struct snd_jack *jack)
428{
429 struct hda_jack_tbl *jacks = jack->private_data;
430 jacks->nid = 0;
431 jacks->jack = NULL;
432}
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447int snd_hda_jack_add_kctl_mst(struct hda_codec *codec, hda_nid_t nid,
448 int dev_id, const char *name, bool phantom_jack,
449 int type, const struct hda_jack_keymap *keymap)
450{
451 struct hda_jack_tbl *jack;
452 const struct hda_jack_keymap *map;
453 int err, state, buttons;
454
455 jack = snd_hda_jack_tbl_new(codec, nid, dev_id);
456 if (!jack)
457 return 0;
458 if (jack->jack)
459 return 0;
460
461 if (!type)
462 type = get_input_jack_type(codec, nid);
463
464 buttons = 0;
465 if (keymap) {
466 for (map = keymap; map->type; map++)
467 buttons |= map->type;
468 }
469
470 err = snd_jack_new(codec->card, name, type | buttons,
471 &jack->jack, true, phantom_jack);
472 if (err < 0)
473 return err;
474
475 jack->phantom_jack = !!phantom_jack;
476 jack->type = type;
477 jack->button_state = 0;
478 jack->jack->private_data = jack;
479 jack->jack->private_free = hda_free_jack_priv;
480 if (keymap) {
481 for (map = keymap; map->type; map++)
482 snd_jack_set_key(jack->jack, map->type, map->key);
483 }
484
485 state = snd_hda_jack_detect_mst(codec, nid, dev_id);
486 snd_jack_report(jack->jack, state ? jack->type : 0);
487
488 return 0;
489}
490EXPORT_SYMBOL_GPL(snd_hda_jack_add_kctl_mst);
491
492static int add_jack_kctl(struct hda_codec *codec, hda_nid_t nid,
493 const struct auto_pin_cfg *cfg,
494 const char *base_name)
495{
496 unsigned int def_conf, conn;
497 char name[SNDRV_CTL_ELEM_ID_NAME_MAXLEN];
498 int err;
499 bool phantom_jack;
500
501 WARN_ON(codec->dp_mst);
502
503 if (!nid)
504 return 0;
505 def_conf = snd_hda_codec_get_pincfg(codec, nid);
506 conn = get_defcfg_connect(def_conf);
507 if (conn == AC_JACK_PORT_NONE)
508 return 0;
509 phantom_jack = (conn != AC_JACK_PORT_COMPLEX) ||
510 !is_jack_detectable(codec, nid);
511
512 if (base_name)
513 strlcpy(name, base_name, sizeof(name));
514 else
515 snd_hda_get_pin_label(codec, nid, cfg, name, sizeof(name), NULL);
516 if (phantom_jack)
517
518 strncat(name, " Phantom", sizeof(name) - strlen(name) - 1);
519 err = snd_hda_jack_add_kctl(codec, nid, name, phantom_jack, 0, NULL);
520 if (err < 0)
521 return err;
522
523 if (!phantom_jack)
524 return snd_hda_jack_detect_enable(codec, nid, 0);
525 return 0;
526}
527
528
529
530
531
532
533int snd_hda_jack_add_kctls(struct hda_codec *codec,
534 const struct auto_pin_cfg *cfg)
535{
536 const hda_nid_t *p;
537 int i, err;
538
539 for (i = 0; i < cfg->num_inputs; i++) {
540
541
542 if (cfg->inputs[i].is_headphone_mic) {
543 if (auto_cfg_hp_outs(cfg) == 1)
544 err = add_jack_kctl(codec, auto_cfg_hp_pins(cfg)[0],
545 cfg, "Headphone Mic");
546 else
547 err = add_jack_kctl(codec, cfg->inputs[i].pin,
548 cfg, "Headphone Mic");
549 } else
550 err = add_jack_kctl(codec, cfg->inputs[i].pin, cfg,
551 NULL);
552 if (err < 0)
553 return err;
554 }
555
556 for (i = 0, p = cfg->line_out_pins; i < cfg->line_outs; i++, p++) {
557 err = add_jack_kctl(codec, *p, cfg, NULL);
558 if (err < 0)
559 return err;
560 }
561 for (i = 0, p = cfg->hp_pins; i < cfg->hp_outs; i++, p++) {
562 if (*p == *cfg->line_out_pins)
563 break;
564 err = add_jack_kctl(codec, *p, cfg, NULL);
565 if (err < 0)
566 return err;
567 }
568 for (i = 0, p = cfg->speaker_pins; i < cfg->speaker_outs; i++, p++) {
569 if (*p == *cfg->line_out_pins)
570 break;
571 err = add_jack_kctl(codec, *p, cfg, NULL);
572 if (err < 0)
573 return err;
574 }
575 for (i = 0, p = cfg->dig_out_pins; i < cfg->dig_outs; i++, p++) {
576 err = add_jack_kctl(codec, *p, cfg, NULL);
577 if (err < 0)
578 return err;
579 }
580 err = add_jack_kctl(codec, cfg->dig_in_pin, cfg, NULL);
581 if (err < 0)
582 return err;
583 err = add_jack_kctl(codec, cfg->mono_out_pin, cfg, NULL);
584 if (err < 0)
585 return err;
586 return 0;
587}
588EXPORT_SYMBOL_GPL(snd_hda_jack_add_kctls);
589
590static void call_jack_callback(struct hda_codec *codec, unsigned int res,
591 struct hda_jack_tbl *jack)
592{
593 struct hda_jack_callback *cb;
594
595 for (cb = jack->callback; cb; cb = cb->next) {
596 cb->jack = jack;
597 cb->unsol_res = res;
598 cb->func(codec, cb);
599 }
600 if (jack->gated_jack) {
601 struct hda_jack_tbl *gated =
602 snd_hda_jack_tbl_get_mst(codec, jack->gated_jack,
603 jack->dev_id);
604 if (gated) {
605 for (cb = gated->callback; cb; cb = cb->next) {
606 cb->jack = gated;
607 cb->unsol_res = res;
608 cb->func(codec, cb);
609 }
610 }
611 }
612}
613
614
615
616
617
618
619void snd_hda_jack_unsol_event(struct hda_codec *codec, unsigned int res)
620{
621 struct hda_jack_tbl *event;
622 int tag = (res & AC_UNSOL_RES_TAG) >> AC_UNSOL_RES_TAG_SHIFT;
623
624 if (codec->dp_mst) {
625 int dev_entry =
626 (res & AC_UNSOL_RES_DE) >> AC_UNSOL_RES_DE_SHIFT;
627
628 event = snd_hda_jack_tbl_get_from_tag(codec, tag, dev_entry);
629 } else {
630 event = snd_hda_jack_tbl_get_from_tag(codec, tag, 0);
631 }
632 if (!event)
633 return;
634 event->jack_dirty = 1;
635
636 call_jack_callback(codec, res, event);
637 snd_hda_jack_report_sync(codec);
638}
639EXPORT_SYMBOL_GPL(snd_hda_jack_unsol_event);
640
641
642
643
644
645
646
647
648void snd_hda_jack_poll_all(struct hda_codec *codec)
649{
650 struct hda_jack_tbl *jack = codec->jacktbl.list;
651 int i, changes = 0;
652
653 for (i = 0; i < codec->jacktbl.used; i++, jack++) {
654 unsigned int old_sense;
655 if (!jack->nid || !jack->jack_dirty || jack->phantom_jack)
656 continue;
657 old_sense = get_jack_plug_state(jack->pin_sense);
658 jack_detect_update(codec, jack);
659 if (old_sense == get_jack_plug_state(jack->pin_sense))
660 continue;
661 changes = 1;
662 call_jack_callback(codec, 0, jack);
663 }
664 if (changes)
665 snd_hda_jack_report_sync(codec);
666}
667EXPORT_SYMBOL_GPL(snd_hda_jack_poll_all);
668
669