1 /*
2 * Jack-detection handling for HD-audio
3 *
4 * Copyright (c) 2011 Takashi Iwai <tiwai@suse.de>
5 *
6 * This driver is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
10 */
11
12 #include <linux/init.h>
13 #include <linux/slab.h>
14 #include <linux/export.h>
15 #include <sound/core.h>
16 #include <sound/control.h>
17 #include <sound/jack.h>
18 #include "hda_codec.h"
19 #include "hda_local.h"
20 #include "hda_jack.h"
21
22 /* execute pin sense measurement */
read_pin_sense(struct hda_codec * codec,hda_nid_t nid)23 static u32 read_pin_sense(struct hda_codec *codec, hda_nid_t nid)
24 {
25 u32 pincap;
26
27 if (!codec->no_trigger_sense) {
28 pincap = snd_hda_query_pin_caps(codec, nid);
29 if (pincap & AC_PINCAP_TRIG_REQ) /* need trigger? */
30 snd_hda_codec_read(codec, nid, 0,
31 AC_VERB_SET_PIN_SENSE, 0);
32 }
33 return snd_hda_codec_read(codec, nid, 0,
34 AC_VERB_GET_PIN_SENSE, 0);
35 }
36
37 /**
38 * snd_hda_jack_tbl_get - query the jack-table entry for the given NID
39 */
40 struct hda_jack_tbl *
snd_hda_jack_tbl_get(struct hda_codec * codec,hda_nid_t nid)41 snd_hda_jack_tbl_get(struct hda_codec *codec, hda_nid_t nid)
42 {
43 struct hda_jack_tbl *jack = codec->jacktbl.list;
44 int i;
45
46 if (!nid || !jack)
47 return NULL;
48 for (i = 0; i < codec->jacktbl.used; i++, jack++)
49 if (jack->nid == nid)
50 return jack;
51 return NULL;
52 }
53 EXPORT_SYMBOL_HDA(snd_hda_jack_tbl_get);
54
55 /**
56 * snd_hda_jack_tbl_get_from_tag - query the jack-table entry for the given tag
57 */
58 struct hda_jack_tbl *
snd_hda_jack_tbl_get_from_tag(struct hda_codec * codec,unsigned char tag)59 snd_hda_jack_tbl_get_from_tag(struct hda_codec *codec, unsigned char tag)
60 {
61 struct hda_jack_tbl *jack = codec->jacktbl.list;
62 int i;
63
64 if (!tag || !jack)
65 return NULL;
66 for (i = 0; i < codec->jacktbl.used; i++, jack++)
67 if (jack->tag == tag)
68 return jack;
69 return NULL;
70 }
71 EXPORT_SYMBOL_HDA(snd_hda_jack_tbl_get_from_tag);
72
73 /**
74 * snd_hda_jack_tbl_new - create a jack-table entry for the given NID
75 */
76 struct hda_jack_tbl *
snd_hda_jack_tbl_new(struct hda_codec * codec,hda_nid_t nid)77 snd_hda_jack_tbl_new(struct hda_codec *codec, hda_nid_t nid)
78 {
79 struct hda_jack_tbl *jack = snd_hda_jack_tbl_get(codec, nid);
80 if (jack)
81 return jack;
82 snd_array_init(&codec->jacktbl, sizeof(*jack), 16);
83 jack = snd_array_new(&codec->jacktbl);
84 if (!jack)
85 return NULL;
86 jack->nid = nid;
87 jack->jack_dirty = 1;
88 jack->tag = codec->jacktbl.used;
89 return jack;
90 }
91 EXPORT_SYMBOL_HDA(snd_hda_jack_tbl_new);
92
snd_hda_jack_tbl_clear(struct hda_codec * codec)93 void snd_hda_jack_tbl_clear(struct hda_codec *codec)
94 {
95 #ifdef CONFIG_SND_HDA_INPUT_JACK
96 /* free jack instances manually when clearing/reconfiguring */
97 if (!codec->bus->shutdown && codec->jacktbl.list) {
98 struct hda_jack_tbl *jack = codec->jacktbl.list;
99 int i;
100 for (i = 0; i < codec->jacktbl.used; i++, jack++) {
101 if (jack->jack)
102 snd_device_free(codec->bus->card, jack->jack);
103 }
104 }
105 #endif
106 snd_array_free(&codec->jacktbl);
107 }
108
109 /* update the cached value and notification flag if needed */
jack_detect_update(struct hda_codec * codec,struct hda_jack_tbl * jack)110 static void jack_detect_update(struct hda_codec *codec,
111 struct hda_jack_tbl *jack)
112 {
113 if (jack->jack_dirty || !jack->jack_detect) {
114 jack->pin_sense = read_pin_sense(codec, jack->nid);
115 jack->jack_dirty = 0;
116 }
117 }
118
119 /**
120 * snd_hda_set_dirty_all - Mark all the cached as dirty
121 *
122 * This function sets the dirty flag to all entries of jack table.
123 * It's called from the resume path in hda_codec.c.
124 */
snd_hda_jack_set_dirty_all(struct hda_codec * codec)125 void snd_hda_jack_set_dirty_all(struct hda_codec *codec)
126 {
127 struct hda_jack_tbl *jack = codec->jacktbl.list;
128 int i;
129
130 for (i = 0; i < codec->jacktbl.used; i++, jack++)
131 if (jack->nid)
132 jack->jack_dirty = 1;
133 }
134 EXPORT_SYMBOL_HDA(snd_hda_jack_set_dirty_all);
135
136 /**
137 * snd_hda_pin_sense - execute pin sense measurement
138 * @codec: the CODEC to sense
139 * @nid: the pin NID to sense
140 *
141 * Execute necessary pin sense measurement and return its Presence Detect,
142 * Impedance, ELD Valid etc. status bits.
143 */
snd_hda_pin_sense(struct hda_codec * codec,hda_nid_t nid)144 u32 snd_hda_pin_sense(struct hda_codec *codec, hda_nid_t nid)
145 {
146 struct hda_jack_tbl *jack = snd_hda_jack_tbl_get(codec, nid);
147 if (jack) {
148 jack_detect_update(codec, jack);
149 return jack->pin_sense;
150 }
151 return read_pin_sense(codec, nid);
152 }
153 EXPORT_SYMBOL_HDA(snd_hda_pin_sense);
154
155 #define get_jack_plug_state(sense) !!(sense & AC_PINSENSE_PRESENCE)
156
157 /**
158 * snd_hda_jack_detect - query pin Presence Detect status
159 * @codec: the CODEC to sense
160 * @nid: the pin NID to sense
161 *
162 * Query and return the pin's Presence Detect status.
163 */
snd_hda_jack_detect(struct hda_codec * codec,hda_nid_t nid)164 int snd_hda_jack_detect(struct hda_codec *codec, hda_nid_t nid)
165 {
166 u32 sense = snd_hda_pin_sense(codec, nid);
167 return get_jack_plug_state(sense);
168 }
169 EXPORT_SYMBOL_HDA(snd_hda_jack_detect);
170
171 /**
172 * snd_hda_jack_detect_enable - enable the jack-detection
173 */
snd_hda_jack_detect_enable(struct hda_codec * codec,hda_nid_t nid,unsigned char action)174 int snd_hda_jack_detect_enable(struct hda_codec *codec, hda_nid_t nid,
175 unsigned char action)
176 {
177 struct hda_jack_tbl *jack = snd_hda_jack_tbl_new(codec, nid);
178 if (!jack)
179 return -ENOMEM;
180 if (jack->jack_detect)
181 return 0; /* already registered */
182 jack->jack_detect = 1;
183 if (action)
184 jack->action = action;
185 return snd_hda_codec_write_cache(codec, nid, 0,
186 AC_VERB_SET_UNSOLICITED_ENABLE,
187 AC_USRSP_EN | jack->tag);
188 }
189 EXPORT_SYMBOL_HDA(snd_hda_jack_detect_enable);
190
191 /**
192 * snd_hda_jack_report_sync - sync the states of all jacks and report if changed
193 */
snd_hda_jack_report_sync(struct hda_codec * codec)194 void snd_hda_jack_report_sync(struct hda_codec *codec)
195 {
196 struct hda_jack_tbl *jack = codec->jacktbl.list;
197 int i, state;
198
199 for (i = 0; i < codec->jacktbl.used; i++, jack++)
200 if (jack->nid) {
201 jack_detect_update(codec, jack);
202 if (!jack->kctl)
203 continue;
204 state = get_jack_plug_state(jack->pin_sense);
205 snd_kctl_jack_report(codec->bus->card, jack->kctl, state);
206 #ifdef CONFIG_SND_HDA_INPUT_JACK
207 if (jack->jack)
208 snd_jack_report(jack->jack,
209 state ? jack->type : 0);
210 #endif
211 }
212 }
213 EXPORT_SYMBOL_HDA(snd_hda_jack_report_sync);
214
215 #ifdef CONFIG_SND_HDA_INPUT_JACK
216 /* guess the jack type from the pin-config */
get_input_jack_type(struct hda_codec * codec,hda_nid_t nid)217 static int get_input_jack_type(struct hda_codec *codec, hda_nid_t nid)
218 {
219 unsigned int def_conf = snd_hda_codec_get_pincfg(codec, nid);
220 switch (get_defcfg_device(def_conf)) {
221 case AC_JACK_LINE_OUT:
222 case AC_JACK_SPEAKER:
223 return SND_JACK_LINEOUT;
224 case AC_JACK_HP_OUT:
225 return SND_JACK_HEADPHONE;
226 case AC_JACK_SPDIF_OUT:
227 case AC_JACK_DIG_OTHER_OUT:
228 return SND_JACK_AVOUT;
229 case AC_JACK_MIC_IN:
230 return SND_JACK_MICROPHONE;
231 default:
232 return SND_JACK_LINEIN;
233 }
234 }
235
hda_free_jack_priv(struct snd_jack * jack)236 static void hda_free_jack_priv(struct snd_jack *jack)
237 {
238 struct hda_jack_tbl *jacks = jack->private_data;
239 jacks->nid = 0;
240 jacks->jack = NULL;
241 }
242 #endif
243
244 /**
245 * snd_hda_jack_add_kctl - Add a kctl for the given pin
246 *
247 * This assigns a jack-detection kctl to the given pin. The kcontrol
248 * will have the given name and index.
249 */
snd_hda_jack_add_kctl(struct hda_codec * codec,hda_nid_t nid,const char * name,int idx)250 int snd_hda_jack_add_kctl(struct hda_codec *codec, hda_nid_t nid,
251 const char *name, int idx)
252 {
253 struct hda_jack_tbl *jack;
254 struct snd_kcontrol *kctl;
255 int err, state;
256
257 jack = snd_hda_jack_tbl_new(codec, nid);
258 if (!jack)
259 return 0;
260 if (jack->kctl)
261 return 0; /* already created */
262 kctl = snd_kctl_jack_new(name, idx, codec);
263 if (!kctl)
264 return -ENOMEM;
265 err = snd_hda_ctl_add(codec, nid, kctl);
266 if (err < 0)
267 return err;
268 jack->kctl = kctl;
269 state = snd_hda_jack_detect(codec, nid);
270 snd_kctl_jack_report(codec->bus->card, kctl, state);
271 #ifdef CONFIG_SND_HDA_INPUT_JACK
272 jack->type = get_input_jack_type(codec, nid);
273 err = snd_jack_new(codec->bus->card, name, jack->type, &jack->jack);
274 if (err < 0)
275 return err;
276 jack->jack->private_data = jack;
277 jack->jack->private_free = hda_free_jack_priv;
278 snd_jack_report(jack->jack, state ? jack->type : 0);
279 #endif
280 return 0;
281 }
282 EXPORT_SYMBOL_HDA(snd_hda_jack_add_kctl);
283
add_jack_kctl(struct hda_codec * codec,hda_nid_t nid,const struct auto_pin_cfg * cfg,char * lastname,int * lastidx)284 static int add_jack_kctl(struct hda_codec *codec, hda_nid_t nid,
285 const struct auto_pin_cfg *cfg,
286 char *lastname, int *lastidx)
287 {
288 unsigned int def_conf, conn;
289 char name[44];
290 int idx, err;
291
292 if (!nid)
293 return 0;
294 if (!is_jack_detectable(codec, nid))
295 return 0;
296 def_conf = snd_hda_codec_get_pincfg(codec, nid);
297 conn = get_defcfg_connect(def_conf);
298 if (conn != AC_JACK_PORT_COMPLEX)
299 return 0;
300
301 snd_hda_get_pin_label(codec, nid, cfg, name, sizeof(name), &idx);
302 if (!strcmp(name, lastname) && idx == *lastidx)
303 idx++;
304 strncpy(lastname, name, 44);
305 *lastidx = idx;
306 err = snd_hda_jack_add_kctl(codec, nid, name, idx);
307 if (err < 0)
308 return err;
309 return snd_hda_jack_detect_enable(codec, nid, 0);
310 }
311
312 /**
313 * snd_hda_jack_add_kctls - Add kctls for all pins included in the given pincfg
314 */
snd_hda_jack_add_kctls(struct hda_codec * codec,const struct auto_pin_cfg * cfg)315 int snd_hda_jack_add_kctls(struct hda_codec *codec,
316 const struct auto_pin_cfg *cfg)
317 {
318 const hda_nid_t *p;
319 int i, err, lastidx = 0;
320 char lastname[44] = "";
321
322 for (i = 0, p = cfg->line_out_pins; i < cfg->line_outs; i++, p++) {
323 err = add_jack_kctl(codec, *p, cfg, lastname, &lastidx);
324 if (err < 0)
325 return err;
326 }
327 for (i = 0, p = cfg->hp_pins; i < cfg->hp_outs; i++, p++) {
328 if (*p == *cfg->line_out_pins) /* might be duplicated */
329 break;
330 err = add_jack_kctl(codec, *p, cfg, lastname, &lastidx);
331 if (err < 0)
332 return err;
333 }
334 for (i = 0, p = cfg->speaker_pins; i < cfg->speaker_outs; i++, p++) {
335 if (*p == *cfg->line_out_pins) /* might be duplicated */
336 break;
337 err = add_jack_kctl(codec, *p, cfg, lastname, &lastidx);
338 if (err < 0)
339 return err;
340 }
341 for (i = 0; i < cfg->num_inputs; i++) {
342 err = add_jack_kctl(codec, cfg->inputs[i].pin, cfg, lastname, &lastidx);
343 if (err < 0)
344 return err;
345 }
346 for (i = 0, p = cfg->dig_out_pins; i < cfg->dig_outs; i++, p++) {
347 err = add_jack_kctl(codec, *p, cfg, lastname, &lastidx);
348 if (err < 0)
349 return err;
350 }
351 err = add_jack_kctl(codec, cfg->dig_in_pin, cfg, lastname, &lastidx);
352 if (err < 0)
353 return err;
354 err = add_jack_kctl(codec, cfg->mono_out_pin, cfg, lastname, &lastidx);
355 if (err < 0)
356 return err;
357 return 0;
358 }
359 EXPORT_SYMBOL_HDA(snd_hda_jack_add_kctls);
360