• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * Universal Interface for Intel High Definition Audio Codec
4  *
5  * Copyright (c) 2004 Takashi Iwai <tiwai@suse.de>
6  */
7 
8 #include <linux/init.h>
9 #include <linux/delay.h>
10 #include <linux/slab.h>
11 #include <linux/mutex.h>
12 #include <linux/module.h>
13 #include <linux/pm.h>
14 #include <linux/pm_runtime.h>
15 #include <sound/core.h>
16 #include <sound/hda_codec.h>
17 #include <sound/asoundef.h>
18 #include <sound/tlv.h>
19 #include <sound/initval.h>
20 #include <sound/jack.h>
21 #include "hda_local.h"
22 #include "hda_beep.h"
23 #include "hda_jack.h"
24 #include <sound/hda_hwdep.h>
25 #include <sound/hda_component.h>
26 
27 #define codec_in_pm(codec)		snd_hdac_is_in_pm(&codec->core)
28 #define hda_codec_is_power_on(codec)	snd_hdac_is_power_on(&codec->core)
29 #define codec_has_epss(codec) \
30 	((codec)->core.power_caps & AC_PWRST_EPSS)
31 #define codec_has_clkstop(codec) \
32 	((codec)->core.power_caps & AC_PWRST_CLKSTOP)
33 
34 /*
35  * Send and receive a verb - passed to exec_verb override for hdac_device
36  */
codec_exec_verb(struct hdac_device * dev,unsigned int cmd,unsigned int flags,unsigned int * res)37 static int codec_exec_verb(struct hdac_device *dev, unsigned int cmd,
38 			   unsigned int flags, unsigned int *res)
39 {
40 	struct hda_codec *codec = container_of(dev, struct hda_codec, core);
41 	struct hda_bus *bus = codec->bus;
42 	int err;
43 
44 	if (cmd == ~0)
45 		return -1;
46 
47  again:
48 	snd_hda_power_up_pm(codec);
49 	mutex_lock(&bus->core.cmd_mutex);
50 	if (flags & HDA_RW_NO_RESPONSE_FALLBACK)
51 		bus->no_response_fallback = 1;
52 	err = snd_hdac_bus_exec_verb_unlocked(&bus->core, codec->core.addr,
53 					      cmd, res);
54 	bus->no_response_fallback = 0;
55 	mutex_unlock(&bus->core.cmd_mutex);
56 	snd_hda_power_down_pm(codec);
57 	if (!codec_in_pm(codec) && res && err == -EAGAIN) {
58 		if (bus->response_reset) {
59 			codec_dbg(codec,
60 				  "resetting BUS due to fatal communication error\n");
61 			snd_hda_bus_reset(bus);
62 		}
63 		goto again;
64 	}
65 	/* clear reset-flag when the communication gets recovered */
66 	if (!err || codec_in_pm(codec))
67 		bus->response_reset = 0;
68 	return err;
69 }
70 
71 /**
72  * snd_hda_sequence_write - sequence writes
73  * @codec: the HDA codec
74  * @seq: VERB array to send
75  *
76  * Send the commands sequentially from the given array.
77  * The array must be terminated with NID=0.
78  */
snd_hda_sequence_write(struct hda_codec * codec,const struct hda_verb * seq)79 void snd_hda_sequence_write(struct hda_codec *codec, const struct hda_verb *seq)
80 {
81 	for (; seq->nid; seq++)
82 		snd_hda_codec_write(codec, seq->nid, 0, seq->verb, seq->param);
83 }
84 EXPORT_SYMBOL_GPL(snd_hda_sequence_write);
85 
86 /* connection list element */
87 struct hda_conn_list {
88 	struct list_head list;
89 	int len;
90 	hda_nid_t nid;
91 	hda_nid_t conns[];
92 };
93 
94 /* look up the cached results */
95 static struct hda_conn_list *
lookup_conn_list(struct hda_codec * codec,hda_nid_t nid)96 lookup_conn_list(struct hda_codec *codec, hda_nid_t nid)
97 {
98 	struct hda_conn_list *p;
99 	list_for_each_entry(p, &codec->conn_list, list) {
100 		if (p->nid == nid)
101 			return p;
102 	}
103 	return NULL;
104 }
105 
add_conn_list(struct hda_codec * codec,hda_nid_t nid,int len,const hda_nid_t * list)106 static int add_conn_list(struct hda_codec *codec, hda_nid_t nid, int len,
107 			 const hda_nid_t *list)
108 {
109 	struct hda_conn_list *p;
110 
111 	p = kmalloc(struct_size(p, conns, len), GFP_KERNEL);
112 	if (!p)
113 		return -ENOMEM;
114 	p->len = len;
115 	p->nid = nid;
116 	memcpy(p->conns, list, len * sizeof(hda_nid_t));
117 	list_add(&p->list, &codec->conn_list);
118 	return 0;
119 }
120 
remove_conn_list(struct hda_codec * codec)121 static void remove_conn_list(struct hda_codec *codec)
122 {
123 	while (!list_empty(&codec->conn_list)) {
124 		struct hda_conn_list *p;
125 		p = list_first_entry(&codec->conn_list, typeof(*p), list);
126 		list_del(&p->list);
127 		kfree(p);
128 	}
129 }
130 
131 /* read the connection and add to the cache */
read_and_add_raw_conns(struct hda_codec * codec,hda_nid_t nid)132 static int read_and_add_raw_conns(struct hda_codec *codec, hda_nid_t nid)
133 {
134 	hda_nid_t list[32];
135 	hda_nid_t *result = list;
136 	int len;
137 
138 	len = snd_hda_get_raw_connections(codec, nid, list, ARRAY_SIZE(list));
139 	if (len == -ENOSPC) {
140 		len = snd_hda_get_num_raw_conns(codec, nid);
141 		result = kmalloc_array(len, sizeof(hda_nid_t), GFP_KERNEL);
142 		if (!result)
143 			return -ENOMEM;
144 		len = snd_hda_get_raw_connections(codec, nid, result, len);
145 	}
146 	if (len >= 0)
147 		len = snd_hda_override_conn_list(codec, nid, len, result);
148 	if (result != list)
149 		kfree(result);
150 	return len;
151 }
152 
153 /**
154  * snd_hda_get_conn_list - get connection list
155  * @codec: the HDA codec
156  * @nid: NID to parse
157  * @listp: the pointer to store NID list
158  *
159  * Parses the connection list of the given widget and stores the pointer
160  * to the list of NIDs.
161  *
162  * Returns the number of connections, or a negative error code.
163  *
164  * Note that the returned pointer isn't protected against the list
165  * modification.  If snd_hda_override_conn_list() might be called
166  * concurrently, protect with a mutex appropriately.
167  */
snd_hda_get_conn_list(struct hda_codec * codec,hda_nid_t nid,const hda_nid_t ** listp)168 int snd_hda_get_conn_list(struct hda_codec *codec, hda_nid_t nid,
169 			  const hda_nid_t **listp)
170 {
171 	bool added = false;
172 
173 	for (;;) {
174 		int err;
175 		const struct hda_conn_list *p;
176 
177 		/* if the connection-list is already cached, read it */
178 		p = lookup_conn_list(codec, nid);
179 		if (p) {
180 			if (listp)
181 				*listp = p->conns;
182 			return p->len;
183 		}
184 		if (snd_BUG_ON(added))
185 			return -EINVAL;
186 
187 		err = read_and_add_raw_conns(codec, nid);
188 		if (err < 0)
189 			return err;
190 		added = true;
191 	}
192 }
193 EXPORT_SYMBOL_GPL(snd_hda_get_conn_list);
194 
195 /**
196  * snd_hda_get_connections - copy connection list
197  * @codec: the HDA codec
198  * @nid: NID to parse
199  * @conn_list: connection list array; when NULL, checks only the size
200  * @max_conns: max. number of connections to store
201  *
202  * Parses the connection list of the given widget and stores the list
203  * of NIDs.
204  *
205  * Returns the number of connections, or a negative error code.
206  */
snd_hda_get_connections(struct hda_codec * codec,hda_nid_t nid,hda_nid_t * conn_list,int max_conns)207 int snd_hda_get_connections(struct hda_codec *codec, hda_nid_t nid,
208 			    hda_nid_t *conn_list, int max_conns)
209 {
210 	const hda_nid_t *list;
211 	int len = snd_hda_get_conn_list(codec, nid, &list);
212 
213 	if (len > 0 && conn_list) {
214 		if (len > max_conns) {
215 			codec_err(codec, "Too many connections %d for NID 0x%x\n",
216 				   len, nid);
217 			return -EINVAL;
218 		}
219 		memcpy(conn_list, list, len * sizeof(hda_nid_t));
220 	}
221 
222 	return len;
223 }
224 EXPORT_SYMBOL_GPL(snd_hda_get_connections);
225 
226 /**
227  * snd_hda_override_conn_list - add/modify the connection-list to cache
228  * @codec: the HDA codec
229  * @nid: NID to parse
230  * @len: number of connection list entries
231  * @list: the list of connection entries
232  *
233  * Add or modify the given connection-list to the cache.  If the corresponding
234  * cache already exists, invalidate it and append a new one.
235  *
236  * Returns zero or a negative error code.
237  */
snd_hda_override_conn_list(struct hda_codec * codec,hda_nid_t nid,int len,const hda_nid_t * list)238 int snd_hda_override_conn_list(struct hda_codec *codec, hda_nid_t nid, int len,
239 			       const hda_nid_t *list)
240 {
241 	struct hda_conn_list *p;
242 
243 	p = lookup_conn_list(codec, nid);
244 	if (p) {
245 		list_del(&p->list);
246 		kfree(p);
247 	}
248 
249 	return add_conn_list(codec, nid, len, list);
250 }
251 EXPORT_SYMBOL_GPL(snd_hda_override_conn_list);
252 
253 /**
254  * snd_hda_get_conn_index - get the connection index of the given NID
255  * @codec: the HDA codec
256  * @mux: NID containing the list
257  * @nid: NID to select
258  * @recursive: 1 when searching NID recursively, otherwise 0
259  *
260  * Parses the connection list of the widget @mux and checks whether the
261  * widget @nid is present.  If it is, return the connection index.
262  * Otherwise it returns -1.
263  */
snd_hda_get_conn_index(struct hda_codec * codec,hda_nid_t mux,hda_nid_t nid,int recursive)264 int snd_hda_get_conn_index(struct hda_codec *codec, hda_nid_t mux,
265 			   hda_nid_t nid, int recursive)
266 {
267 	const hda_nid_t *conn;
268 	int i, nums;
269 
270 	nums = snd_hda_get_conn_list(codec, mux, &conn);
271 	for (i = 0; i < nums; i++)
272 		if (conn[i] == nid)
273 			return i;
274 	if (!recursive)
275 		return -1;
276 	if (recursive > 10) {
277 		codec_dbg(codec, "too deep connection for 0x%x\n", nid);
278 		return -1;
279 	}
280 	recursive++;
281 	for (i = 0; i < nums; i++) {
282 		unsigned int type = get_wcaps_type(get_wcaps(codec, conn[i]));
283 		if (type == AC_WID_PIN || type == AC_WID_AUD_OUT)
284 			continue;
285 		if (snd_hda_get_conn_index(codec, conn[i], nid, recursive) >= 0)
286 			return i;
287 	}
288 	return -1;
289 }
290 EXPORT_SYMBOL_GPL(snd_hda_get_conn_index);
291 
292 /**
293  * snd_hda_get_num_devices - get DEVLIST_LEN parameter of the given widget
294  *  @codec: the HDA codec
295  *  @nid: NID of the pin to parse
296  *
297  * Get the device entry number on the given widget. This is a feature of
298  * DP MST audio. Each pin can have several device entries in it.
299  */
snd_hda_get_num_devices(struct hda_codec * codec,hda_nid_t nid)300 unsigned int snd_hda_get_num_devices(struct hda_codec *codec, hda_nid_t nid)
301 {
302 	unsigned int wcaps = get_wcaps(codec, nid);
303 	unsigned int parm;
304 
305 	if (!codec->dp_mst || !(wcaps & AC_WCAP_DIGITAL) ||
306 	    get_wcaps_type(wcaps) != AC_WID_PIN)
307 		return 0;
308 
309 	parm = snd_hdac_read_parm_uncached(&codec->core, nid, AC_PAR_DEVLIST_LEN);
310 	if (parm == -1)
311 		parm = 0;
312 	return parm & AC_DEV_LIST_LEN_MASK;
313 }
314 EXPORT_SYMBOL_GPL(snd_hda_get_num_devices);
315 
316 /**
317  * snd_hda_get_devices - copy device list without cache
318  * @codec: the HDA codec
319  * @nid: NID of the pin to parse
320  * @dev_list: device list array
321  * @max_devices: max. number of devices to store
322  *
323  * Copy the device list. This info is dynamic and so not cached.
324  * Currently called only from hda_proc.c, so not exported.
325  */
snd_hda_get_devices(struct hda_codec * codec,hda_nid_t nid,u8 * dev_list,int max_devices)326 int snd_hda_get_devices(struct hda_codec *codec, hda_nid_t nid,
327 			u8 *dev_list, int max_devices)
328 {
329 	unsigned int parm;
330 	int i, dev_len, devices;
331 
332 	parm = snd_hda_get_num_devices(codec, nid);
333 	if (!parm)	/* not multi-stream capable */
334 		return 0;
335 
336 	dev_len = parm + 1;
337 	dev_len = dev_len < max_devices ? dev_len : max_devices;
338 
339 	devices = 0;
340 	while (devices < dev_len) {
341 		if (snd_hdac_read(&codec->core, nid,
342 				  AC_VERB_GET_DEVICE_LIST, devices, &parm))
343 			break; /* error */
344 
345 		for (i = 0; i < 8; i++) {
346 			dev_list[devices] = (u8)parm;
347 			parm >>= 4;
348 			devices++;
349 			if (devices >= dev_len)
350 				break;
351 		}
352 	}
353 	return devices;
354 }
355 
356 /**
357  * snd_hda_get_dev_select - get device entry select on the pin
358  * @codec: the HDA codec
359  * @nid: NID of the pin to get device entry select
360  *
361  * Get the devcie entry select on the pin. Return the device entry
362  * id selected on the pin. Return 0 means the first device entry
363  * is selected or MST is not supported.
364  */
snd_hda_get_dev_select(struct hda_codec * codec,hda_nid_t nid)365 int snd_hda_get_dev_select(struct hda_codec *codec, hda_nid_t nid)
366 {
367 	/* not support dp_mst will always return 0, using first dev_entry */
368 	if (!codec->dp_mst)
369 		return 0;
370 
371 	return snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_DEVICE_SEL, 0);
372 }
373 EXPORT_SYMBOL_GPL(snd_hda_get_dev_select);
374 
375 /**
376  * snd_hda_set_dev_select - set device entry select on the pin
377  * @codec: the HDA codec
378  * @nid: NID of the pin to set device entry select
379  * @dev_id: device entry id to be set
380  *
381  * Set the device entry select on the pin nid.
382  */
snd_hda_set_dev_select(struct hda_codec * codec,hda_nid_t nid,int dev_id)383 int snd_hda_set_dev_select(struct hda_codec *codec, hda_nid_t nid, int dev_id)
384 {
385 	int ret, num_devices;
386 
387 	/* not support dp_mst will always return 0, using first dev_entry */
388 	if (!codec->dp_mst)
389 		return 0;
390 
391 	/* AC_PAR_DEVLIST_LEN is 0 based. */
392 	num_devices = snd_hda_get_num_devices(codec, nid) + 1;
393 	/* If Device List Length is 0 (num_device = 1),
394 	 * the pin is not multi stream capable.
395 	 * Do nothing in this case.
396 	 */
397 	if (num_devices == 1)
398 		return 0;
399 
400 	/* Behavior of setting index being equal to or greater than
401 	 * Device List Length is not predictable
402 	 */
403 	if (num_devices <= dev_id)
404 		return -EINVAL;
405 
406 	ret = snd_hda_codec_write(codec, nid, 0,
407 			AC_VERB_SET_DEVICE_SEL, dev_id);
408 
409 	return ret;
410 }
411 EXPORT_SYMBOL_GPL(snd_hda_set_dev_select);
412 
413 /*
414  * read widget caps for each widget and store in cache
415  */
read_widget_caps(struct hda_codec * codec,hda_nid_t fg_node)416 static int read_widget_caps(struct hda_codec *codec, hda_nid_t fg_node)
417 {
418 	int i;
419 	hda_nid_t nid;
420 
421 	codec->wcaps = kmalloc_array(codec->core.num_nodes, 4, GFP_KERNEL);
422 	if (!codec->wcaps)
423 		return -ENOMEM;
424 	nid = codec->core.start_nid;
425 	for (i = 0; i < codec->core.num_nodes; i++, nid++)
426 		codec->wcaps[i] = snd_hdac_read_parm_uncached(&codec->core,
427 					nid, AC_PAR_AUDIO_WIDGET_CAP);
428 	return 0;
429 }
430 
431 /* read all pin default configurations and save codec->init_pins */
read_pin_defaults(struct hda_codec * codec)432 static int read_pin_defaults(struct hda_codec *codec)
433 {
434 	hda_nid_t nid;
435 
436 	for_each_hda_codec_node(nid, codec) {
437 		struct hda_pincfg *pin;
438 		unsigned int wcaps = get_wcaps(codec, nid);
439 		unsigned int wid_type = get_wcaps_type(wcaps);
440 		if (wid_type != AC_WID_PIN)
441 			continue;
442 		pin = snd_array_new(&codec->init_pins);
443 		if (!pin)
444 			return -ENOMEM;
445 		pin->nid = nid;
446 		pin->cfg = snd_hda_codec_read(codec, nid, 0,
447 					      AC_VERB_GET_CONFIG_DEFAULT, 0);
448 		/*
449 		 * all device entries are the same widget control so far
450 		 * fixme: if any codec is different, need fix here
451 		 */
452 		pin->ctrl = snd_hda_codec_read(codec, nid, 0,
453 					       AC_VERB_GET_PIN_WIDGET_CONTROL,
454 					       0);
455 	}
456 	return 0;
457 }
458 
459 /* look up the given pin config list and return the item matching with NID */
look_up_pincfg(struct hda_codec * codec,struct snd_array * array,hda_nid_t nid)460 static struct hda_pincfg *look_up_pincfg(struct hda_codec *codec,
461 					 struct snd_array *array,
462 					 hda_nid_t nid)
463 {
464 	struct hda_pincfg *pin;
465 	int i;
466 
467 	snd_array_for_each(array, i, pin) {
468 		if (pin->nid == nid)
469 			return pin;
470 	}
471 	return NULL;
472 }
473 
474 /* set the current pin config value for the given NID.
475  * the value is cached, and read via snd_hda_codec_get_pincfg()
476  */
snd_hda_add_pincfg(struct hda_codec * codec,struct snd_array * list,hda_nid_t nid,unsigned int cfg)477 int snd_hda_add_pincfg(struct hda_codec *codec, struct snd_array *list,
478 		       hda_nid_t nid, unsigned int cfg)
479 {
480 	struct hda_pincfg *pin;
481 
482 	/* the check below may be invalid when pins are added by a fixup
483 	 * dynamically (e.g. via snd_hda_codec_update_widgets()), so disabled
484 	 * for now
485 	 */
486 	/*
487 	if (get_wcaps_type(get_wcaps(codec, nid)) != AC_WID_PIN)
488 		return -EINVAL;
489 	*/
490 
491 	pin = look_up_pincfg(codec, list, nid);
492 	if (!pin) {
493 		pin = snd_array_new(list);
494 		if (!pin)
495 			return -ENOMEM;
496 		pin->nid = nid;
497 	}
498 	pin->cfg = cfg;
499 	return 0;
500 }
501 
502 /**
503  * snd_hda_codec_set_pincfg - Override a pin default configuration
504  * @codec: the HDA codec
505  * @nid: NID to set the pin config
506  * @cfg: the pin default config value
507  *
508  * Override a pin default configuration value in the cache.
509  * This value can be read by snd_hda_codec_get_pincfg() in a higher
510  * priority than the real hardware value.
511  */
snd_hda_codec_set_pincfg(struct hda_codec * codec,hda_nid_t nid,unsigned int cfg)512 int snd_hda_codec_set_pincfg(struct hda_codec *codec,
513 			     hda_nid_t nid, unsigned int cfg)
514 {
515 	return snd_hda_add_pincfg(codec, &codec->driver_pins, nid, cfg);
516 }
517 EXPORT_SYMBOL_GPL(snd_hda_codec_set_pincfg);
518 
519 /**
520  * snd_hda_codec_get_pincfg - Obtain a pin-default configuration
521  * @codec: the HDA codec
522  * @nid: NID to get the pin config
523  *
524  * Get the current pin config value of the given pin NID.
525  * If the pincfg value is cached or overridden via sysfs or driver,
526  * returns the cached value.
527  */
snd_hda_codec_get_pincfg(struct hda_codec * codec,hda_nid_t nid)528 unsigned int snd_hda_codec_get_pincfg(struct hda_codec *codec, hda_nid_t nid)
529 {
530 	struct hda_pincfg *pin;
531 
532 #ifdef CONFIG_SND_HDA_RECONFIG
533 	{
534 		unsigned int cfg = 0;
535 		mutex_lock(&codec->user_mutex);
536 		pin = look_up_pincfg(codec, &codec->user_pins, nid);
537 		if (pin)
538 			cfg = pin->cfg;
539 		mutex_unlock(&codec->user_mutex);
540 		if (cfg)
541 			return cfg;
542 	}
543 #endif
544 	pin = look_up_pincfg(codec, &codec->driver_pins, nid);
545 	if (pin)
546 		return pin->cfg;
547 	pin = look_up_pincfg(codec, &codec->init_pins, nid);
548 	if (pin)
549 		return pin->cfg;
550 	return 0;
551 }
552 EXPORT_SYMBOL_GPL(snd_hda_codec_get_pincfg);
553 
554 /**
555  * snd_hda_codec_set_pin_target - remember the current pinctl target value
556  * @codec: the HDA codec
557  * @nid: pin NID
558  * @val: assigned pinctl value
559  *
560  * This function stores the given value to a pinctl target value in the
561  * pincfg table.  This isn't always as same as the actually written value
562  * but can be referred at any time via snd_hda_codec_get_pin_target().
563  */
snd_hda_codec_set_pin_target(struct hda_codec * codec,hda_nid_t nid,unsigned int val)564 int snd_hda_codec_set_pin_target(struct hda_codec *codec, hda_nid_t nid,
565 				 unsigned int val)
566 {
567 	struct hda_pincfg *pin;
568 
569 	pin = look_up_pincfg(codec, &codec->init_pins, nid);
570 	if (!pin)
571 		return -EINVAL;
572 	pin->target = val;
573 	return 0;
574 }
575 EXPORT_SYMBOL_GPL(snd_hda_codec_set_pin_target);
576 
577 /**
578  * snd_hda_codec_get_pin_target - return the current pinctl target value
579  * @codec: the HDA codec
580  * @nid: pin NID
581  */
snd_hda_codec_get_pin_target(struct hda_codec * codec,hda_nid_t nid)582 int snd_hda_codec_get_pin_target(struct hda_codec *codec, hda_nid_t nid)
583 {
584 	struct hda_pincfg *pin;
585 
586 	pin = look_up_pincfg(codec, &codec->init_pins, nid);
587 	if (!pin)
588 		return 0;
589 	return pin->target;
590 }
591 EXPORT_SYMBOL_GPL(snd_hda_codec_get_pin_target);
592 
593 /**
594  * snd_hda_shutup_pins - Shut up all pins
595  * @codec: the HDA codec
596  *
597  * Clear all pin controls to shup up before suspend for avoiding click noise.
598  * The controls aren't cached so that they can be resumed properly.
599  */
snd_hda_shutup_pins(struct hda_codec * codec)600 void snd_hda_shutup_pins(struct hda_codec *codec)
601 {
602 	const struct hda_pincfg *pin;
603 	int i;
604 
605 	/* don't shut up pins when unloading the driver; otherwise it breaks
606 	 * the default pin setup at the next load of the driver
607 	 */
608 	if (codec->bus->shutdown)
609 		return;
610 	snd_array_for_each(&codec->init_pins, i, pin) {
611 		/* use read here for syncing after issuing each verb */
612 		snd_hda_codec_read(codec, pin->nid, 0,
613 				   AC_VERB_SET_PIN_WIDGET_CONTROL, 0);
614 	}
615 	codec->pins_shutup = 1;
616 }
617 EXPORT_SYMBOL_GPL(snd_hda_shutup_pins);
618 
619 #ifdef CONFIG_PM
620 /* Restore the pin controls cleared previously via snd_hda_shutup_pins() */
restore_shutup_pins(struct hda_codec * codec)621 static void restore_shutup_pins(struct hda_codec *codec)
622 {
623 	const struct hda_pincfg *pin;
624 	int i;
625 
626 	if (!codec->pins_shutup)
627 		return;
628 	if (codec->bus->shutdown)
629 		return;
630 	snd_array_for_each(&codec->init_pins, i, pin) {
631 		snd_hda_codec_write(codec, pin->nid, 0,
632 				    AC_VERB_SET_PIN_WIDGET_CONTROL,
633 				    pin->ctrl);
634 	}
635 	codec->pins_shutup = 0;
636 }
637 #endif
638 
hda_jackpoll_work(struct work_struct * work)639 static void hda_jackpoll_work(struct work_struct *work)
640 {
641 	struct hda_codec *codec =
642 		container_of(work, struct hda_codec, jackpoll_work.work);
643 
644 	/* for non-polling trigger: we need nothing if already powered on */
645 	if (!codec->jackpoll_interval && snd_hdac_is_power_on(&codec->core))
646 		return;
647 
648 	/* the power-up/down sequence triggers the runtime resume */
649 	snd_hda_power_up_pm(codec);
650 	/* update jacks manually if polling is required, too */
651 	if (codec->jackpoll_interval) {
652 		snd_hda_jack_set_dirty_all(codec);
653 		snd_hda_jack_poll_all(codec);
654 	}
655 	snd_hda_power_down_pm(codec);
656 
657 	if (!codec->jackpoll_interval)
658 		return;
659 
660 	schedule_delayed_work(&codec->jackpoll_work,
661 			      codec->jackpoll_interval);
662 }
663 
664 /* release all pincfg lists */
free_init_pincfgs(struct hda_codec * codec)665 static void free_init_pincfgs(struct hda_codec *codec)
666 {
667 	snd_array_free(&codec->driver_pins);
668 #ifdef CONFIG_SND_HDA_RECONFIG
669 	snd_array_free(&codec->user_pins);
670 #endif
671 	snd_array_free(&codec->init_pins);
672 }
673 
674 /*
675  * audio-converter setup caches
676  */
677 struct hda_cvt_setup {
678 	hda_nid_t nid;
679 	u8 stream_tag;
680 	u8 channel_id;
681 	u16 format_id;
682 	unsigned char active;	/* cvt is currently used */
683 	unsigned char dirty;	/* setups should be cleared */
684 };
685 
686 /* get or create a cache entry for the given audio converter NID */
687 static struct hda_cvt_setup *
get_hda_cvt_setup(struct hda_codec * codec,hda_nid_t nid)688 get_hda_cvt_setup(struct hda_codec *codec, hda_nid_t nid)
689 {
690 	struct hda_cvt_setup *p;
691 	int i;
692 
693 	snd_array_for_each(&codec->cvt_setups, i, p) {
694 		if (p->nid == nid)
695 			return p;
696 	}
697 	p = snd_array_new(&codec->cvt_setups);
698 	if (p)
699 		p->nid = nid;
700 	return p;
701 }
702 
703 /*
704  * PCM device
705  */
release_pcm(struct kref * kref)706 static void release_pcm(struct kref *kref)
707 {
708 	struct hda_pcm *pcm = container_of(kref, struct hda_pcm, kref);
709 
710 	if (pcm->pcm)
711 		snd_device_free(pcm->codec->card, pcm->pcm);
712 	clear_bit(pcm->device, pcm->codec->bus->pcm_dev_bits);
713 	kfree(pcm->name);
714 	kfree(pcm);
715 }
716 
snd_hda_codec_pcm_put(struct hda_pcm * pcm)717 void snd_hda_codec_pcm_put(struct hda_pcm *pcm)
718 {
719 	kref_put(&pcm->kref, release_pcm);
720 }
721 EXPORT_SYMBOL_GPL(snd_hda_codec_pcm_put);
722 
snd_hda_codec_pcm_new(struct hda_codec * codec,const char * fmt,...)723 struct hda_pcm *snd_hda_codec_pcm_new(struct hda_codec *codec,
724 				      const char *fmt, ...)
725 {
726 	struct hda_pcm *pcm;
727 	va_list args;
728 
729 	pcm = kzalloc(sizeof(*pcm), GFP_KERNEL);
730 	if (!pcm)
731 		return NULL;
732 
733 	pcm->codec = codec;
734 	kref_init(&pcm->kref);
735 	va_start(args, fmt);
736 	pcm->name = kvasprintf(GFP_KERNEL, fmt, args);
737 	va_end(args);
738 	if (!pcm->name) {
739 		kfree(pcm);
740 		return NULL;
741 	}
742 
743 	list_add_tail(&pcm->list, &codec->pcm_list_head);
744 	return pcm;
745 }
746 EXPORT_SYMBOL_GPL(snd_hda_codec_pcm_new);
747 
748 /*
749  * codec destructor
750  */
codec_release_pcms(struct hda_codec * codec)751 static void codec_release_pcms(struct hda_codec *codec)
752 {
753 	struct hda_pcm *pcm, *n;
754 
755 	list_for_each_entry_safe(pcm, n, &codec->pcm_list_head, list) {
756 		list_del_init(&pcm->list);
757 		if (pcm->pcm)
758 			snd_device_disconnect(codec->card, pcm->pcm);
759 		snd_hda_codec_pcm_put(pcm);
760 	}
761 }
762 
snd_hda_codec_cleanup_for_unbind(struct hda_codec * codec)763 void snd_hda_codec_cleanup_for_unbind(struct hda_codec *codec)
764 {
765 	if (codec->registered) {
766 		/* pm_runtime_put() is called in snd_hdac_device_exit() */
767 		pm_runtime_get_noresume(hda_codec_dev(codec));
768 		pm_runtime_disable(hda_codec_dev(codec));
769 		codec->registered = 0;
770 	}
771 
772 	cancel_delayed_work_sync(&codec->jackpoll_work);
773 	if (!codec->in_freeing)
774 		snd_hda_ctls_clear(codec);
775 	codec_release_pcms(codec);
776 	snd_hda_detach_beep_device(codec);
777 	memset(&codec->patch_ops, 0, sizeof(codec->patch_ops));
778 	snd_hda_jack_tbl_clear(codec);
779 	codec->proc_widget_hook = NULL;
780 	codec->spec = NULL;
781 
782 	/* free only driver_pins so that init_pins + user_pins are restored */
783 	snd_array_free(&codec->driver_pins);
784 	snd_array_free(&codec->cvt_setups);
785 	snd_array_free(&codec->spdif_out);
786 	snd_array_free(&codec->verbs);
787 	codec->preset = NULL;
788 	codec->follower_dig_outs = NULL;
789 	codec->spdif_status_reset = 0;
790 	snd_array_free(&codec->mixers);
791 	snd_array_free(&codec->nids);
792 	remove_conn_list(codec);
793 	snd_hdac_regmap_exit(&codec->core);
794 	codec->configured = 0;
795 }
796 EXPORT_SYMBOL_GPL(snd_hda_codec_cleanup_for_unbind);
797 
798 static unsigned int hda_set_power_state(struct hda_codec *codec,
799 				unsigned int power_state);
800 
801 /* enable/disable display power per codec */
codec_display_power(struct hda_codec * codec,bool enable)802 static void codec_display_power(struct hda_codec *codec, bool enable)
803 {
804 	if (codec->display_power_control)
805 		snd_hdac_display_power(&codec->bus->core, codec->addr, enable);
806 }
807 
808 /* also called from hda_bind.c */
snd_hda_codec_register(struct hda_codec * codec)809 void snd_hda_codec_register(struct hda_codec *codec)
810 {
811 	if (codec->registered)
812 		return;
813 	if (device_is_registered(hda_codec_dev(codec))) {
814 		codec_display_power(codec, true);
815 		pm_runtime_enable(hda_codec_dev(codec));
816 		/* it was powered up in snd_hda_codec_new(), now all done */
817 		snd_hda_power_down(codec);
818 		codec->registered = 1;
819 	}
820 }
821 
snd_hda_codec_dev_register(struct snd_device * device)822 static int snd_hda_codec_dev_register(struct snd_device *device)
823 {
824 	snd_hda_codec_register(device->device_data);
825 	return 0;
826 }
827 
snd_hda_codec_dev_free(struct snd_device * device)828 static int snd_hda_codec_dev_free(struct snd_device *device)
829 {
830 	struct hda_codec *codec = device->device_data;
831 
832 	codec->in_freeing = 1;
833 	/*
834 	 * snd_hda_codec_device_new() is used by legacy HDA and ASoC driver.
835 	 * We can't unregister ASoC device since it will be unregistered in
836 	 * snd_hdac_ext_bus_device_remove().
837 	 */
838 	if (codec->core.type == HDA_DEV_LEGACY)
839 		snd_hdac_device_unregister(&codec->core);
840 	codec_display_power(codec, false);
841 
842 	/*
843 	 * In the case of ASoC HD-audio bus, the device refcount is released in
844 	 * snd_hdac_ext_bus_device_remove() explicitly.
845 	 */
846 	if (codec->core.type == HDA_DEV_LEGACY)
847 		put_device(hda_codec_dev(codec));
848 
849 	return 0;
850 }
851 
snd_hda_codec_dev_release(struct device * dev)852 static void snd_hda_codec_dev_release(struct device *dev)
853 {
854 	struct hda_codec *codec = dev_to_hda_codec(dev);
855 
856 	free_init_pincfgs(codec);
857 	snd_hdac_device_exit(&codec->core);
858 	snd_hda_sysfs_clear(codec);
859 	kfree(codec->modelname);
860 	kfree(codec->wcaps);
861 
862 	/*
863 	 * In the case of ASoC HD-audio, hda_codec is device managed.
864 	 * It will be freed when the ASoC device is removed.
865 	 */
866 	if (codec->core.type == HDA_DEV_LEGACY)
867 		kfree(codec);
868 }
869 
870 #define DEV_NAME_LEN 31
871 
snd_hda_codec_device_init(struct hda_bus * bus,struct snd_card * card,unsigned int codec_addr,struct hda_codec ** codecp)872 static int snd_hda_codec_device_init(struct hda_bus *bus, struct snd_card *card,
873 			unsigned int codec_addr, struct hda_codec **codecp)
874 {
875 	char name[DEV_NAME_LEN];
876 	struct hda_codec *codec;
877 	int err;
878 
879 	dev_dbg(card->dev, "%s: entry\n", __func__);
880 
881 	if (snd_BUG_ON(!bus))
882 		return -EINVAL;
883 	if (snd_BUG_ON(codec_addr > HDA_MAX_CODEC_ADDRESS))
884 		return -EINVAL;
885 
886 	codec = kzalloc(sizeof(*codec), GFP_KERNEL);
887 	if (!codec)
888 		return -ENOMEM;
889 
890 	sprintf(name, "hdaudioC%dD%d", card->number, codec_addr);
891 	err = snd_hdac_device_init(&codec->core, &bus->core, name, codec_addr);
892 	if (err < 0) {
893 		kfree(codec);
894 		return err;
895 	}
896 
897 	codec->core.type = HDA_DEV_LEGACY;
898 	*codecp = codec;
899 
900 	return err;
901 }
902 
903 /**
904  * snd_hda_codec_new - create a HDA codec
905  * @bus: the bus to assign
906  * @card: card for this codec
907  * @codec_addr: the codec address
908  * @codecp: the pointer to store the generated codec
909  *
910  * Returns 0 if successful, or a negative error code.
911  */
snd_hda_codec_new(struct hda_bus * bus,struct snd_card * card,unsigned int codec_addr,struct hda_codec ** codecp)912 int snd_hda_codec_new(struct hda_bus *bus, struct snd_card *card,
913 		      unsigned int codec_addr, struct hda_codec **codecp)
914 {
915 	int ret;
916 
917 	ret = snd_hda_codec_device_init(bus, card, codec_addr, codecp);
918 	if (ret < 0)
919 		return ret;
920 
921 	return snd_hda_codec_device_new(bus, card, codec_addr, *codecp);
922 }
923 EXPORT_SYMBOL_GPL(snd_hda_codec_new);
924 
snd_hda_codec_device_new(struct hda_bus * bus,struct snd_card * card,unsigned int codec_addr,struct hda_codec * codec)925 int snd_hda_codec_device_new(struct hda_bus *bus, struct snd_card *card,
926 			unsigned int codec_addr, struct hda_codec *codec)
927 {
928 	char component[31];
929 	hda_nid_t fg;
930 	int err;
931 	static const struct snd_device_ops dev_ops = {
932 		.dev_register = snd_hda_codec_dev_register,
933 		.dev_free = snd_hda_codec_dev_free,
934 	};
935 
936 	dev_dbg(card->dev, "%s: entry\n", __func__);
937 
938 	if (snd_BUG_ON(!bus))
939 		return -EINVAL;
940 	if (snd_BUG_ON(codec_addr > HDA_MAX_CODEC_ADDRESS))
941 		return -EINVAL;
942 
943 	codec->core.dev.release = snd_hda_codec_dev_release;
944 	codec->core.exec_verb = codec_exec_verb;
945 
946 	codec->bus = bus;
947 	codec->card = card;
948 	codec->addr = codec_addr;
949 	mutex_init(&codec->spdif_mutex);
950 	mutex_init(&codec->control_mutex);
951 	snd_array_init(&codec->mixers, sizeof(struct hda_nid_item), 32);
952 	snd_array_init(&codec->nids, sizeof(struct hda_nid_item), 32);
953 	snd_array_init(&codec->init_pins, sizeof(struct hda_pincfg), 16);
954 	snd_array_init(&codec->driver_pins, sizeof(struct hda_pincfg), 16);
955 	snd_array_init(&codec->cvt_setups, sizeof(struct hda_cvt_setup), 8);
956 	snd_array_init(&codec->spdif_out, sizeof(struct hda_spdif_out), 16);
957 	snd_array_init(&codec->jacktbl, sizeof(struct hda_jack_tbl), 16);
958 	snd_array_init(&codec->verbs, sizeof(struct hda_verb *), 8);
959 	INIT_LIST_HEAD(&codec->conn_list);
960 	INIT_LIST_HEAD(&codec->pcm_list_head);
961 
962 	INIT_DELAYED_WORK(&codec->jackpoll_work, hda_jackpoll_work);
963 	codec->depop_delay = -1;
964 	codec->fixup_id = HDA_FIXUP_ID_NOT_SET;
965 
966 #ifdef CONFIG_PM
967 	codec->power_jiffies = jiffies;
968 #endif
969 
970 	snd_hda_sysfs_init(codec);
971 
972 	if (codec->bus->modelname) {
973 		codec->modelname = kstrdup(codec->bus->modelname, GFP_KERNEL);
974 		if (!codec->modelname) {
975 			err = -ENOMEM;
976 			goto error;
977 		}
978 	}
979 
980 	fg = codec->core.afg ? codec->core.afg : codec->core.mfg;
981 	err = read_widget_caps(codec, fg);
982 	if (err < 0)
983 		goto error;
984 	err = read_pin_defaults(codec);
985 	if (err < 0)
986 		goto error;
987 
988 	/* power-up all before initialization */
989 	hda_set_power_state(codec, AC_PWRST_D0);
990 	codec->core.dev.power.power_state = PMSG_ON;
991 
992 	snd_hda_codec_proc_new(codec);
993 
994 	snd_hda_create_hwdep(codec);
995 
996 	sprintf(component, "HDA:%08x,%08x,%08x", codec->core.vendor_id,
997 		codec->core.subsystem_id, codec->core.revision_id);
998 	snd_component_add(card, component);
999 
1000 	err = snd_device_new(card, SNDRV_DEV_CODEC, codec, &dev_ops);
1001 	if (err < 0)
1002 		goto error;
1003 
1004 	/* PM runtime needs to be enabled later after binding codec */
1005 	pm_runtime_forbid(&codec->core.dev);
1006 
1007 	return 0;
1008 
1009  error:
1010 	put_device(hda_codec_dev(codec));
1011 	return err;
1012 }
1013 EXPORT_SYMBOL_GPL(snd_hda_codec_device_new);
1014 
1015 /**
1016  * snd_hda_codec_update_widgets - Refresh widget caps and pin defaults
1017  * @codec: the HDA codec
1018  *
1019  * Forcibly refresh the all widget caps and the init pin configurations of
1020  * the given codec.
1021  */
snd_hda_codec_update_widgets(struct hda_codec * codec)1022 int snd_hda_codec_update_widgets(struct hda_codec *codec)
1023 {
1024 	hda_nid_t fg;
1025 	int err;
1026 
1027 	err = snd_hdac_refresh_widgets(&codec->core);
1028 	if (err < 0)
1029 		return err;
1030 
1031 	/* Assume the function group node does not change,
1032 	 * only the widget nodes may change.
1033 	 */
1034 	kfree(codec->wcaps);
1035 	fg = codec->core.afg ? codec->core.afg : codec->core.mfg;
1036 	err = read_widget_caps(codec, fg);
1037 	if (err < 0)
1038 		return err;
1039 
1040 	snd_array_free(&codec->init_pins);
1041 	err = read_pin_defaults(codec);
1042 
1043 	return err;
1044 }
1045 EXPORT_SYMBOL_GPL(snd_hda_codec_update_widgets);
1046 
1047 /* update the stream-id if changed */
update_pcm_stream_id(struct hda_codec * codec,struct hda_cvt_setup * p,hda_nid_t nid,u32 stream_tag,int channel_id)1048 static void update_pcm_stream_id(struct hda_codec *codec,
1049 				 struct hda_cvt_setup *p, hda_nid_t nid,
1050 				 u32 stream_tag, int channel_id)
1051 {
1052 	unsigned int oldval, newval;
1053 
1054 	if (p->stream_tag != stream_tag || p->channel_id != channel_id) {
1055 		oldval = snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_CONV, 0);
1056 		newval = (stream_tag << 4) | channel_id;
1057 		if (oldval != newval)
1058 			snd_hda_codec_write(codec, nid, 0,
1059 					    AC_VERB_SET_CHANNEL_STREAMID,
1060 					    newval);
1061 		p->stream_tag = stream_tag;
1062 		p->channel_id = channel_id;
1063 	}
1064 }
1065 
1066 /* update the format-id if changed */
update_pcm_format(struct hda_codec * codec,struct hda_cvt_setup * p,hda_nid_t nid,int format)1067 static void update_pcm_format(struct hda_codec *codec, struct hda_cvt_setup *p,
1068 			      hda_nid_t nid, int format)
1069 {
1070 	unsigned int oldval;
1071 
1072 	if (p->format_id != format) {
1073 		oldval = snd_hda_codec_read(codec, nid, 0,
1074 					    AC_VERB_GET_STREAM_FORMAT, 0);
1075 		if (oldval != format) {
1076 			msleep(1);
1077 			snd_hda_codec_write(codec, nid, 0,
1078 					    AC_VERB_SET_STREAM_FORMAT,
1079 					    format);
1080 		}
1081 		p->format_id = format;
1082 	}
1083 }
1084 
1085 /**
1086  * snd_hda_codec_setup_stream - set up the codec for streaming
1087  * @codec: the CODEC to set up
1088  * @nid: the NID to set up
1089  * @stream_tag: stream tag to pass, it's between 0x1 and 0xf.
1090  * @channel_id: channel id to pass, zero based.
1091  * @format: stream format.
1092  */
snd_hda_codec_setup_stream(struct hda_codec * codec,hda_nid_t nid,u32 stream_tag,int channel_id,int format)1093 void snd_hda_codec_setup_stream(struct hda_codec *codec, hda_nid_t nid,
1094 				u32 stream_tag,
1095 				int channel_id, int format)
1096 {
1097 	struct hda_codec *c;
1098 	struct hda_cvt_setup *p;
1099 	int type;
1100 	int i;
1101 
1102 	if (!nid)
1103 		return;
1104 
1105 	codec_dbg(codec,
1106 		  "hda_codec_setup_stream: NID=0x%x, stream=0x%x, channel=%d, format=0x%x\n",
1107 		  nid, stream_tag, channel_id, format);
1108 	p = get_hda_cvt_setup(codec, nid);
1109 	if (!p)
1110 		return;
1111 
1112 	if (codec->patch_ops.stream_pm)
1113 		codec->patch_ops.stream_pm(codec, nid, true);
1114 	if (codec->pcm_format_first)
1115 		update_pcm_format(codec, p, nid, format);
1116 	update_pcm_stream_id(codec, p, nid, stream_tag, channel_id);
1117 	if (!codec->pcm_format_first)
1118 		update_pcm_format(codec, p, nid, format);
1119 
1120 	p->active = 1;
1121 	p->dirty = 0;
1122 
1123 	/* make other inactive cvts with the same stream-tag dirty */
1124 	type = get_wcaps_type(get_wcaps(codec, nid));
1125 	list_for_each_codec(c, codec->bus) {
1126 		snd_array_for_each(&c->cvt_setups, i, p) {
1127 			if (!p->active && p->stream_tag == stream_tag &&
1128 			    get_wcaps_type(get_wcaps(c, p->nid)) == type)
1129 				p->dirty = 1;
1130 		}
1131 	}
1132 }
1133 EXPORT_SYMBOL_GPL(snd_hda_codec_setup_stream);
1134 
1135 static void really_cleanup_stream(struct hda_codec *codec,
1136 				  struct hda_cvt_setup *q);
1137 
1138 /**
1139  * __snd_hda_codec_cleanup_stream - clean up the codec for closing
1140  * @codec: the CODEC to clean up
1141  * @nid: the NID to clean up
1142  * @do_now: really clean up the stream instead of clearing the active flag
1143  */
__snd_hda_codec_cleanup_stream(struct hda_codec * codec,hda_nid_t nid,int do_now)1144 void __snd_hda_codec_cleanup_stream(struct hda_codec *codec, hda_nid_t nid,
1145 				    int do_now)
1146 {
1147 	struct hda_cvt_setup *p;
1148 
1149 	if (!nid)
1150 		return;
1151 
1152 	if (codec->no_sticky_stream)
1153 		do_now = 1;
1154 
1155 	codec_dbg(codec, "hda_codec_cleanup_stream: NID=0x%x\n", nid);
1156 	p = get_hda_cvt_setup(codec, nid);
1157 	if (p) {
1158 		/* here we just clear the active flag when do_now isn't set;
1159 		 * actual clean-ups will be done later in
1160 		 * purify_inactive_streams() called from snd_hda_codec_prpapre()
1161 		 */
1162 		if (do_now)
1163 			really_cleanup_stream(codec, p);
1164 		else
1165 			p->active = 0;
1166 	}
1167 }
1168 EXPORT_SYMBOL_GPL(__snd_hda_codec_cleanup_stream);
1169 
really_cleanup_stream(struct hda_codec * codec,struct hda_cvt_setup * q)1170 static void really_cleanup_stream(struct hda_codec *codec,
1171 				  struct hda_cvt_setup *q)
1172 {
1173 	hda_nid_t nid = q->nid;
1174 	if (q->stream_tag || q->channel_id)
1175 		snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_CHANNEL_STREAMID, 0);
1176 	if (q->format_id)
1177 		snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_STREAM_FORMAT, 0
1178 );
1179 	memset(q, 0, sizeof(*q));
1180 	q->nid = nid;
1181 	if (codec->patch_ops.stream_pm)
1182 		codec->patch_ops.stream_pm(codec, nid, false);
1183 }
1184 
1185 /* clean up the all conflicting obsolete streams */
purify_inactive_streams(struct hda_codec * codec)1186 static void purify_inactive_streams(struct hda_codec *codec)
1187 {
1188 	struct hda_codec *c;
1189 	struct hda_cvt_setup *p;
1190 	int i;
1191 
1192 	list_for_each_codec(c, codec->bus) {
1193 		snd_array_for_each(&c->cvt_setups, i, p) {
1194 			if (p->dirty)
1195 				really_cleanup_stream(c, p);
1196 		}
1197 	}
1198 }
1199 
1200 #ifdef CONFIG_PM
1201 /* clean up all streams; called from suspend */
hda_cleanup_all_streams(struct hda_codec * codec)1202 static void hda_cleanup_all_streams(struct hda_codec *codec)
1203 {
1204 	struct hda_cvt_setup *p;
1205 	int i;
1206 
1207 	snd_array_for_each(&codec->cvt_setups, i, p) {
1208 		if (p->stream_tag)
1209 			really_cleanup_stream(codec, p);
1210 	}
1211 }
1212 #endif
1213 
1214 /*
1215  * amp access functions
1216  */
1217 
1218 /**
1219  * query_amp_caps - query AMP capabilities
1220  * @codec: the HD-auio codec
1221  * @nid: the NID to query
1222  * @direction: either #HDA_INPUT or #HDA_OUTPUT
1223  *
1224  * Query AMP capabilities for the given widget and direction.
1225  * Returns the obtained capability bits.
1226  *
1227  * When cap bits have been already read, this doesn't read again but
1228  * returns the cached value.
1229  */
query_amp_caps(struct hda_codec * codec,hda_nid_t nid,int direction)1230 u32 query_amp_caps(struct hda_codec *codec, hda_nid_t nid, int direction)
1231 {
1232 	if (!(get_wcaps(codec, nid) & AC_WCAP_AMP_OVRD))
1233 		nid = codec->core.afg;
1234 	return snd_hda_param_read(codec, nid,
1235 				  direction == HDA_OUTPUT ?
1236 				  AC_PAR_AMP_OUT_CAP : AC_PAR_AMP_IN_CAP);
1237 }
1238 EXPORT_SYMBOL_GPL(query_amp_caps);
1239 
1240 /**
1241  * snd_hda_check_amp_caps - query AMP capabilities
1242  * @codec: the HD-audio codec
1243  * @nid: the NID to query
1244  * @dir: either #HDA_INPUT or #HDA_OUTPUT
1245  * @bits: bit mask to check the result
1246  *
1247  * Check whether the widget has the given amp capability for the direction.
1248  */
snd_hda_check_amp_caps(struct hda_codec * codec,hda_nid_t nid,int dir,unsigned int bits)1249 bool snd_hda_check_amp_caps(struct hda_codec *codec, hda_nid_t nid,
1250 			   int dir, unsigned int bits)
1251 {
1252 	if (!nid)
1253 		return false;
1254 	if (get_wcaps(codec, nid) & (1 << (dir + 1)))
1255 		if (query_amp_caps(codec, nid, dir) & bits)
1256 			return true;
1257 	return false;
1258 }
1259 EXPORT_SYMBOL_GPL(snd_hda_check_amp_caps);
1260 
1261 /**
1262  * snd_hda_override_amp_caps - Override the AMP capabilities
1263  * @codec: the CODEC to clean up
1264  * @nid: the NID to clean up
1265  * @dir: either #HDA_INPUT or #HDA_OUTPUT
1266  * @caps: the capability bits to set
1267  *
1268  * Override the cached AMP caps bits value by the given one.
1269  * This function is useful if the driver needs to adjust the AMP ranges,
1270  * e.g. limit to 0dB, etc.
1271  *
1272  * Returns zero if successful or a negative error code.
1273  */
snd_hda_override_amp_caps(struct hda_codec * codec,hda_nid_t nid,int dir,unsigned int caps)1274 int snd_hda_override_amp_caps(struct hda_codec *codec, hda_nid_t nid, int dir,
1275 			      unsigned int caps)
1276 {
1277 	unsigned int parm;
1278 
1279 	snd_hda_override_wcaps(codec, nid,
1280 			       get_wcaps(codec, nid) | AC_WCAP_AMP_OVRD);
1281 	parm = dir == HDA_OUTPUT ? AC_PAR_AMP_OUT_CAP : AC_PAR_AMP_IN_CAP;
1282 	return snd_hdac_override_parm(&codec->core, nid, parm, caps);
1283 }
1284 EXPORT_SYMBOL_GPL(snd_hda_override_amp_caps);
1285 
encode_amp(struct hda_codec * codec,hda_nid_t nid,int ch,int dir,int idx)1286 static unsigned int encode_amp(struct hda_codec *codec, hda_nid_t nid,
1287 			       int ch, int dir, int idx)
1288 {
1289 	unsigned int cmd = snd_hdac_regmap_encode_amp(nid, ch, dir, idx);
1290 
1291 	/* enable fake mute if no h/w mute but min=mute */
1292 	if ((query_amp_caps(codec, nid, dir) &
1293 	     (AC_AMPCAP_MUTE | AC_AMPCAP_MIN_MUTE)) == AC_AMPCAP_MIN_MUTE)
1294 		cmd |= AC_AMP_FAKE_MUTE;
1295 	return cmd;
1296 }
1297 
1298 /**
1299  * snd_hda_codec_amp_update - update the AMP mono value
1300  * @codec: HD-audio codec
1301  * @nid: NID to read the AMP value
1302  * @ch: channel to update (0 or 1)
1303  * @dir: #HDA_INPUT or #HDA_OUTPUT
1304  * @idx: the index value (only for input direction)
1305  * @mask: bit mask to set
1306  * @val: the bits value to set
1307  *
1308  * Update the AMP values for the given channel, direction and index.
1309  */
snd_hda_codec_amp_update(struct hda_codec * codec,hda_nid_t nid,int ch,int dir,int idx,int mask,int val)1310 int snd_hda_codec_amp_update(struct hda_codec *codec, hda_nid_t nid,
1311 			     int ch, int dir, int idx, int mask, int val)
1312 {
1313 	unsigned int cmd = encode_amp(codec, nid, ch, dir, idx);
1314 
1315 	return snd_hdac_regmap_update_raw(&codec->core, cmd, mask, val);
1316 }
1317 EXPORT_SYMBOL_GPL(snd_hda_codec_amp_update);
1318 
1319 /**
1320  * snd_hda_codec_amp_stereo - update the AMP stereo values
1321  * @codec: HD-audio codec
1322  * @nid: NID to read the AMP value
1323  * @direction: #HDA_INPUT or #HDA_OUTPUT
1324  * @idx: the index value (only for input direction)
1325  * @mask: bit mask to set
1326  * @val: the bits value to set
1327  *
1328  * Update the AMP values like snd_hda_codec_amp_update(), but for a
1329  * stereo widget with the same mask and value.
1330  */
snd_hda_codec_amp_stereo(struct hda_codec * codec,hda_nid_t nid,int direction,int idx,int mask,int val)1331 int snd_hda_codec_amp_stereo(struct hda_codec *codec, hda_nid_t nid,
1332 			     int direction, int idx, int mask, int val)
1333 {
1334 	int ch, ret = 0;
1335 
1336 	if (snd_BUG_ON(mask & ~0xff))
1337 		mask &= 0xff;
1338 	for (ch = 0; ch < 2; ch++)
1339 		ret |= snd_hda_codec_amp_update(codec, nid, ch, direction,
1340 						idx, mask, val);
1341 	return ret;
1342 }
1343 EXPORT_SYMBOL_GPL(snd_hda_codec_amp_stereo);
1344 
1345 /**
1346  * snd_hda_codec_amp_init - initialize the AMP value
1347  * @codec: the HDA codec
1348  * @nid: NID to read the AMP value
1349  * @ch: channel (left=0 or right=1)
1350  * @dir: #HDA_INPUT or #HDA_OUTPUT
1351  * @idx: the index value (only for input direction)
1352  * @mask: bit mask to set
1353  * @val: the bits value to set
1354  *
1355  * Works like snd_hda_codec_amp_update() but it writes the value only at
1356  * the first access.  If the amp was already initialized / updated beforehand,
1357  * this does nothing.
1358  */
snd_hda_codec_amp_init(struct hda_codec * codec,hda_nid_t nid,int ch,int dir,int idx,int mask,int val)1359 int snd_hda_codec_amp_init(struct hda_codec *codec, hda_nid_t nid, int ch,
1360 			   int dir, int idx, int mask, int val)
1361 {
1362 	unsigned int cmd = encode_amp(codec, nid, ch, dir, idx);
1363 
1364 	if (!codec->core.regmap)
1365 		return -EINVAL;
1366 	return snd_hdac_regmap_update_raw_once(&codec->core, cmd, mask, val);
1367 }
1368 EXPORT_SYMBOL_GPL(snd_hda_codec_amp_init);
1369 
1370 /**
1371  * snd_hda_codec_amp_init_stereo - initialize the stereo AMP value
1372  * @codec: the HDA codec
1373  * @nid: NID to read the AMP value
1374  * @dir: #HDA_INPUT or #HDA_OUTPUT
1375  * @idx: the index value (only for input direction)
1376  * @mask: bit mask to set
1377  * @val: the bits value to set
1378  *
1379  * Call snd_hda_codec_amp_init() for both stereo channels.
1380  */
snd_hda_codec_amp_init_stereo(struct hda_codec * codec,hda_nid_t nid,int dir,int idx,int mask,int val)1381 int snd_hda_codec_amp_init_stereo(struct hda_codec *codec, hda_nid_t nid,
1382 				  int dir, int idx, int mask, int val)
1383 {
1384 	int ch, ret = 0;
1385 
1386 	if (snd_BUG_ON(mask & ~0xff))
1387 		mask &= 0xff;
1388 	for (ch = 0; ch < 2; ch++)
1389 		ret |= snd_hda_codec_amp_init(codec, nid, ch, dir,
1390 					      idx, mask, val);
1391 	return ret;
1392 }
1393 EXPORT_SYMBOL_GPL(snd_hda_codec_amp_init_stereo);
1394 
get_amp_max_value(struct hda_codec * codec,hda_nid_t nid,int dir,unsigned int ofs)1395 static u32 get_amp_max_value(struct hda_codec *codec, hda_nid_t nid, int dir,
1396 			     unsigned int ofs)
1397 {
1398 	u32 caps = query_amp_caps(codec, nid, dir);
1399 	/* get num steps */
1400 	caps = (caps & AC_AMPCAP_NUM_STEPS) >> AC_AMPCAP_NUM_STEPS_SHIFT;
1401 	if (ofs < caps)
1402 		caps -= ofs;
1403 	return caps;
1404 }
1405 
1406 /**
1407  * snd_hda_mixer_amp_volume_info - Info callback for a standard AMP mixer
1408  * @kcontrol: referred ctl element
1409  * @uinfo: pointer to get/store the data
1410  *
1411  * The control element is supposed to have the private_value field
1412  * set up via HDA_COMPOSE_AMP_VAL*() or related macros.
1413  */
snd_hda_mixer_amp_volume_info(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_info * uinfo)1414 int snd_hda_mixer_amp_volume_info(struct snd_kcontrol *kcontrol,
1415 				  struct snd_ctl_elem_info *uinfo)
1416 {
1417 	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1418 	u16 nid = get_amp_nid(kcontrol);
1419 	u8 chs = get_amp_channels(kcontrol);
1420 	int dir = get_amp_direction(kcontrol);
1421 	unsigned int ofs = get_amp_offset(kcontrol);
1422 
1423 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
1424 	uinfo->count = chs == 3 ? 2 : 1;
1425 	uinfo->value.integer.min = 0;
1426 	uinfo->value.integer.max = get_amp_max_value(codec, nid, dir, ofs);
1427 	if (!uinfo->value.integer.max) {
1428 		codec_warn(codec,
1429 			   "num_steps = 0 for NID=0x%x (ctl = %s)\n",
1430 			   nid, kcontrol->id.name);
1431 		return -EINVAL;
1432 	}
1433 	return 0;
1434 }
1435 EXPORT_SYMBOL_GPL(snd_hda_mixer_amp_volume_info);
1436 
1437 
1438 static inline unsigned int
read_amp_value(struct hda_codec * codec,hda_nid_t nid,int ch,int dir,int idx,unsigned int ofs)1439 read_amp_value(struct hda_codec *codec, hda_nid_t nid,
1440 	       int ch, int dir, int idx, unsigned int ofs)
1441 {
1442 	unsigned int val;
1443 	val = snd_hda_codec_amp_read(codec, nid, ch, dir, idx);
1444 	val &= HDA_AMP_VOLMASK;
1445 	if (val >= ofs)
1446 		val -= ofs;
1447 	else
1448 		val = 0;
1449 	return val;
1450 }
1451 
1452 static inline int
update_amp_value(struct hda_codec * codec,hda_nid_t nid,int ch,int dir,int idx,unsigned int ofs,unsigned int val)1453 update_amp_value(struct hda_codec *codec, hda_nid_t nid,
1454 		 int ch, int dir, int idx, unsigned int ofs,
1455 		 unsigned int val)
1456 {
1457 	unsigned int maxval;
1458 
1459 	if (val > 0)
1460 		val += ofs;
1461 	/* ofs = 0: raw max value */
1462 	maxval = get_amp_max_value(codec, nid, dir, 0);
1463 	if (val > maxval)
1464 		val = maxval;
1465 	return snd_hda_codec_amp_update(codec, nid, ch, dir, idx,
1466 					HDA_AMP_VOLMASK, val);
1467 }
1468 
1469 /**
1470  * snd_hda_mixer_amp_volume_get - Get callback for a standard AMP mixer volume
1471  * @kcontrol: ctl element
1472  * @ucontrol: pointer to get/store the data
1473  *
1474  * The control element is supposed to have the private_value field
1475  * set up via HDA_COMPOSE_AMP_VAL*() or related macros.
1476  */
snd_hda_mixer_amp_volume_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1477 int snd_hda_mixer_amp_volume_get(struct snd_kcontrol *kcontrol,
1478 				 struct snd_ctl_elem_value *ucontrol)
1479 {
1480 	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1481 	hda_nid_t nid = get_amp_nid(kcontrol);
1482 	int chs = get_amp_channels(kcontrol);
1483 	int dir = get_amp_direction(kcontrol);
1484 	int idx = get_amp_index(kcontrol);
1485 	unsigned int ofs = get_amp_offset(kcontrol);
1486 	long *valp = ucontrol->value.integer.value;
1487 
1488 	if (chs & 1)
1489 		*valp++ = read_amp_value(codec, nid, 0, dir, idx, ofs);
1490 	if (chs & 2)
1491 		*valp = read_amp_value(codec, nid, 1, dir, idx, ofs);
1492 	return 0;
1493 }
1494 EXPORT_SYMBOL_GPL(snd_hda_mixer_amp_volume_get);
1495 
1496 /**
1497  * snd_hda_mixer_amp_volume_put - Put callback for a standard AMP mixer volume
1498  * @kcontrol: ctl element
1499  * @ucontrol: pointer to get/store the data
1500  *
1501  * The control element is supposed to have the private_value field
1502  * set up via HDA_COMPOSE_AMP_VAL*() or related macros.
1503  */
snd_hda_mixer_amp_volume_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1504 int snd_hda_mixer_amp_volume_put(struct snd_kcontrol *kcontrol,
1505 				 struct snd_ctl_elem_value *ucontrol)
1506 {
1507 	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1508 	hda_nid_t nid = get_amp_nid(kcontrol);
1509 	int chs = get_amp_channels(kcontrol);
1510 	int dir = get_amp_direction(kcontrol);
1511 	int idx = get_amp_index(kcontrol);
1512 	unsigned int ofs = get_amp_offset(kcontrol);
1513 	long *valp = ucontrol->value.integer.value;
1514 	int change = 0;
1515 
1516 	if (chs & 1) {
1517 		change = update_amp_value(codec, nid, 0, dir, idx, ofs, *valp);
1518 		valp++;
1519 	}
1520 	if (chs & 2)
1521 		change |= update_amp_value(codec, nid, 1, dir, idx, ofs, *valp);
1522 	return change;
1523 }
1524 EXPORT_SYMBOL_GPL(snd_hda_mixer_amp_volume_put);
1525 
1526 /* inquiry the amp caps and convert to TLV */
get_ctl_amp_tlv(struct snd_kcontrol * kcontrol,unsigned int * tlv)1527 static void get_ctl_amp_tlv(struct snd_kcontrol *kcontrol, unsigned int *tlv)
1528 {
1529 	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1530 	hda_nid_t nid = get_amp_nid(kcontrol);
1531 	int dir = get_amp_direction(kcontrol);
1532 	unsigned int ofs = get_amp_offset(kcontrol);
1533 	bool min_mute = get_amp_min_mute(kcontrol);
1534 	u32 caps, val1, val2;
1535 
1536 	caps = query_amp_caps(codec, nid, dir);
1537 	val2 = (caps & AC_AMPCAP_STEP_SIZE) >> AC_AMPCAP_STEP_SIZE_SHIFT;
1538 	val2 = (val2 + 1) * 25;
1539 	val1 = -((caps & AC_AMPCAP_OFFSET) >> AC_AMPCAP_OFFSET_SHIFT);
1540 	val1 += ofs;
1541 	val1 = ((int)val1) * ((int)val2);
1542 	if (min_mute || (caps & AC_AMPCAP_MIN_MUTE))
1543 		val2 |= TLV_DB_SCALE_MUTE;
1544 	tlv[SNDRV_CTL_TLVO_TYPE] = SNDRV_CTL_TLVT_DB_SCALE;
1545 	tlv[SNDRV_CTL_TLVO_LEN] = 2 * sizeof(unsigned int);
1546 	tlv[SNDRV_CTL_TLVO_DB_SCALE_MIN] = val1;
1547 	tlv[SNDRV_CTL_TLVO_DB_SCALE_MUTE_AND_STEP] = val2;
1548 }
1549 
1550 /**
1551  * snd_hda_mixer_amp_tlv - TLV callback for a standard AMP mixer volume
1552  * @kcontrol: ctl element
1553  * @op_flag: operation flag
1554  * @size: byte size of input TLV
1555  * @_tlv: TLV data
1556  *
1557  * The control element is supposed to have the private_value field
1558  * set up via HDA_COMPOSE_AMP_VAL*() or related macros.
1559  */
snd_hda_mixer_amp_tlv(struct snd_kcontrol * kcontrol,int op_flag,unsigned int size,unsigned int __user * _tlv)1560 int snd_hda_mixer_amp_tlv(struct snd_kcontrol *kcontrol, int op_flag,
1561 			  unsigned int size, unsigned int __user *_tlv)
1562 {
1563 	unsigned int tlv[4];
1564 
1565 	if (size < 4 * sizeof(unsigned int))
1566 		return -ENOMEM;
1567 	get_ctl_amp_tlv(kcontrol, tlv);
1568 	if (copy_to_user(_tlv, tlv, sizeof(tlv)))
1569 		return -EFAULT;
1570 	return 0;
1571 }
1572 EXPORT_SYMBOL_GPL(snd_hda_mixer_amp_tlv);
1573 
1574 /**
1575  * snd_hda_set_vmaster_tlv - Set TLV for a virtual master control
1576  * @codec: HD-audio codec
1577  * @nid: NID of a reference widget
1578  * @dir: #HDA_INPUT or #HDA_OUTPUT
1579  * @tlv: TLV data to be stored, at least 4 elements
1580  *
1581  * Set (static) TLV data for a virtual master volume using the AMP caps
1582  * obtained from the reference NID.
1583  * The volume range is recalculated as if the max volume is 0dB.
1584  */
snd_hda_set_vmaster_tlv(struct hda_codec * codec,hda_nid_t nid,int dir,unsigned int * tlv)1585 void snd_hda_set_vmaster_tlv(struct hda_codec *codec, hda_nid_t nid, int dir,
1586 			     unsigned int *tlv)
1587 {
1588 	u32 caps;
1589 	int nums, step;
1590 
1591 	caps = query_amp_caps(codec, nid, dir);
1592 	nums = (caps & AC_AMPCAP_NUM_STEPS) >> AC_AMPCAP_NUM_STEPS_SHIFT;
1593 	step = (caps & AC_AMPCAP_STEP_SIZE) >> AC_AMPCAP_STEP_SIZE_SHIFT;
1594 	step = (step + 1) * 25;
1595 	tlv[SNDRV_CTL_TLVO_TYPE] = SNDRV_CTL_TLVT_DB_SCALE;
1596 	tlv[SNDRV_CTL_TLVO_LEN] = 2 * sizeof(unsigned int);
1597 	tlv[SNDRV_CTL_TLVO_DB_SCALE_MIN] = -nums * step;
1598 	tlv[SNDRV_CTL_TLVO_DB_SCALE_MUTE_AND_STEP] = step;
1599 }
1600 EXPORT_SYMBOL_GPL(snd_hda_set_vmaster_tlv);
1601 
1602 /* find a mixer control element with the given name */
1603 static struct snd_kcontrol *
find_mixer_ctl(struct hda_codec * codec,const char * name,int dev,int idx)1604 find_mixer_ctl(struct hda_codec *codec, const char *name, int dev, int idx)
1605 {
1606 	struct snd_ctl_elem_id id;
1607 	memset(&id, 0, sizeof(id));
1608 	id.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
1609 	id.device = dev;
1610 	id.index = idx;
1611 	if (snd_BUG_ON(strlen(name) >= sizeof(id.name)))
1612 		return NULL;
1613 	strcpy(id.name, name);
1614 	return snd_ctl_find_id(codec->card, &id);
1615 }
1616 
1617 /**
1618  * snd_hda_find_mixer_ctl - Find a mixer control element with the given name
1619  * @codec: HD-audio codec
1620  * @name: ctl id name string
1621  *
1622  * Get the control element with the given id string and IFACE_MIXER.
1623  */
snd_hda_find_mixer_ctl(struct hda_codec * codec,const char * name)1624 struct snd_kcontrol *snd_hda_find_mixer_ctl(struct hda_codec *codec,
1625 					    const char *name)
1626 {
1627 	return find_mixer_ctl(codec, name, 0, 0);
1628 }
1629 EXPORT_SYMBOL_GPL(snd_hda_find_mixer_ctl);
1630 
find_empty_mixer_ctl_idx(struct hda_codec * codec,const char * name,int start_idx)1631 static int find_empty_mixer_ctl_idx(struct hda_codec *codec, const char *name,
1632 				    int start_idx)
1633 {
1634 	int i, idx;
1635 	/* 16 ctlrs should be large enough */
1636 	for (i = 0, idx = start_idx; i < 16; i++, idx++) {
1637 		if (!find_mixer_ctl(codec, name, 0, idx))
1638 			return idx;
1639 	}
1640 	return -EBUSY;
1641 }
1642 
1643 /**
1644  * snd_hda_ctl_add - Add a control element and assign to the codec
1645  * @codec: HD-audio codec
1646  * @nid: corresponding NID (optional)
1647  * @kctl: the control element to assign
1648  *
1649  * Add the given control element to an array inside the codec instance.
1650  * All control elements belonging to a codec are supposed to be added
1651  * by this function so that a proper clean-up works at the free or
1652  * reconfiguration time.
1653  *
1654  * If non-zero @nid is passed, the NID is assigned to the control element.
1655  * The assignment is shown in the codec proc file.
1656  *
1657  * snd_hda_ctl_add() checks the control subdev id field whether
1658  * #HDA_SUBDEV_NID_FLAG bit is set.  If set (and @nid is zero), the lower
1659  * bits value is taken as the NID to assign. The #HDA_NID_ITEM_AMP bit
1660  * specifies if kctl->private_value is a HDA amplifier value.
1661  */
snd_hda_ctl_add(struct hda_codec * codec,hda_nid_t nid,struct snd_kcontrol * kctl)1662 int snd_hda_ctl_add(struct hda_codec *codec, hda_nid_t nid,
1663 		    struct snd_kcontrol *kctl)
1664 {
1665 	int err;
1666 	unsigned short flags = 0;
1667 	struct hda_nid_item *item;
1668 
1669 	if (kctl->id.subdevice & HDA_SUBDEV_AMP_FLAG) {
1670 		flags |= HDA_NID_ITEM_AMP;
1671 		if (nid == 0)
1672 			nid = get_amp_nid_(kctl->private_value);
1673 	}
1674 	if ((kctl->id.subdevice & HDA_SUBDEV_NID_FLAG) != 0 && nid == 0)
1675 		nid = kctl->id.subdevice & 0xffff;
1676 	if (kctl->id.subdevice & (HDA_SUBDEV_NID_FLAG|HDA_SUBDEV_AMP_FLAG))
1677 		kctl->id.subdevice = 0;
1678 	err = snd_ctl_add(codec->card, kctl);
1679 	if (err < 0)
1680 		return err;
1681 	item = snd_array_new(&codec->mixers);
1682 	if (!item)
1683 		return -ENOMEM;
1684 	item->kctl = kctl;
1685 	item->nid = nid;
1686 	item->flags = flags;
1687 	return 0;
1688 }
1689 EXPORT_SYMBOL_GPL(snd_hda_ctl_add);
1690 
1691 /**
1692  * snd_hda_add_nid - Assign a NID to a control element
1693  * @codec: HD-audio codec
1694  * @nid: corresponding NID (optional)
1695  * @kctl: the control element to assign
1696  * @index: index to kctl
1697  *
1698  * Add the given control element to an array inside the codec instance.
1699  * This function is used when #snd_hda_ctl_add cannot be used for 1:1
1700  * NID:KCTL mapping - for example "Capture Source" selector.
1701  */
snd_hda_add_nid(struct hda_codec * codec,struct snd_kcontrol * kctl,unsigned int index,hda_nid_t nid)1702 int snd_hda_add_nid(struct hda_codec *codec, struct snd_kcontrol *kctl,
1703 		    unsigned int index, hda_nid_t nid)
1704 {
1705 	struct hda_nid_item *item;
1706 
1707 	if (nid > 0) {
1708 		item = snd_array_new(&codec->nids);
1709 		if (!item)
1710 			return -ENOMEM;
1711 		item->kctl = kctl;
1712 		item->index = index;
1713 		item->nid = nid;
1714 		return 0;
1715 	}
1716 	codec_err(codec, "no NID for mapping control %s:%d:%d\n",
1717 		  kctl->id.name, kctl->id.index, index);
1718 	return -EINVAL;
1719 }
1720 EXPORT_SYMBOL_GPL(snd_hda_add_nid);
1721 
1722 /**
1723  * snd_hda_ctls_clear - Clear all controls assigned to the given codec
1724  * @codec: HD-audio codec
1725  */
snd_hda_ctls_clear(struct hda_codec * codec)1726 void snd_hda_ctls_clear(struct hda_codec *codec)
1727 {
1728 	int i;
1729 	struct hda_nid_item *items = codec->mixers.list;
1730 
1731 	down_write(&codec->card->controls_rwsem);
1732 	for (i = 0; i < codec->mixers.used; i++)
1733 		snd_ctl_remove(codec->card, items[i].kctl);
1734 	up_write(&codec->card->controls_rwsem);
1735 	snd_array_free(&codec->mixers);
1736 	snd_array_free(&codec->nids);
1737 }
1738 
1739 /**
1740  * snd_hda_lock_devices - pseudo device locking
1741  * @bus: the BUS
1742  *
1743  * toggle card->shutdown to allow/disallow the device access (as a hack)
1744  */
snd_hda_lock_devices(struct hda_bus * bus)1745 int snd_hda_lock_devices(struct hda_bus *bus)
1746 {
1747 	struct snd_card *card = bus->card;
1748 	struct hda_codec *codec;
1749 
1750 	spin_lock(&card->files_lock);
1751 	if (card->shutdown)
1752 		goto err_unlock;
1753 	card->shutdown = 1;
1754 	if (!list_empty(&card->ctl_files))
1755 		goto err_clear;
1756 
1757 	list_for_each_codec(codec, bus) {
1758 		struct hda_pcm *cpcm;
1759 		list_for_each_entry(cpcm, &codec->pcm_list_head, list) {
1760 			if (!cpcm->pcm)
1761 				continue;
1762 			if (cpcm->pcm->streams[0].substream_opened ||
1763 			    cpcm->pcm->streams[1].substream_opened)
1764 				goto err_clear;
1765 		}
1766 	}
1767 	spin_unlock(&card->files_lock);
1768 	return 0;
1769 
1770  err_clear:
1771 	card->shutdown = 0;
1772  err_unlock:
1773 	spin_unlock(&card->files_lock);
1774 	return -EINVAL;
1775 }
1776 EXPORT_SYMBOL_GPL(snd_hda_lock_devices);
1777 
1778 /**
1779  * snd_hda_unlock_devices - pseudo device unlocking
1780  * @bus: the BUS
1781  */
snd_hda_unlock_devices(struct hda_bus * bus)1782 void snd_hda_unlock_devices(struct hda_bus *bus)
1783 {
1784 	struct snd_card *card = bus->card;
1785 
1786 	spin_lock(&card->files_lock);
1787 	card->shutdown = 0;
1788 	spin_unlock(&card->files_lock);
1789 }
1790 EXPORT_SYMBOL_GPL(snd_hda_unlock_devices);
1791 
1792 /**
1793  * snd_hda_codec_reset - Clear all objects assigned to the codec
1794  * @codec: HD-audio codec
1795  *
1796  * This frees the all PCM and control elements assigned to the codec, and
1797  * clears the caches and restores the pin default configurations.
1798  *
1799  * When a device is being used, it returns -EBSY.  If successfully freed,
1800  * returns zero.
1801  */
snd_hda_codec_reset(struct hda_codec * codec)1802 int snd_hda_codec_reset(struct hda_codec *codec)
1803 {
1804 	struct hda_bus *bus = codec->bus;
1805 
1806 	if (snd_hda_lock_devices(bus) < 0)
1807 		return -EBUSY;
1808 
1809 	/* OK, let it free */
1810 	device_release_driver(hda_codec_dev(codec));
1811 
1812 	/* allow device access again */
1813 	snd_hda_unlock_devices(bus);
1814 	return 0;
1815 }
1816 
1817 typedef int (*map_follower_func_t)(struct hda_codec *, void *, struct snd_kcontrol *);
1818 
1819 /* apply the function to all matching follower ctls in the mixer list */
map_followers(struct hda_codec * codec,const char * const * followers,const char * suffix,map_follower_func_t func,void * data)1820 static int map_followers(struct hda_codec *codec, const char * const *followers,
1821 			 const char *suffix, map_follower_func_t func, void *data)
1822 {
1823 	struct hda_nid_item *items;
1824 	const char * const *s;
1825 	int i, err;
1826 
1827 	items = codec->mixers.list;
1828 	for (i = 0; i < codec->mixers.used; i++) {
1829 		struct snd_kcontrol *sctl = items[i].kctl;
1830 		if (!sctl || sctl->id.iface != SNDRV_CTL_ELEM_IFACE_MIXER)
1831 			continue;
1832 		for (s = followers; *s; s++) {
1833 			char tmpname[sizeof(sctl->id.name)];
1834 			const char *name = *s;
1835 			if (suffix) {
1836 				snprintf(tmpname, sizeof(tmpname), "%s %s",
1837 					 name, suffix);
1838 				name = tmpname;
1839 			}
1840 			if (!strcmp(sctl->id.name, name)) {
1841 				err = func(codec, data, sctl);
1842 				if (err)
1843 					return err;
1844 				break;
1845 			}
1846 		}
1847 	}
1848 	return 0;
1849 }
1850 
check_follower_present(struct hda_codec * codec,void * data,struct snd_kcontrol * sctl)1851 static int check_follower_present(struct hda_codec *codec,
1852 				  void *data, struct snd_kcontrol *sctl)
1853 {
1854 	return 1;
1855 }
1856 
1857 /* call kctl->put with the given value(s) */
put_kctl_with_value(struct snd_kcontrol * kctl,int val)1858 static int put_kctl_with_value(struct snd_kcontrol *kctl, int val)
1859 {
1860 	struct snd_ctl_elem_value *ucontrol;
1861 	ucontrol = kzalloc(sizeof(*ucontrol), GFP_KERNEL);
1862 	if (!ucontrol)
1863 		return -ENOMEM;
1864 	ucontrol->value.integer.value[0] = val;
1865 	ucontrol->value.integer.value[1] = val;
1866 	kctl->put(kctl, ucontrol);
1867 	kfree(ucontrol);
1868 	return 0;
1869 }
1870 
1871 struct follower_init_arg {
1872 	struct hda_codec *codec;
1873 	int step;
1874 };
1875 
1876 /* initialize the follower volume with 0dB via snd_ctl_apply_vmaster_followers() */
init_follower_0dB(struct snd_kcontrol * follower,struct snd_kcontrol * kctl,void * _arg)1877 static int init_follower_0dB(struct snd_kcontrol *follower,
1878 			     struct snd_kcontrol *kctl,
1879 			     void *_arg)
1880 {
1881 	struct follower_init_arg *arg = _arg;
1882 	int _tlv[4];
1883 	const int *tlv = NULL;
1884 	int step;
1885 	int val;
1886 
1887 	if (kctl->vd[0].access & SNDRV_CTL_ELEM_ACCESS_TLV_CALLBACK) {
1888 		if (kctl->tlv.c != snd_hda_mixer_amp_tlv) {
1889 			codec_err(arg->codec,
1890 				  "Unexpected TLV callback for follower %s:%d\n",
1891 				  kctl->id.name, kctl->id.index);
1892 			return 0; /* ignore */
1893 		}
1894 		get_ctl_amp_tlv(kctl, _tlv);
1895 		tlv = _tlv;
1896 	} else if (kctl->vd[0].access & SNDRV_CTL_ELEM_ACCESS_TLV_READ)
1897 		tlv = kctl->tlv.p;
1898 
1899 	if (!tlv || tlv[SNDRV_CTL_TLVO_TYPE] != SNDRV_CTL_TLVT_DB_SCALE)
1900 		return 0;
1901 
1902 	step = tlv[SNDRV_CTL_TLVO_DB_SCALE_MUTE_AND_STEP];
1903 	step &= ~TLV_DB_SCALE_MUTE;
1904 	if (!step)
1905 		return 0;
1906 	if (arg->step && arg->step != step) {
1907 		codec_err(arg->codec,
1908 			  "Mismatching dB step for vmaster follower (%d!=%d)\n",
1909 			  arg->step, step);
1910 		return 0;
1911 	}
1912 
1913 	arg->step = step;
1914 	val = -tlv[SNDRV_CTL_TLVO_DB_SCALE_MIN] / step;
1915 	if (val > 0) {
1916 		put_kctl_with_value(follower, val);
1917 		return val;
1918 	}
1919 
1920 	return 0;
1921 }
1922 
1923 /* unmute the follower via snd_ctl_apply_vmaster_followers() */
init_follower_unmute(struct snd_kcontrol * follower,struct snd_kcontrol * kctl,void * _arg)1924 static int init_follower_unmute(struct snd_kcontrol *follower,
1925 				struct snd_kcontrol *kctl,
1926 				void *_arg)
1927 {
1928 	return put_kctl_with_value(follower, 1);
1929 }
1930 
add_follower(struct hda_codec * codec,void * data,struct snd_kcontrol * follower)1931 static int add_follower(struct hda_codec *codec,
1932 			void *data, struct snd_kcontrol *follower)
1933 {
1934 	return snd_ctl_add_follower(data, follower);
1935 }
1936 
1937 /**
1938  * __snd_hda_add_vmaster - create a virtual master control and add followers
1939  * @codec: HD-audio codec
1940  * @name: vmaster control name
1941  * @tlv: TLV data (optional)
1942  * @followers: follower control names (optional)
1943  * @suffix: suffix string to each follower name (optional)
1944  * @init_follower_vol: initialize followers to unmute/0dB
1945  * @ctl_ret: store the vmaster kcontrol in return
1946  *
1947  * Create a virtual master control with the given name.  The TLV data
1948  * must be either NULL or a valid data.
1949  *
1950  * @followers is a NULL-terminated array of strings, each of which is a
1951  * follower control name.  All controls with these names are assigned to
1952  * the new virtual master control.
1953  *
1954  * This function returns zero if successful or a negative error code.
1955  */
__snd_hda_add_vmaster(struct hda_codec * codec,char * name,unsigned int * tlv,const char * const * followers,const char * suffix,bool init_follower_vol,struct snd_kcontrol ** ctl_ret)1956 int __snd_hda_add_vmaster(struct hda_codec *codec, char *name,
1957 			  unsigned int *tlv, const char * const *followers,
1958 			  const char *suffix, bool init_follower_vol,
1959 			  struct snd_kcontrol **ctl_ret)
1960 {
1961 	struct snd_kcontrol *kctl;
1962 	int err;
1963 
1964 	if (ctl_ret)
1965 		*ctl_ret = NULL;
1966 
1967 	err = map_followers(codec, followers, suffix, check_follower_present, NULL);
1968 	if (err != 1) {
1969 		codec_dbg(codec, "No follower found for %s\n", name);
1970 		return 0;
1971 	}
1972 	kctl = snd_ctl_make_virtual_master(name, tlv);
1973 	if (!kctl)
1974 		return -ENOMEM;
1975 	err = snd_hda_ctl_add(codec, 0, kctl);
1976 	if (err < 0)
1977 		return err;
1978 
1979 	err = map_followers(codec, followers, suffix, add_follower, kctl);
1980 	if (err < 0)
1981 		return err;
1982 
1983 	/* init with master mute & zero volume */
1984 	put_kctl_with_value(kctl, 0);
1985 	if (init_follower_vol) {
1986 		struct follower_init_arg arg = {
1987 			.codec = codec,
1988 			.step = 0,
1989 		};
1990 		snd_ctl_apply_vmaster_followers(kctl,
1991 						tlv ? init_follower_0dB : init_follower_unmute,
1992 						&arg);
1993 	}
1994 
1995 	if (ctl_ret)
1996 		*ctl_ret = kctl;
1997 	return 0;
1998 }
1999 EXPORT_SYMBOL_GPL(__snd_hda_add_vmaster);
2000 
2001 /*
2002  * mute-LED control using vmaster
2003  */
vmaster_mute_mode_info(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_info * uinfo)2004 static int vmaster_mute_mode_info(struct snd_kcontrol *kcontrol,
2005 				  struct snd_ctl_elem_info *uinfo)
2006 {
2007 	static const char * const texts[] = {
2008 		"On", "Off", "Follow Master"
2009 	};
2010 
2011 	return snd_ctl_enum_info(uinfo, 1, 3, texts);
2012 }
2013 
vmaster_mute_mode_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)2014 static int vmaster_mute_mode_get(struct snd_kcontrol *kcontrol,
2015 				 struct snd_ctl_elem_value *ucontrol)
2016 {
2017 	struct hda_vmaster_mute_hook *hook = snd_kcontrol_chip(kcontrol);
2018 	ucontrol->value.enumerated.item[0] = hook->mute_mode;
2019 	return 0;
2020 }
2021 
vmaster_mute_mode_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)2022 static int vmaster_mute_mode_put(struct snd_kcontrol *kcontrol,
2023 				 struct snd_ctl_elem_value *ucontrol)
2024 {
2025 	struct hda_vmaster_mute_hook *hook = snd_kcontrol_chip(kcontrol);
2026 	unsigned int old_mode = hook->mute_mode;
2027 
2028 	hook->mute_mode = ucontrol->value.enumerated.item[0];
2029 	if (hook->mute_mode > HDA_VMUTE_FOLLOW_MASTER)
2030 		hook->mute_mode = HDA_VMUTE_FOLLOW_MASTER;
2031 	if (old_mode == hook->mute_mode)
2032 		return 0;
2033 	snd_hda_sync_vmaster_hook(hook);
2034 	return 1;
2035 }
2036 
2037 static const struct snd_kcontrol_new vmaster_mute_mode = {
2038 	.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2039 	.name = "Mute-LED Mode",
2040 	.info = vmaster_mute_mode_info,
2041 	.get = vmaster_mute_mode_get,
2042 	.put = vmaster_mute_mode_put,
2043 };
2044 
2045 /* meta hook to call each driver's vmaster hook */
vmaster_hook(void * private_data,int enabled)2046 static void vmaster_hook(void *private_data, int enabled)
2047 {
2048 	struct hda_vmaster_mute_hook *hook = private_data;
2049 
2050 	if (hook->mute_mode != HDA_VMUTE_FOLLOW_MASTER)
2051 		enabled = hook->mute_mode;
2052 	hook->hook(hook->codec, enabled);
2053 }
2054 
2055 /**
2056  * snd_hda_add_vmaster_hook - Add a vmaster hook for mute-LED
2057  * @codec: the HDA codec
2058  * @hook: the vmaster hook object
2059  * @expose_enum_ctl: flag to create an enum ctl
2060  *
2061  * Add a mute-LED hook with the given vmaster switch kctl.
2062  * When @expose_enum_ctl is set, "Mute-LED Mode" control is automatically
2063  * created and associated with the given hook.
2064  */
snd_hda_add_vmaster_hook(struct hda_codec * codec,struct hda_vmaster_mute_hook * hook,bool expose_enum_ctl)2065 int snd_hda_add_vmaster_hook(struct hda_codec *codec,
2066 			     struct hda_vmaster_mute_hook *hook,
2067 			     bool expose_enum_ctl)
2068 {
2069 	struct snd_kcontrol *kctl;
2070 
2071 	if (!hook->hook || !hook->sw_kctl)
2072 		return 0;
2073 	hook->codec = codec;
2074 	hook->mute_mode = HDA_VMUTE_FOLLOW_MASTER;
2075 	snd_ctl_add_vmaster_hook(hook->sw_kctl, vmaster_hook, hook);
2076 	if (!expose_enum_ctl)
2077 		return 0;
2078 	kctl = snd_ctl_new1(&vmaster_mute_mode, hook);
2079 	if (!kctl)
2080 		return -ENOMEM;
2081 	return snd_hda_ctl_add(codec, 0, kctl);
2082 }
2083 EXPORT_SYMBOL_GPL(snd_hda_add_vmaster_hook);
2084 
2085 /**
2086  * snd_hda_sync_vmaster_hook - Sync vmaster hook
2087  * @hook: the vmaster hook
2088  *
2089  * Call the hook with the current value for synchronization.
2090  * Should be called in init callback.
2091  */
snd_hda_sync_vmaster_hook(struct hda_vmaster_mute_hook * hook)2092 void snd_hda_sync_vmaster_hook(struct hda_vmaster_mute_hook *hook)
2093 {
2094 	if (!hook->hook || !hook->codec)
2095 		return;
2096 	/* don't call vmaster hook in the destructor since it might have
2097 	 * been already destroyed
2098 	 */
2099 	if (hook->codec->bus->shutdown)
2100 		return;
2101 	snd_ctl_sync_vmaster_hook(hook->sw_kctl);
2102 }
2103 EXPORT_SYMBOL_GPL(snd_hda_sync_vmaster_hook);
2104 
2105 
2106 /**
2107  * snd_hda_mixer_amp_switch_info - Info callback for a standard AMP mixer switch
2108  * @kcontrol: referred ctl element
2109  * @uinfo: pointer to get/store the data
2110  *
2111  * The control element is supposed to have the private_value field
2112  * set up via HDA_COMPOSE_AMP_VAL*() or related macros.
2113  */
snd_hda_mixer_amp_switch_info(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_info * uinfo)2114 int snd_hda_mixer_amp_switch_info(struct snd_kcontrol *kcontrol,
2115 				  struct snd_ctl_elem_info *uinfo)
2116 {
2117 	int chs = get_amp_channels(kcontrol);
2118 
2119 	uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2120 	uinfo->count = chs == 3 ? 2 : 1;
2121 	uinfo->value.integer.min = 0;
2122 	uinfo->value.integer.max = 1;
2123 	return 0;
2124 }
2125 EXPORT_SYMBOL_GPL(snd_hda_mixer_amp_switch_info);
2126 
2127 /**
2128  * snd_hda_mixer_amp_switch_get - Get callback for a standard AMP mixer switch
2129  * @kcontrol: ctl element
2130  * @ucontrol: pointer to get/store the data
2131  *
2132  * The control element is supposed to have the private_value field
2133  * set up via HDA_COMPOSE_AMP_VAL*() or related macros.
2134  */
snd_hda_mixer_amp_switch_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)2135 int snd_hda_mixer_amp_switch_get(struct snd_kcontrol *kcontrol,
2136 				 struct snd_ctl_elem_value *ucontrol)
2137 {
2138 	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
2139 	hda_nid_t nid = get_amp_nid(kcontrol);
2140 	int chs = get_amp_channels(kcontrol);
2141 	int dir = get_amp_direction(kcontrol);
2142 	int idx = get_amp_index(kcontrol);
2143 	long *valp = ucontrol->value.integer.value;
2144 
2145 	if (chs & 1)
2146 		*valp++ = (snd_hda_codec_amp_read(codec, nid, 0, dir, idx) &
2147 			   HDA_AMP_MUTE) ? 0 : 1;
2148 	if (chs & 2)
2149 		*valp = (snd_hda_codec_amp_read(codec, nid, 1, dir, idx) &
2150 			 HDA_AMP_MUTE) ? 0 : 1;
2151 	return 0;
2152 }
2153 EXPORT_SYMBOL_GPL(snd_hda_mixer_amp_switch_get);
2154 
2155 /**
2156  * snd_hda_mixer_amp_switch_put - Put callback for a standard AMP mixer switch
2157  * @kcontrol: ctl element
2158  * @ucontrol: pointer to get/store the data
2159  *
2160  * The control element is supposed to have the private_value field
2161  * set up via HDA_COMPOSE_AMP_VAL*() or related macros.
2162  */
snd_hda_mixer_amp_switch_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)2163 int snd_hda_mixer_amp_switch_put(struct snd_kcontrol *kcontrol,
2164 				 struct snd_ctl_elem_value *ucontrol)
2165 {
2166 	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
2167 	hda_nid_t nid = get_amp_nid(kcontrol);
2168 	int chs = get_amp_channels(kcontrol);
2169 	int dir = get_amp_direction(kcontrol);
2170 	int idx = get_amp_index(kcontrol);
2171 	long *valp = ucontrol->value.integer.value;
2172 	int change = 0;
2173 
2174 	if (chs & 1) {
2175 		change = snd_hda_codec_amp_update(codec, nid, 0, dir, idx,
2176 						  HDA_AMP_MUTE,
2177 						  *valp ? 0 : HDA_AMP_MUTE);
2178 		valp++;
2179 	}
2180 	if (chs & 2)
2181 		change |= snd_hda_codec_amp_update(codec, nid, 1, dir, idx,
2182 						   HDA_AMP_MUTE,
2183 						   *valp ? 0 : HDA_AMP_MUTE);
2184 	hda_call_check_power_status(codec, nid);
2185 	return change;
2186 }
2187 EXPORT_SYMBOL_GPL(snd_hda_mixer_amp_switch_put);
2188 
2189 /*
2190  * SPDIF out controls
2191  */
2192 
snd_hda_spdif_mask_info(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_info * uinfo)2193 static int snd_hda_spdif_mask_info(struct snd_kcontrol *kcontrol,
2194 				   struct snd_ctl_elem_info *uinfo)
2195 {
2196 	uinfo->type = SNDRV_CTL_ELEM_TYPE_IEC958;
2197 	uinfo->count = 1;
2198 	return 0;
2199 }
2200 
snd_hda_spdif_cmask_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)2201 static int snd_hda_spdif_cmask_get(struct snd_kcontrol *kcontrol,
2202 				   struct snd_ctl_elem_value *ucontrol)
2203 {
2204 	ucontrol->value.iec958.status[0] = IEC958_AES0_PROFESSIONAL |
2205 					   IEC958_AES0_NONAUDIO |
2206 					   IEC958_AES0_CON_EMPHASIS_5015 |
2207 					   IEC958_AES0_CON_NOT_COPYRIGHT;
2208 	ucontrol->value.iec958.status[1] = IEC958_AES1_CON_CATEGORY |
2209 					   IEC958_AES1_CON_ORIGINAL;
2210 	return 0;
2211 }
2212 
snd_hda_spdif_pmask_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)2213 static int snd_hda_spdif_pmask_get(struct snd_kcontrol *kcontrol,
2214 				   struct snd_ctl_elem_value *ucontrol)
2215 {
2216 	ucontrol->value.iec958.status[0] = IEC958_AES0_PROFESSIONAL |
2217 					   IEC958_AES0_NONAUDIO |
2218 					   IEC958_AES0_PRO_EMPHASIS_5015;
2219 	return 0;
2220 }
2221 
snd_hda_spdif_default_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)2222 static int snd_hda_spdif_default_get(struct snd_kcontrol *kcontrol,
2223 				     struct snd_ctl_elem_value *ucontrol)
2224 {
2225 	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
2226 	int idx = kcontrol->private_value;
2227 	struct hda_spdif_out *spdif;
2228 
2229 	if (WARN_ON(codec->spdif_out.used <= idx))
2230 		return -EINVAL;
2231 	mutex_lock(&codec->spdif_mutex);
2232 	spdif = snd_array_elem(&codec->spdif_out, idx);
2233 	ucontrol->value.iec958.status[0] = spdif->status & 0xff;
2234 	ucontrol->value.iec958.status[1] = (spdif->status >> 8) & 0xff;
2235 	ucontrol->value.iec958.status[2] = (spdif->status >> 16) & 0xff;
2236 	ucontrol->value.iec958.status[3] = (spdif->status >> 24) & 0xff;
2237 	mutex_unlock(&codec->spdif_mutex);
2238 
2239 	return 0;
2240 }
2241 
2242 /* convert from SPDIF status bits to HDA SPDIF bits
2243  * bit 0 (DigEn) is always set zero (to be filled later)
2244  */
convert_from_spdif_status(unsigned int sbits)2245 static unsigned short convert_from_spdif_status(unsigned int sbits)
2246 {
2247 	unsigned short val = 0;
2248 
2249 	if (sbits & IEC958_AES0_PROFESSIONAL)
2250 		val |= AC_DIG1_PROFESSIONAL;
2251 	if (sbits & IEC958_AES0_NONAUDIO)
2252 		val |= AC_DIG1_NONAUDIO;
2253 	if (sbits & IEC958_AES0_PROFESSIONAL) {
2254 		if ((sbits & IEC958_AES0_PRO_EMPHASIS) ==
2255 		    IEC958_AES0_PRO_EMPHASIS_5015)
2256 			val |= AC_DIG1_EMPHASIS;
2257 	} else {
2258 		if ((sbits & IEC958_AES0_CON_EMPHASIS) ==
2259 		    IEC958_AES0_CON_EMPHASIS_5015)
2260 			val |= AC_DIG1_EMPHASIS;
2261 		if (!(sbits & IEC958_AES0_CON_NOT_COPYRIGHT))
2262 			val |= AC_DIG1_COPYRIGHT;
2263 		if (sbits & (IEC958_AES1_CON_ORIGINAL << 8))
2264 			val |= AC_DIG1_LEVEL;
2265 		val |= sbits & (IEC958_AES1_CON_CATEGORY << 8);
2266 	}
2267 	return val;
2268 }
2269 
2270 /* convert to SPDIF status bits from HDA SPDIF bits
2271  */
convert_to_spdif_status(unsigned short val)2272 static unsigned int convert_to_spdif_status(unsigned short val)
2273 {
2274 	unsigned int sbits = 0;
2275 
2276 	if (val & AC_DIG1_NONAUDIO)
2277 		sbits |= IEC958_AES0_NONAUDIO;
2278 	if (val & AC_DIG1_PROFESSIONAL)
2279 		sbits |= IEC958_AES0_PROFESSIONAL;
2280 	if (sbits & IEC958_AES0_PROFESSIONAL) {
2281 		if (val & AC_DIG1_EMPHASIS)
2282 			sbits |= IEC958_AES0_PRO_EMPHASIS_5015;
2283 	} else {
2284 		if (val & AC_DIG1_EMPHASIS)
2285 			sbits |= IEC958_AES0_CON_EMPHASIS_5015;
2286 		if (!(val & AC_DIG1_COPYRIGHT))
2287 			sbits |= IEC958_AES0_CON_NOT_COPYRIGHT;
2288 		if (val & AC_DIG1_LEVEL)
2289 			sbits |= (IEC958_AES1_CON_ORIGINAL << 8);
2290 		sbits |= val & (0x7f << 8);
2291 	}
2292 	return sbits;
2293 }
2294 
2295 /* set digital convert verbs both for the given NID and its followers */
set_dig_out(struct hda_codec * codec,hda_nid_t nid,int mask,int val)2296 static void set_dig_out(struct hda_codec *codec, hda_nid_t nid,
2297 			int mask, int val)
2298 {
2299 	const hda_nid_t *d;
2300 
2301 	snd_hdac_regmap_update(&codec->core, nid, AC_VERB_SET_DIGI_CONVERT_1,
2302 			       mask, val);
2303 	d = codec->follower_dig_outs;
2304 	if (!d)
2305 		return;
2306 	for (; *d; d++)
2307 		snd_hdac_regmap_update(&codec->core, *d,
2308 				       AC_VERB_SET_DIGI_CONVERT_1, mask, val);
2309 }
2310 
set_dig_out_convert(struct hda_codec * codec,hda_nid_t nid,int dig1,int dig2)2311 static inline void set_dig_out_convert(struct hda_codec *codec, hda_nid_t nid,
2312 				       int dig1, int dig2)
2313 {
2314 	unsigned int mask = 0;
2315 	unsigned int val = 0;
2316 
2317 	if (dig1 != -1) {
2318 		mask |= 0xff;
2319 		val = dig1;
2320 	}
2321 	if (dig2 != -1) {
2322 		mask |= 0xff00;
2323 		val |= dig2 << 8;
2324 	}
2325 	set_dig_out(codec, nid, mask, val);
2326 }
2327 
snd_hda_spdif_default_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)2328 static int snd_hda_spdif_default_put(struct snd_kcontrol *kcontrol,
2329 				     struct snd_ctl_elem_value *ucontrol)
2330 {
2331 	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
2332 	int idx = kcontrol->private_value;
2333 	struct hda_spdif_out *spdif;
2334 	hda_nid_t nid;
2335 	unsigned short val;
2336 	int change;
2337 
2338 	if (WARN_ON(codec->spdif_out.used <= idx))
2339 		return -EINVAL;
2340 	mutex_lock(&codec->spdif_mutex);
2341 	spdif = snd_array_elem(&codec->spdif_out, idx);
2342 	nid = spdif->nid;
2343 	spdif->status = ucontrol->value.iec958.status[0] |
2344 		((unsigned int)ucontrol->value.iec958.status[1] << 8) |
2345 		((unsigned int)ucontrol->value.iec958.status[2] << 16) |
2346 		((unsigned int)ucontrol->value.iec958.status[3] << 24);
2347 	val = convert_from_spdif_status(spdif->status);
2348 	val |= spdif->ctls & 1;
2349 	change = spdif->ctls != val;
2350 	spdif->ctls = val;
2351 	if (change && nid != (u16)-1)
2352 		set_dig_out_convert(codec, nid, val & 0xff, (val >> 8) & 0xff);
2353 	mutex_unlock(&codec->spdif_mutex);
2354 	return change;
2355 }
2356 
2357 #define snd_hda_spdif_out_switch_info	snd_ctl_boolean_mono_info
2358 
snd_hda_spdif_out_switch_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)2359 static int snd_hda_spdif_out_switch_get(struct snd_kcontrol *kcontrol,
2360 					struct snd_ctl_elem_value *ucontrol)
2361 {
2362 	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
2363 	int idx = kcontrol->private_value;
2364 	struct hda_spdif_out *spdif;
2365 
2366 	if (WARN_ON(codec->spdif_out.used <= idx))
2367 		return -EINVAL;
2368 	mutex_lock(&codec->spdif_mutex);
2369 	spdif = snd_array_elem(&codec->spdif_out, idx);
2370 	ucontrol->value.integer.value[0] = spdif->ctls & AC_DIG1_ENABLE;
2371 	mutex_unlock(&codec->spdif_mutex);
2372 	return 0;
2373 }
2374 
set_spdif_ctls(struct hda_codec * codec,hda_nid_t nid,int dig1,int dig2)2375 static inline void set_spdif_ctls(struct hda_codec *codec, hda_nid_t nid,
2376 				  int dig1, int dig2)
2377 {
2378 	set_dig_out_convert(codec, nid, dig1, dig2);
2379 	/* unmute amp switch (if any) */
2380 	if ((get_wcaps(codec, nid) & AC_WCAP_OUT_AMP) &&
2381 	    (dig1 & AC_DIG1_ENABLE))
2382 		snd_hda_codec_amp_stereo(codec, nid, HDA_OUTPUT, 0,
2383 					    HDA_AMP_MUTE, 0);
2384 }
2385 
snd_hda_spdif_out_switch_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)2386 static int snd_hda_spdif_out_switch_put(struct snd_kcontrol *kcontrol,
2387 					struct snd_ctl_elem_value *ucontrol)
2388 {
2389 	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
2390 	int idx = kcontrol->private_value;
2391 	struct hda_spdif_out *spdif;
2392 	hda_nid_t nid;
2393 	unsigned short val;
2394 	int change;
2395 
2396 	if (WARN_ON(codec->spdif_out.used <= idx))
2397 		return -EINVAL;
2398 	mutex_lock(&codec->spdif_mutex);
2399 	spdif = snd_array_elem(&codec->spdif_out, idx);
2400 	nid = spdif->nid;
2401 	val = spdif->ctls & ~AC_DIG1_ENABLE;
2402 	if (ucontrol->value.integer.value[0])
2403 		val |= AC_DIG1_ENABLE;
2404 	change = spdif->ctls != val;
2405 	spdif->ctls = val;
2406 	if (change && nid != (u16)-1)
2407 		set_spdif_ctls(codec, nid, val & 0xff, -1);
2408 	mutex_unlock(&codec->spdif_mutex);
2409 	return change;
2410 }
2411 
2412 static const struct snd_kcontrol_new dig_mixes[] = {
2413 	{
2414 		.access = SNDRV_CTL_ELEM_ACCESS_READ,
2415 		.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2416 		.name = SNDRV_CTL_NAME_IEC958("", PLAYBACK, CON_MASK),
2417 		.info = snd_hda_spdif_mask_info,
2418 		.get = snd_hda_spdif_cmask_get,
2419 	},
2420 	{
2421 		.access = SNDRV_CTL_ELEM_ACCESS_READ,
2422 		.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2423 		.name = SNDRV_CTL_NAME_IEC958("", PLAYBACK, PRO_MASK),
2424 		.info = snd_hda_spdif_mask_info,
2425 		.get = snd_hda_spdif_pmask_get,
2426 	},
2427 	{
2428 		.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2429 		.name = SNDRV_CTL_NAME_IEC958("", PLAYBACK, DEFAULT),
2430 		.info = snd_hda_spdif_mask_info,
2431 		.get = snd_hda_spdif_default_get,
2432 		.put = snd_hda_spdif_default_put,
2433 	},
2434 	{
2435 		.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2436 		.name = SNDRV_CTL_NAME_IEC958("", PLAYBACK, SWITCH),
2437 		.info = snd_hda_spdif_out_switch_info,
2438 		.get = snd_hda_spdif_out_switch_get,
2439 		.put = snd_hda_spdif_out_switch_put,
2440 	},
2441 	{ } /* end */
2442 };
2443 
2444 /**
2445  * snd_hda_create_dig_out_ctls - create Output SPDIF-related controls
2446  * @codec: the HDA codec
2447  * @associated_nid: NID that new ctls associated with
2448  * @cvt_nid: converter NID
2449  * @type: HDA_PCM_TYPE_*
2450  * Creates controls related with the digital output.
2451  * Called from each patch supporting the digital out.
2452  *
2453  * Returns 0 if successful, or a negative error code.
2454  */
snd_hda_create_dig_out_ctls(struct hda_codec * codec,hda_nid_t associated_nid,hda_nid_t cvt_nid,int type)2455 int snd_hda_create_dig_out_ctls(struct hda_codec *codec,
2456 				hda_nid_t associated_nid,
2457 				hda_nid_t cvt_nid,
2458 				int type)
2459 {
2460 	int err;
2461 	struct snd_kcontrol *kctl;
2462 	const struct snd_kcontrol_new *dig_mix;
2463 	int idx = 0;
2464 	int val = 0;
2465 	const int spdif_index = 16;
2466 	struct hda_spdif_out *spdif;
2467 	struct hda_bus *bus = codec->bus;
2468 
2469 	if (bus->primary_dig_out_type == HDA_PCM_TYPE_HDMI &&
2470 	    type == HDA_PCM_TYPE_SPDIF) {
2471 		idx = spdif_index;
2472 	} else if (bus->primary_dig_out_type == HDA_PCM_TYPE_SPDIF &&
2473 		   type == HDA_PCM_TYPE_HDMI) {
2474 		/* suppose a single SPDIF device */
2475 		for (dig_mix = dig_mixes; dig_mix->name; dig_mix++) {
2476 			kctl = find_mixer_ctl(codec, dig_mix->name, 0, 0);
2477 			if (!kctl)
2478 				break;
2479 			kctl->id.index = spdif_index;
2480 		}
2481 		bus->primary_dig_out_type = HDA_PCM_TYPE_HDMI;
2482 	}
2483 	if (!bus->primary_dig_out_type)
2484 		bus->primary_dig_out_type = type;
2485 
2486 	idx = find_empty_mixer_ctl_idx(codec, "IEC958 Playback Switch", idx);
2487 	if (idx < 0) {
2488 		codec_err(codec, "too many IEC958 outputs\n");
2489 		return -EBUSY;
2490 	}
2491 	spdif = snd_array_new(&codec->spdif_out);
2492 	if (!spdif)
2493 		return -ENOMEM;
2494 	for (dig_mix = dig_mixes; dig_mix->name; dig_mix++) {
2495 		kctl = snd_ctl_new1(dig_mix, codec);
2496 		if (!kctl)
2497 			return -ENOMEM;
2498 		kctl->id.index = idx;
2499 		kctl->private_value = codec->spdif_out.used - 1;
2500 		err = snd_hda_ctl_add(codec, associated_nid, kctl);
2501 		if (err < 0)
2502 			return err;
2503 	}
2504 	spdif->nid = cvt_nid;
2505 	snd_hdac_regmap_read(&codec->core, cvt_nid,
2506 			     AC_VERB_GET_DIGI_CONVERT_1, &val);
2507 	spdif->ctls = val;
2508 	spdif->status = convert_to_spdif_status(spdif->ctls);
2509 	return 0;
2510 }
2511 EXPORT_SYMBOL_GPL(snd_hda_create_dig_out_ctls);
2512 
2513 /**
2514  * snd_hda_spdif_out_of_nid - get the hda_spdif_out entry from the given NID
2515  * @codec: the HDA codec
2516  * @nid: widget NID
2517  *
2518  * call within spdif_mutex lock
2519  */
snd_hda_spdif_out_of_nid(struct hda_codec * codec,hda_nid_t nid)2520 struct hda_spdif_out *snd_hda_spdif_out_of_nid(struct hda_codec *codec,
2521 					       hda_nid_t nid)
2522 {
2523 	struct hda_spdif_out *spdif;
2524 	int i;
2525 
2526 	snd_array_for_each(&codec->spdif_out, i, spdif) {
2527 		if (spdif->nid == nid)
2528 			return spdif;
2529 	}
2530 	return NULL;
2531 }
2532 EXPORT_SYMBOL_GPL(snd_hda_spdif_out_of_nid);
2533 
2534 /**
2535  * snd_hda_spdif_ctls_unassign - Unassign the given SPDIF ctl
2536  * @codec: the HDA codec
2537  * @idx: the SPDIF ctl index
2538  *
2539  * Unassign the widget from the given SPDIF control.
2540  */
snd_hda_spdif_ctls_unassign(struct hda_codec * codec,int idx)2541 void snd_hda_spdif_ctls_unassign(struct hda_codec *codec, int idx)
2542 {
2543 	struct hda_spdif_out *spdif;
2544 
2545 	if (WARN_ON(codec->spdif_out.used <= idx))
2546 		return;
2547 	mutex_lock(&codec->spdif_mutex);
2548 	spdif = snd_array_elem(&codec->spdif_out, idx);
2549 	spdif->nid = (u16)-1;
2550 	mutex_unlock(&codec->spdif_mutex);
2551 }
2552 EXPORT_SYMBOL_GPL(snd_hda_spdif_ctls_unassign);
2553 
2554 /**
2555  * snd_hda_spdif_ctls_assign - Assign the SPDIF controls to the given NID
2556  * @codec: the HDA codec
2557  * @idx: the SPDIF ctl idx
2558  * @nid: widget NID
2559  *
2560  * Assign the widget to the SPDIF control with the given index.
2561  */
snd_hda_spdif_ctls_assign(struct hda_codec * codec,int idx,hda_nid_t nid)2562 void snd_hda_spdif_ctls_assign(struct hda_codec *codec, int idx, hda_nid_t nid)
2563 {
2564 	struct hda_spdif_out *spdif;
2565 	unsigned short val;
2566 
2567 	if (WARN_ON(codec->spdif_out.used <= idx))
2568 		return;
2569 	mutex_lock(&codec->spdif_mutex);
2570 	spdif = snd_array_elem(&codec->spdif_out, idx);
2571 	if (spdif->nid != nid) {
2572 		spdif->nid = nid;
2573 		val = spdif->ctls;
2574 		set_spdif_ctls(codec, nid, val & 0xff, (val >> 8) & 0xff);
2575 	}
2576 	mutex_unlock(&codec->spdif_mutex);
2577 }
2578 EXPORT_SYMBOL_GPL(snd_hda_spdif_ctls_assign);
2579 
2580 /*
2581  * SPDIF sharing with analog output
2582  */
spdif_share_sw_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)2583 static int spdif_share_sw_get(struct snd_kcontrol *kcontrol,
2584 			      struct snd_ctl_elem_value *ucontrol)
2585 {
2586 	struct hda_multi_out *mout = snd_kcontrol_chip(kcontrol);
2587 	ucontrol->value.integer.value[0] = mout->share_spdif;
2588 	return 0;
2589 }
2590 
spdif_share_sw_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)2591 static int spdif_share_sw_put(struct snd_kcontrol *kcontrol,
2592 			      struct snd_ctl_elem_value *ucontrol)
2593 {
2594 	struct hda_multi_out *mout = snd_kcontrol_chip(kcontrol);
2595 	mout->share_spdif = !!ucontrol->value.integer.value[0];
2596 	return 0;
2597 }
2598 
2599 static const struct snd_kcontrol_new spdif_share_sw = {
2600 	.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2601 	.name = "IEC958 Default PCM Playback Switch",
2602 	.info = snd_ctl_boolean_mono_info,
2603 	.get = spdif_share_sw_get,
2604 	.put = spdif_share_sw_put,
2605 };
2606 
2607 /**
2608  * snd_hda_create_spdif_share_sw - create Default PCM switch
2609  * @codec: the HDA codec
2610  * @mout: multi-out instance
2611  */
snd_hda_create_spdif_share_sw(struct hda_codec * codec,struct hda_multi_out * mout)2612 int snd_hda_create_spdif_share_sw(struct hda_codec *codec,
2613 				  struct hda_multi_out *mout)
2614 {
2615 	struct snd_kcontrol *kctl;
2616 
2617 	if (!mout->dig_out_nid)
2618 		return 0;
2619 
2620 	kctl = snd_ctl_new1(&spdif_share_sw, mout);
2621 	if (!kctl)
2622 		return -ENOMEM;
2623 	/* ATTENTION: here mout is passed as private_data, instead of codec */
2624 	return snd_hda_ctl_add(codec, mout->dig_out_nid, kctl);
2625 }
2626 EXPORT_SYMBOL_GPL(snd_hda_create_spdif_share_sw);
2627 
2628 /*
2629  * SPDIF input
2630  */
2631 
2632 #define snd_hda_spdif_in_switch_info	snd_hda_spdif_out_switch_info
2633 
snd_hda_spdif_in_switch_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)2634 static int snd_hda_spdif_in_switch_get(struct snd_kcontrol *kcontrol,
2635 				       struct snd_ctl_elem_value *ucontrol)
2636 {
2637 	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
2638 
2639 	ucontrol->value.integer.value[0] = codec->spdif_in_enable;
2640 	return 0;
2641 }
2642 
snd_hda_spdif_in_switch_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)2643 static int snd_hda_spdif_in_switch_put(struct snd_kcontrol *kcontrol,
2644 				       struct snd_ctl_elem_value *ucontrol)
2645 {
2646 	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
2647 	hda_nid_t nid = kcontrol->private_value;
2648 	unsigned int val = !!ucontrol->value.integer.value[0];
2649 	int change;
2650 
2651 	mutex_lock(&codec->spdif_mutex);
2652 	change = codec->spdif_in_enable != val;
2653 	if (change) {
2654 		codec->spdif_in_enable = val;
2655 		snd_hdac_regmap_write(&codec->core, nid,
2656 				      AC_VERB_SET_DIGI_CONVERT_1, val);
2657 	}
2658 	mutex_unlock(&codec->spdif_mutex);
2659 	return change;
2660 }
2661 
snd_hda_spdif_in_status_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)2662 static int snd_hda_spdif_in_status_get(struct snd_kcontrol *kcontrol,
2663 				       struct snd_ctl_elem_value *ucontrol)
2664 {
2665 	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
2666 	hda_nid_t nid = kcontrol->private_value;
2667 	unsigned int val;
2668 	unsigned int sbits;
2669 
2670 	snd_hdac_regmap_read(&codec->core, nid,
2671 			     AC_VERB_GET_DIGI_CONVERT_1, &val);
2672 	sbits = convert_to_spdif_status(val);
2673 	ucontrol->value.iec958.status[0] = sbits;
2674 	ucontrol->value.iec958.status[1] = sbits >> 8;
2675 	ucontrol->value.iec958.status[2] = sbits >> 16;
2676 	ucontrol->value.iec958.status[3] = sbits >> 24;
2677 	return 0;
2678 }
2679 
2680 static const struct snd_kcontrol_new dig_in_ctls[] = {
2681 	{
2682 		.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2683 		.name = SNDRV_CTL_NAME_IEC958("", CAPTURE, SWITCH),
2684 		.info = snd_hda_spdif_in_switch_info,
2685 		.get = snd_hda_spdif_in_switch_get,
2686 		.put = snd_hda_spdif_in_switch_put,
2687 	},
2688 	{
2689 		.access = SNDRV_CTL_ELEM_ACCESS_READ,
2690 		.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2691 		.name = SNDRV_CTL_NAME_IEC958("", CAPTURE, DEFAULT),
2692 		.info = snd_hda_spdif_mask_info,
2693 		.get = snd_hda_spdif_in_status_get,
2694 	},
2695 	{ } /* end */
2696 };
2697 
2698 /**
2699  * snd_hda_create_spdif_in_ctls - create Input SPDIF-related controls
2700  * @codec: the HDA codec
2701  * @nid: audio in widget NID
2702  *
2703  * Creates controls related with the SPDIF input.
2704  * Called from each patch supporting the SPDIF in.
2705  *
2706  * Returns 0 if successful, or a negative error code.
2707  */
snd_hda_create_spdif_in_ctls(struct hda_codec * codec,hda_nid_t nid)2708 int snd_hda_create_spdif_in_ctls(struct hda_codec *codec, hda_nid_t nid)
2709 {
2710 	int err;
2711 	struct snd_kcontrol *kctl;
2712 	const struct snd_kcontrol_new *dig_mix;
2713 	int idx;
2714 
2715 	idx = find_empty_mixer_ctl_idx(codec, "IEC958 Capture Switch", 0);
2716 	if (idx < 0) {
2717 		codec_err(codec, "too many IEC958 inputs\n");
2718 		return -EBUSY;
2719 	}
2720 	for (dig_mix = dig_in_ctls; dig_mix->name; dig_mix++) {
2721 		kctl = snd_ctl_new1(dig_mix, codec);
2722 		if (!kctl)
2723 			return -ENOMEM;
2724 		kctl->private_value = nid;
2725 		err = snd_hda_ctl_add(codec, nid, kctl);
2726 		if (err < 0)
2727 			return err;
2728 	}
2729 	codec->spdif_in_enable =
2730 		snd_hda_codec_read(codec, nid, 0,
2731 				   AC_VERB_GET_DIGI_CONVERT_1, 0) &
2732 		AC_DIG1_ENABLE;
2733 	return 0;
2734 }
2735 EXPORT_SYMBOL_GPL(snd_hda_create_spdif_in_ctls);
2736 
2737 /**
2738  * snd_hda_codec_set_power_to_all - Set the power state to all widgets
2739  * @codec: the HDA codec
2740  * @fg: function group (not used now)
2741  * @power_state: the power state to set (AC_PWRST_*)
2742  *
2743  * Set the given power state to all widgets that have the power control.
2744  * If the codec has power_filter set, it evaluates the power state and
2745  * filter out if it's unchanged as D3.
2746  */
snd_hda_codec_set_power_to_all(struct hda_codec * codec,hda_nid_t fg,unsigned int power_state)2747 void snd_hda_codec_set_power_to_all(struct hda_codec *codec, hda_nid_t fg,
2748 				    unsigned int power_state)
2749 {
2750 	hda_nid_t nid;
2751 
2752 	for_each_hda_codec_node(nid, codec) {
2753 		unsigned int wcaps = get_wcaps(codec, nid);
2754 		unsigned int state = power_state;
2755 		if (!(wcaps & AC_WCAP_POWER))
2756 			continue;
2757 		if (codec->power_filter) {
2758 			state = codec->power_filter(codec, nid, power_state);
2759 			if (state != power_state && power_state == AC_PWRST_D3)
2760 				continue;
2761 		}
2762 		snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_POWER_STATE,
2763 				    state);
2764 	}
2765 }
2766 EXPORT_SYMBOL_GPL(snd_hda_codec_set_power_to_all);
2767 
2768 /**
2769  * snd_hda_codec_eapd_power_filter - A power filter callback for EAPD
2770  * @codec: the HDA codec
2771  * @nid: widget NID
2772  * @power_state: power state to evalue
2773  *
2774  * Don't power down the widget if it controls eapd and EAPD_BTLENABLE is set.
2775  * This can be used a codec power_filter callback.
2776  */
snd_hda_codec_eapd_power_filter(struct hda_codec * codec,hda_nid_t nid,unsigned int power_state)2777 unsigned int snd_hda_codec_eapd_power_filter(struct hda_codec *codec,
2778 					     hda_nid_t nid,
2779 					     unsigned int power_state)
2780 {
2781 	if (nid == codec->core.afg || nid == codec->core.mfg)
2782 		return power_state;
2783 	if (power_state == AC_PWRST_D3 &&
2784 	    get_wcaps_type(get_wcaps(codec, nid)) == AC_WID_PIN &&
2785 	    (snd_hda_query_pin_caps(codec, nid) & AC_PINCAP_EAPD)) {
2786 		int eapd = snd_hda_codec_read(codec, nid, 0,
2787 					      AC_VERB_GET_EAPD_BTLENABLE, 0);
2788 		if (eapd & 0x02)
2789 			return AC_PWRST_D0;
2790 	}
2791 	return power_state;
2792 }
2793 EXPORT_SYMBOL_GPL(snd_hda_codec_eapd_power_filter);
2794 
2795 /*
2796  * set power state of the codec, and return the power state
2797  */
hda_set_power_state(struct hda_codec * codec,unsigned int power_state)2798 static unsigned int hda_set_power_state(struct hda_codec *codec,
2799 					unsigned int power_state)
2800 {
2801 	hda_nid_t fg = codec->core.afg ? codec->core.afg : codec->core.mfg;
2802 	int count;
2803 	unsigned int state;
2804 	int flags = 0;
2805 
2806 	/* this delay seems necessary to avoid click noise at power-down */
2807 	if (power_state == AC_PWRST_D3) {
2808 		if (codec->depop_delay < 0)
2809 			msleep(codec_has_epss(codec) ? 10 : 100);
2810 		else if (codec->depop_delay > 0)
2811 			msleep(codec->depop_delay);
2812 		flags = HDA_RW_NO_RESPONSE_FALLBACK;
2813 	}
2814 
2815 	/* repeat power states setting at most 10 times*/
2816 	for (count = 0; count < 10; count++) {
2817 		if (codec->patch_ops.set_power_state)
2818 			codec->patch_ops.set_power_state(codec, fg,
2819 							 power_state);
2820 		else {
2821 			state = power_state;
2822 			if (codec->power_filter)
2823 				state = codec->power_filter(codec, fg, state);
2824 			if (state == power_state || power_state != AC_PWRST_D3)
2825 				snd_hda_codec_read(codec, fg, flags,
2826 						   AC_VERB_SET_POWER_STATE,
2827 						   state);
2828 			snd_hda_codec_set_power_to_all(codec, fg, power_state);
2829 		}
2830 		state = snd_hda_sync_power_state(codec, fg, power_state);
2831 		if (!(state & AC_PWRST_ERROR))
2832 			break;
2833 	}
2834 
2835 	return state;
2836 }
2837 
2838 /* sync power states of all widgets;
2839  * this is called at the end of codec parsing
2840  */
sync_power_up_states(struct hda_codec * codec)2841 static void sync_power_up_states(struct hda_codec *codec)
2842 {
2843 	hda_nid_t nid;
2844 
2845 	/* don't care if no filter is used */
2846 	if (!codec->power_filter)
2847 		return;
2848 
2849 	for_each_hda_codec_node(nid, codec) {
2850 		unsigned int wcaps = get_wcaps(codec, nid);
2851 		unsigned int target;
2852 		if (!(wcaps & AC_WCAP_POWER))
2853 			continue;
2854 		target = codec->power_filter(codec, nid, AC_PWRST_D0);
2855 		if (target == AC_PWRST_D0)
2856 			continue;
2857 		if (!snd_hda_check_power_state(codec, nid, target))
2858 			snd_hda_codec_write(codec, nid, 0,
2859 					    AC_VERB_SET_POWER_STATE, target);
2860 	}
2861 }
2862 
2863 #ifdef CONFIG_SND_HDA_RECONFIG
2864 /* execute additional init verbs */
hda_exec_init_verbs(struct hda_codec * codec)2865 static void hda_exec_init_verbs(struct hda_codec *codec)
2866 {
2867 	if (codec->init_verbs.list)
2868 		snd_hda_sequence_write(codec, codec->init_verbs.list);
2869 }
2870 #else
hda_exec_init_verbs(struct hda_codec * codec)2871 static inline void hda_exec_init_verbs(struct hda_codec *codec) {}
2872 #endif
2873 
2874 #ifdef CONFIG_PM
2875 /* update the power on/off account with the current jiffies */
update_power_acct(struct hda_codec * codec,bool on)2876 static void update_power_acct(struct hda_codec *codec, bool on)
2877 {
2878 	unsigned long delta = jiffies - codec->power_jiffies;
2879 
2880 	if (on)
2881 		codec->power_on_acct += delta;
2882 	else
2883 		codec->power_off_acct += delta;
2884 	codec->power_jiffies += delta;
2885 }
2886 
snd_hda_update_power_acct(struct hda_codec * codec)2887 void snd_hda_update_power_acct(struct hda_codec *codec)
2888 {
2889 	update_power_acct(codec, hda_codec_is_power_on(codec));
2890 }
2891 
2892 /*
2893  * call suspend and power-down; used both from PM and power-save
2894  * this function returns the power state in the end
2895  */
hda_call_codec_suspend(struct hda_codec * codec)2896 static unsigned int hda_call_codec_suspend(struct hda_codec *codec)
2897 {
2898 	unsigned int state;
2899 
2900 	snd_hdac_enter_pm(&codec->core);
2901 	if (codec->patch_ops.suspend)
2902 		codec->patch_ops.suspend(codec);
2903 	hda_cleanup_all_streams(codec);
2904 	state = hda_set_power_state(codec, AC_PWRST_D3);
2905 	update_power_acct(codec, true);
2906 	snd_hdac_leave_pm(&codec->core);
2907 	return state;
2908 }
2909 
2910 /*
2911  * kick up codec; used both from PM and power-save
2912  */
hda_call_codec_resume(struct hda_codec * codec)2913 static void hda_call_codec_resume(struct hda_codec *codec)
2914 {
2915 	snd_hdac_enter_pm(&codec->core);
2916 	if (codec->core.regmap)
2917 		regcache_mark_dirty(codec->core.regmap);
2918 
2919 	codec->power_jiffies = jiffies;
2920 
2921 	hda_set_power_state(codec, AC_PWRST_D0);
2922 	restore_shutup_pins(codec);
2923 	hda_exec_init_verbs(codec);
2924 	snd_hda_jack_set_dirty_all(codec);
2925 	if (codec->patch_ops.resume)
2926 		codec->patch_ops.resume(codec);
2927 	else {
2928 		if (codec->patch_ops.init)
2929 			codec->patch_ops.init(codec);
2930 		snd_hda_regmap_sync(codec);
2931 	}
2932 
2933 	if (codec->jackpoll_interval)
2934 		hda_jackpoll_work(&codec->jackpoll_work.work);
2935 	else
2936 		snd_hda_jack_report_sync(codec);
2937 	codec->core.dev.power.power_state = PMSG_ON;
2938 	snd_hdac_leave_pm(&codec->core);
2939 }
2940 
hda_codec_runtime_suspend(struct device * dev)2941 static int hda_codec_runtime_suspend(struct device *dev)
2942 {
2943 	struct hda_codec *codec = dev_to_hda_codec(dev);
2944 	unsigned int state;
2945 
2946 	/* Nothing to do if card registration fails and the component driver never probes */
2947 	if (!codec->card)
2948 		return 0;
2949 
2950 	cancel_delayed_work_sync(&codec->jackpoll_work);
2951 	state = hda_call_codec_suspend(codec);
2952 	if (codec->link_down_at_suspend ||
2953 	    (codec_has_clkstop(codec) && codec_has_epss(codec) &&
2954 	     (state & AC_PWRST_CLK_STOP_OK)))
2955 		snd_hdac_codec_link_down(&codec->core);
2956 	codec_display_power(codec, false);
2957 	return 0;
2958 }
2959 
hda_codec_runtime_resume(struct device * dev)2960 static int hda_codec_runtime_resume(struct device *dev)
2961 {
2962 	struct hda_codec *codec = dev_to_hda_codec(dev);
2963 
2964 	/* Nothing to do if card registration fails and the component driver never probes */
2965 	if (!codec->card)
2966 		return 0;
2967 
2968 	codec_display_power(codec, true);
2969 	snd_hdac_codec_link_up(&codec->core);
2970 	hda_call_codec_resume(codec);
2971 	pm_runtime_mark_last_busy(dev);
2972 	return 0;
2973 }
2974 
2975 #endif /* CONFIG_PM */
2976 
2977 #ifdef CONFIG_PM_SLEEP
hda_codec_pm_prepare(struct device * dev)2978 static int hda_codec_pm_prepare(struct device *dev)
2979 {
2980 	dev->power.power_state = PMSG_SUSPEND;
2981 	return pm_runtime_suspended(dev);
2982 }
2983 
hda_codec_pm_complete(struct device * dev)2984 static void hda_codec_pm_complete(struct device *dev)
2985 {
2986 	struct hda_codec *codec = dev_to_hda_codec(dev);
2987 
2988 	/* If no other pm-functions are called between prepare() and complete() */
2989 	if (dev->power.power_state.event == PM_EVENT_SUSPEND)
2990 		dev->power.power_state = PMSG_RESUME;
2991 
2992 	if (pm_runtime_suspended(dev) && (codec->jackpoll_interval ||
2993 	    hda_codec_need_resume(codec) || codec->forced_resume))
2994 		pm_request_resume(dev);
2995 }
2996 
hda_codec_pm_suspend(struct device * dev)2997 static int hda_codec_pm_suspend(struct device *dev)
2998 {
2999 	dev->power.power_state = PMSG_SUSPEND;
3000 	return pm_runtime_force_suspend(dev);
3001 }
3002 
hda_codec_pm_resume(struct device * dev)3003 static int hda_codec_pm_resume(struct device *dev)
3004 {
3005 	dev->power.power_state = PMSG_RESUME;
3006 	return pm_runtime_force_resume(dev);
3007 }
3008 
hda_codec_pm_freeze(struct device * dev)3009 static int hda_codec_pm_freeze(struct device *dev)
3010 {
3011 	dev->power.power_state = PMSG_FREEZE;
3012 	return pm_runtime_force_suspend(dev);
3013 }
3014 
hda_codec_pm_thaw(struct device * dev)3015 static int hda_codec_pm_thaw(struct device *dev)
3016 {
3017 	dev->power.power_state = PMSG_THAW;
3018 	return pm_runtime_force_resume(dev);
3019 }
3020 
hda_codec_pm_restore(struct device * dev)3021 static int hda_codec_pm_restore(struct device *dev)
3022 {
3023 	dev->power.power_state = PMSG_RESTORE;
3024 	return pm_runtime_force_resume(dev);
3025 }
3026 #endif /* CONFIG_PM_SLEEP */
3027 
3028 /* referred in hda_bind.c */
3029 const struct dev_pm_ops hda_codec_driver_pm = {
3030 #ifdef CONFIG_PM_SLEEP
3031 	.prepare = hda_codec_pm_prepare,
3032 	.complete = hda_codec_pm_complete,
3033 	.suspend = hda_codec_pm_suspend,
3034 	.resume = hda_codec_pm_resume,
3035 	.freeze = hda_codec_pm_freeze,
3036 	.thaw = hda_codec_pm_thaw,
3037 	.poweroff = hda_codec_pm_suspend,
3038 	.restore = hda_codec_pm_restore,
3039 #endif /* CONFIG_PM_SLEEP */
3040 	SET_RUNTIME_PM_OPS(hda_codec_runtime_suspend, hda_codec_runtime_resume,
3041 			   NULL)
3042 };
3043 
3044 /*
3045  * add standard channel maps if not specified
3046  */
add_std_chmaps(struct hda_codec * codec)3047 static int add_std_chmaps(struct hda_codec *codec)
3048 {
3049 	struct hda_pcm *pcm;
3050 	int str, err;
3051 
3052 	list_for_each_entry(pcm, &codec->pcm_list_head, list) {
3053 		for (str = 0; str < 2; str++) {
3054 			struct hda_pcm_stream *hinfo = &pcm->stream[str];
3055 			struct snd_pcm_chmap *chmap;
3056 			const struct snd_pcm_chmap_elem *elem;
3057 
3058 			if (!pcm->pcm || pcm->own_chmap || !hinfo->substreams)
3059 				continue;
3060 			elem = hinfo->chmap ? hinfo->chmap : snd_pcm_std_chmaps;
3061 			err = snd_pcm_add_chmap_ctls(pcm->pcm, str, elem,
3062 						     hinfo->channels_max,
3063 						     0, &chmap);
3064 			if (err < 0)
3065 				return err;
3066 			chmap->channel_mask = SND_PCM_CHMAP_MASK_2468;
3067 		}
3068 	}
3069 	return 0;
3070 }
3071 
3072 /* default channel maps for 2.1 speakers;
3073  * since HD-audio supports only stereo, odd number channels are omitted
3074  */
3075 const struct snd_pcm_chmap_elem snd_pcm_2_1_chmaps[] = {
3076 	{ .channels = 2,
3077 	  .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR } },
3078 	{ .channels = 4,
3079 	  .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR,
3080 		   SNDRV_CHMAP_LFE, SNDRV_CHMAP_LFE } },
3081 	{ }
3082 };
3083 EXPORT_SYMBOL_GPL(snd_pcm_2_1_chmaps);
3084 
snd_hda_codec_build_controls(struct hda_codec * codec)3085 int snd_hda_codec_build_controls(struct hda_codec *codec)
3086 {
3087 	int err = 0;
3088 	hda_exec_init_verbs(codec);
3089 	/* continue to initialize... */
3090 	if (codec->patch_ops.init)
3091 		err = codec->patch_ops.init(codec);
3092 	if (!err && codec->patch_ops.build_controls)
3093 		err = codec->patch_ops.build_controls(codec);
3094 	if (err < 0)
3095 		return err;
3096 
3097 	/* we create chmaps here instead of build_pcms */
3098 	err = add_std_chmaps(codec);
3099 	if (err < 0)
3100 		return err;
3101 
3102 	if (codec->jackpoll_interval)
3103 		hda_jackpoll_work(&codec->jackpoll_work.work);
3104 	else
3105 		snd_hda_jack_report_sync(codec); /* call at the last init point */
3106 	sync_power_up_states(codec);
3107 	return 0;
3108 }
3109 EXPORT_SYMBOL_GPL(snd_hda_codec_build_controls);
3110 
3111 /*
3112  * PCM stuff
3113  */
hda_pcm_default_open_close(struct hda_pcm_stream * hinfo,struct hda_codec * codec,struct snd_pcm_substream * substream)3114 static int hda_pcm_default_open_close(struct hda_pcm_stream *hinfo,
3115 				      struct hda_codec *codec,
3116 				      struct snd_pcm_substream *substream)
3117 {
3118 	return 0;
3119 }
3120 
hda_pcm_default_prepare(struct hda_pcm_stream * hinfo,struct hda_codec * codec,unsigned int stream_tag,unsigned int format,struct snd_pcm_substream * substream)3121 static int hda_pcm_default_prepare(struct hda_pcm_stream *hinfo,
3122 				   struct hda_codec *codec,
3123 				   unsigned int stream_tag,
3124 				   unsigned int format,
3125 				   struct snd_pcm_substream *substream)
3126 {
3127 	snd_hda_codec_setup_stream(codec, hinfo->nid, stream_tag, 0, format);
3128 	return 0;
3129 }
3130 
hda_pcm_default_cleanup(struct hda_pcm_stream * hinfo,struct hda_codec * codec,struct snd_pcm_substream * substream)3131 static int hda_pcm_default_cleanup(struct hda_pcm_stream *hinfo,
3132 				   struct hda_codec *codec,
3133 				   struct snd_pcm_substream *substream)
3134 {
3135 	snd_hda_codec_cleanup_stream(codec, hinfo->nid);
3136 	return 0;
3137 }
3138 
set_pcm_default_values(struct hda_codec * codec,struct hda_pcm_stream * info)3139 static int set_pcm_default_values(struct hda_codec *codec,
3140 				  struct hda_pcm_stream *info)
3141 {
3142 	int err;
3143 
3144 	/* query support PCM information from the given NID */
3145 	if (info->nid && (!info->rates || !info->formats)) {
3146 		err = snd_hda_query_supported_pcm(codec, info->nid,
3147 				info->rates ? NULL : &info->rates,
3148 				info->formats ? NULL : &info->formats,
3149 				info->maxbps ? NULL : &info->maxbps);
3150 		if (err < 0)
3151 			return err;
3152 	}
3153 	if (info->ops.open == NULL)
3154 		info->ops.open = hda_pcm_default_open_close;
3155 	if (info->ops.close == NULL)
3156 		info->ops.close = hda_pcm_default_open_close;
3157 	if (info->ops.prepare == NULL) {
3158 		if (snd_BUG_ON(!info->nid))
3159 			return -EINVAL;
3160 		info->ops.prepare = hda_pcm_default_prepare;
3161 	}
3162 	if (info->ops.cleanup == NULL) {
3163 		if (snd_BUG_ON(!info->nid))
3164 			return -EINVAL;
3165 		info->ops.cleanup = hda_pcm_default_cleanup;
3166 	}
3167 	return 0;
3168 }
3169 
3170 /*
3171  * codec prepare/cleanup entries
3172  */
3173 /**
3174  * snd_hda_codec_prepare - Prepare a stream
3175  * @codec: the HDA codec
3176  * @hinfo: PCM information
3177  * @stream: stream tag to assign
3178  * @format: format id to assign
3179  * @substream: PCM substream to assign
3180  *
3181  * Calls the prepare callback set by the codec with the given arguments.
3182  * Clean up the inactive streams when successful.
3183  */
snd_hda_codec_prepare(struct hda_codec * codec,struct hda_pcm_stream * hinfo,unsigned int stream,unsigned int format,struct snd_pcm_substream * substream)3184 int snd_hda_codec_prepare(struct hda_codec *codec,
3185 			  struct hda_pcm_stream *hinfo,
3186 			  unsigned int stream,
3187 			  unsigned int format,
3188 			  struct snd_pcm_substream *substream)
3189 {
3190 	int ret;
3191 	mutex_lock(&codec->bus->prepare_mutex);
3192 	if (hinfo->ops.prepare)
3193 		ret = hinfo->ops.prepare(hinfo, codec, stream, format,
3194 					 substream);
3195 	else
3196 		ret = -ENODEV;
3197 	if (ret >= 0)
3198 		purify_inactive_streams(codec);
3199 	mutex_unlock(&codec->bus->prepare_mutex);
3200 	return ret;
3201 }
3202 EXPORT_SYMBOL_GPL(snd_hda_codec_prepare);
3203 
3204 /**
3205  * snd_hda_codec_cleanup - Clean up stream resources
3206  * @codec: the HDA codec
3207  * @hinfo: PCM information
3208  * @substream: PCM substream
3209  *
3210  * Calls the cleanup callback set by the codec with the given arguments.
3211  */
snd_hda_codec_cleanup(struct hda_codec * codec,struct hda_pcm_stream * hinfo,struct snd_pcm_substream * substream)3212 void snd_hda_codec_cleanup(struct hda_codec *codec,
3213 			   struct hda_pcm_stream *hinfo,
3214 			   struct snd_pcm_substream *substream)
3215 {
3216 	mutex_lock(&codec->bus->prepare_mutex);
3217 	if (hinfo->ops.cleanup)
3218 		hinfo->ops.cleanup(hinfo, codec, substream);
3219 	mutex_unlock(&codec->bus->prepare_mutex);
3220 }
3221 EXPORT_SYMBOL_GPL(snd_hda_codec_cleanup);
3222 
3223 /* global */
3224 const char *snd_hda_pcm_type_name[HDA_PCM_NTYPES] = {
3225 	"Audio", "SPDIF", "HDMI", "Modem"
3226 };
3227 
3228 /*
3229  * get the empty PCM device number to assign
3230  */
get_empty_pcm_device(struct hda_bus * bus,unsigned int type)3231 static int get_empty_pcm_device(struct hda_bus *bus, unsigned int type)
3232 {
3233 	/* audio device indices; not linear to keep compatibility */
3234 	/* assigned to static slots up to dev#10; if more needed, assign
3235 	 * the later slot dynamically (when CONFIG_SND_DYNAMIC_MINORS=y)
3236 	 */
3237 	static const int audio_idx[HDA_PCM_NTYPES][5] = {
3238 		[HDA_PCM_TYPE_AUDIO] = { 0, 2, 4, 5, -1 },
3239 		[HDA_PCM_TYPE_SPDIF] = { 1, -1 },
3240 		[HDA_PCM_TYPE_HDMI]  = { 3, 7, 8, 9, -1 },
3241 		[HDA_PCM_TYPE_MODEM] = { 6, -1 },
3242 	};
3243 	int i;
3244 
3245 	if (type >= HDA_PCM_NTYPES) {
3246 		dev_err(bus->card->dev, "Invalid PCM type %d\n", type);
3247 		return -EINVAL;
3248 	}
3249 
3250 	for (i = 0; audio_idx[type][i] >= 0; i++) {
3251 #ifndef CONFIG_SND_DYNAMIC_MINORS
3252 		if (audio_idx[type][i] >= 8)
3253 			break;
3254 #endif
3255 		if (!test_and_set_bit(audio_idx[type][i], bus->pcm_dev_bits))
3256 			return audio_idx[type][i];
3257 	}
3258 
3259 #ifdef CONFIG_SND_DYNAMIC_MINORS
3260 	/* non-fixed slots starting from 10 */
3261 	for (i = 10; i < 32; i++) {
3262 		if (!test_and_set_bit(i, bus->pcm_dev_bits))
3263 			return i;
3264 	}
3265 #endif
3266 
3267 	dev_warn(bus->card->dev, "Too many %s devices\n",
3268 		snd_hda_pcm_type_name[type]);
3269 #ifndef CONFIG_SND_DYNAMIC_MINORS
3270 	dev_warn(bus->card->dev,
3271 		 "Consider building the kernel with CONFIG_SND_DYNAMIC_MINORS=y\n");
3272 #endif
3273 	return -EAGAIN;
3274 }
3275 
3276 /* call build_pcms ops of the given codec and set up the default parameters */
snd_hda_codec_parse_pcms(struct hda_codec * codec)3277 int snd_hda_codec_parse_pcms(struct hda_codec *codec)
3278 {
3279 	struct hda_pcm *cpcm;
3280 	int err;
3281 
3282 	if (!list_empty(&codec->pcm_list_head))
3283 		return 0; /* already parsed */
3284 
3285 	if (!codec->patch_ops.build_pcms)
3286 		return 0;
3287 
3288 	err = codec->patch_ops.build_pcms(codec);
3289 	if (err < 0) {
3290 		codec_err(codec, "cannot build PCMs for #%d (error %d)\n",
3291 			  codec->core.addr, err);
3292 		return err;
3293 	}
3294 
3295 	list_for_each_entry(cpcm, &codec->pcm_list_head, list) {
3296 		int stream;
3297 
3298 		for (stream = 0; stream < 2; stream++) {
3299 			struct hda_pcm_stream *info = &cpcm->stream[stream];
3300 
3301 			if (!info->substreams)
3302 				continue;
3303 			err = set_pcm_default_values(codec, info);
3304 			if (err < 0) {
3305 				codec_warn(codec,
3306 					   "fail to setup default for PCM %s\n",
3307 					   cpcm->name);
3308 				return err;
3309 			}
3310 		}
3311 	}
3312 
3313 	return 0;
3314 }
3315 EXPORT_SYMBOL_GPL(snd_hda_codec_parse_pcms);
3316 
3317 /* assign all PCMs of the given codec */
snd_hda_codec_build_pcms(struct hda_codec * codec)3318 int snd_hda_codec_build_pcms(struct hda_codec *codec)
3319 {
3320 	struct hda_bus *bus = codec->bus;
3321 	struct hda_pcm *cpcm;
3322 	int dev, err;
3323 
3324 	err = snd_hda_codec_parse_pcms(codec);
3325 	if (err < 0)
3326 		return err;
3327 
3328 	/* attach a new PCM streams */
3329 	list_for_each_entry(cpcm, &codec->pcm_list_head, list) {
3330 		if (cpcm->pcm)
3331 			continue; /* already attached */
3332 		if (!cpcm->stream[0].substreams && !cpcm->stream[1].substreams)
3333 			continue; /* no substreams assigned */
3334 
3335 		dev = get_empty_pcm_device(bus, cpcm->pcm_type);
3336 		if (dev < 0) {
3337 			cpcm->device = SNDRV_PCM_INVALID_DEVICE;
3338 			continue; /* no fatal error */
3339 		}
3340 		cpcm->device = dev;
3341 		err =  snd_hda_attach_pcm_stream(bus, codec, cpcm);
3342 		if (err < 0) {
3343 			codec_err(codec,
3344 				  "cannot attach PCM stream %d for codec #%d\n",
3345 				  dev, codec->core.addr);
3346 			continue; /* no fatal error */
3347 		}
3348 	}
3349 
3350 	return 0;
3351 }
3352 
3353 /**
3354  * snd_hda_add_new_ctls - create controls from the array
3355  * @codec: the HDA codec
3356  * @knew: the array of struct snd_kcontrol_new
3357  *
3358  * This helper function creates and add new controls in the given array.
3359  * The array must be terminated with an empty entry as terminator.
3360  *
3361  * Returns 0 if successful, or a negative error code.
3362  */
snd_hda_add_new_ctls(struct hda_codec * codec,const struct snd_kcontrol_new * knew)3363 int snd_hda_add_new_ctls(struct hda_codec *codec,
3364 			 const struct snd_kcontrol_new *knew)
3365 {
3366 	int err;
3367 
3368 	for (; knew->name; knew++) {
3369 		struct snd_kcontrol *kctl;
3370 		int addr = 0, idx = 0;
3371 		if (knew->iface == (__force snd_ctl_elem_iface_t)-1)
3372 			continue; /* skip this codec private value */
3373 		for (;;) {
3374 			kctl = snd_ctl_new1(knew, codec);
3375 			if (!kctl)
3376 				return -ENOMEM;
3377 			if (addr > 0)
3378 				kctl->id.device = addr;
3379 			if (idx > 0)
3380 				kctl->id.index = idx;
3381 			err = snd_hda_ctl_add(codec, 0, kctl);
3382 			if (!err)
3383 				break;
3384 			/* try first with another device index corresponding to
3385 			 * the codec addr; if it still fails (or it's the
3386 			 * primary codec), then try another control index
3387 			 */
3388 			if (!addr && codec->core.addr)
3389 				addr = codec->core.addr;
3390 			else if (!idx && !knew->index) {
3391 				idx = find_empty_mixer_ctl_idx(codec,
3392 							       knew->name, 0);
3393 				if (idx <= 0)
3394 					return err;
3395 			} else
3396 				return err;
3397 		}
3398 	}
3399 	return 0;
3400 }
3401 EXPORT_SYMBOL_GPL(snd_hda_add_new_ctls);
3402 
3403 #ifdef CONFIG_PM
codec_set_power_save(struct hda_codec * codec,int delay)3404 static void codec_set_power_save(struct hda_codec *codec, int delay)
3405 {
3406 	struct device *dev = hda_codec_dev(codec);
3407 
3408 	if (delay == 0 && codec->auto_runtime_pm)
3409 		delay = 3000;
3410 
3411 	if (delay > 0) {
3412 		pm_runtime_set_autosuspend_delay(dev, delay);
3413 		pm_runtime_use_autosuspend(dev);
3414 		pm_runtime_allow(dev);
3415 		if (!pm_runtime_suspended(dev))
3416 			pm_runtime_mark_last_busy(dev);
3417 	} else {
3418 		pm_runtime_dont_use_autosuspend(dev);
3419 		pm_runtime_forbid(dev);
3420 	}
3421 }
3422 
3423 /**
3424  * snd_hda_set_power_save - reprogram autosuspend for the given delay
3425  * @bus: HD-audio bus
3426  * @delay: autosuspend delay in msec, 0 = off
3427  *
3428  * Synchronize the runtime PM autosuspend state from the power_save option.
3429  */
snd_hda_set_power_save(struct hda_bus * bus,int delay)3430 void snd_hda_set_power_save(struct hda_bus *bus, int delay)
3431 {
3432 	struct hda_codec *c;
3433 
3434 	list_for_each_codec(c, bus)
3435 		codec_set_power_save(c, delay);
3436 }
3437 EXPORT_SYMBOL_GPL(snd_hda_set_power_save);
3438 
3439 /**
3440  * snd_hda_check_amp_list_power - Check the amp list and update the power
3441  * @codec: HD-audio codec
3442  * @check: the object containing an AMP list and the status
3443  * @nid: NID to check / update
3444  *
3445  * Check whether the given NID is in the amp list.  If it's in the list,
3446  * check the current AMP status, and update the power-status according
3447  * to the mute status.
3448  *
3449  * This function is supposed to be set or called from the check_power_status
3450  * patch ops.
3451  */
snd_hda_check_amp_list_power(struct hda_codec * codec,struct hda_loopback_check * check,hda_nid_t nid)3452 int snd_hda_check_amp_list_power(struct hda_codec *codec,
3453 				 struct hda_loopback_check *check,
3454 				 hda_nid_t nid)
3455 {
3456 	const struct hda_amp_list *p;
3457 	int ch, v;
3458 
3459 	if (!check->amplist)
3460 		return 0;
3461 	for (p = check->amplist; p->nid; p++) {
3462 		if (p->nid == nid)
3463 			break;
3464 	}
3465 	if (!p->nid)
3466 		return 0; /* nothing changed */
3467 
3468 	for (p = check->amplist; p->nid; p++) {
3469 		for (ch = 0; ch < 2; ch++) {
3470 			v = snd_hda_codec_amp_read(codec, p->nid, ch, p->dir,
3471 						   p->idx);
3472 			if (!(v & HDA_AMP_MUTE) && v > 0) {
3473 				if (!check->power_on) {
3474 					check->power_on = 1;
3475 					snd_hda_power_up_pm(codec);
3476 				}
3477 				return 1;
3478 			}
3479 		}
3480 	}
3481 	if (check->power_on) {
3482 		check->power_on = 0;
3483 		snd_hda_power_down_pm(codec);
3484 	}
3485 	return 0;
3486 }
3487 EXPORT_SYMBOL_GPL(snd_hda_check_amp_list_power);
3488 #endif
3489 
3490 /*
3491  * input MUX helper
3492  */
3493 
3494 /**
3495  * snd_hda_input_mux_info_info - Info callback helper for the input-mux enum
3496  * @imux: imux helper object
3497  * @uinfo: pointer to get/store the data
3498  */
snd_hda_input_mux_info(const struct hda_input_mux * imux,struct snd_ctl_elem_info * uinfo)3499 int snd_hda_input_mux_info(const struct hda_input_mux *imux,
3500 			   struct snd_ctl_elem_info *uinfo)
3501 {
3502 	unsigned int index;
3503 
3504 	uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
3505 	uinfo->count = 1;
3506 	uinfo->value.enumerated.items = imux->num_items;
3507 	if (!imux->num_items)
3508 		return 0;
3509 	index = uinfo->value.enumerated.item;
3510 	if (index >= imux->num_items)
3511 		index = imux->num_items - 1;
3512 	strcpy(uinfo->value.enumerated.name, imux->items[index].label);
3513 	return 0;
3514 }
3515 EXPORT_SYMBOL_GPL(snd_hda_input_mux_info);
3516 
3517 /**
3518  * snd_hda_input_mux_info_put - Put callback helper for the input-mux enum
3519  * @codec: the HDA codec
3520  * @imux: imux helper object
3521  * @ucontrol: pointer to get/store the data
3522  * @nid: input mux NID
3523  * @cur_val: pointer to get/store the current imux value
3524  */
snd_hda_input_mux_put(struct hda_codec * codec,const struct hda_input_mux * imux,struct snd_ctl_elem_value * ucontrol,hda_nid_t nid,unsigned int * cur_val)3525 int snd_hda_input_mux_put(struct hda_codec *codec,
3526 			  const struct hda_input_mux *imux,
3527 			  struct snd_ctl_elem_value *ucontrol,
3528 			  hda_nid_t nid,
3529 			  unsigned int *cur_val)
3530 {
3531 	unsigned int idx;
3532 
3533 	if (!imux->num_items)
3534 		return 0;
3535 	idx = ucontrol->value.enumerated.item[0];
3536 	if (idx >= imux->num_items)
3537 		idx = imux->num_items - 1;
3538 	if (*cur_val == idx)
3539 		return 0;
3540 	snd_hda_codec_write_cache(codec, nid, 0, AC_VERB_SET_CONNECT_SEL,
3541 				  imux->items[idx].index);
3542 	*cur_val = idx;
3543 	return 1;
3544 }
3545 EXPORT_SYMBOL_GPL(snd_hda_input_mux_put);
3546 
3547 
3548 /**
3549  * snd_hda_enum_helper_info - Helper for simple enum ctls
3550  * @kcontrol: ctl element
3551  * @uinfo: pointer to get/store the data
3552  * @num_items: number of enum items
3553  * @texts: enum item string array
3554  *
3555  * process kcontrol info callback of a simple string enum array
3556  * when @num_items is 0 or @texts is NULL, assume a boolean enum array
3557  */
snd_hda_enum_helper_info(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_info * uinfo,int num_items,const char * const * texts)3558 int snd_hda_enum_helper_info(struct snd_kcontrol *kcontrol,
3559 			     struct snd_ctl_elem_info *uinfo,
3560 			     int num_items, const char * const *texts)
3561 {
3562 	static const char * const texts_default[] = {
3563 		"Disabled", "Enabled"
3564 	};
3565 
3566 	if (!texts || !num_items) {
3567 		num_items = 2;
3568 		texts = texts_default;
3569 	}
3570 
3571 	return snd_ctl_enum_info(uinfo, 1, num_items, texts);
3572 }
3573 EXPORT_SYMBOL_GPL(snd_hda_enum_helper_info);
3574 
3575 /*
3576  * Multi-channel / digital-out PCM helper functions
3577  */
3578 
3579 /* setup SPDIF output stream */
setup_dig_out_stream(struct hda_codec * codec,hda_nid_t nid,unsigned int stream_tag,unsigned int format)3580 static void setup_dig_out_stream(struct hda_codec *codec, hda_nid_t nid,
3581 				 unsigned int stream_tag, unsigned int format)
3582 {
3583 	struct hda_spdif_out *spdif;
3584 	unsigned int curr_fmt;
3585 	bool reset;
3586 
3587 	spdif = snd_hda_spdif_out_of_nid(codec, nid);
3588 	/* Add sanity check to pass klockwork check.
3589 	 * This should never happen.
3590 	 */
3591 	if (WARN_ON(spdif == NULL))
3592 		return;
3593 
3594 	curr_fmt = snd_hda_codec_read(codec, nid, 0,
3595 				      AC_VERB_GET_STREAM_FORMAT, 0);
3596 	reset = codec->spdif_status_reset &&
3597 		(spdif->ctls & AC_DIG1_ENABLE) &&
3598 		curr_fmt != format;
3599 
3600 	/* turn off SPDIF if needed; otherwise the IEC958 bits won't be
3601 	   updated */
3602 	if (reset)
3603 		set_dig_out_convert(codec, nid,
3604 				    spdif->ctls & ~AC_DIG1_ENABLE & 0xff,
3605 				    -1);
3606 	snd_hda_codec_setup_stream(codec, nid, stream_tag, 0, format);
3607 	if (codec->follower_dig_outs) {
3608 		const hda_nid_t *d;
3609 		for (d = codec->follower_dig_outs; *d; d++)
3610 			snd_hda_codec_setup_stream(codec, *d, stream_tag, 0,
3611 						   format);
3612 	}
3613 	/* turn on again (if needed) */
3614 	if (reset)
3615 		set_dig_out_convert(codec, nid,
3616 				    spdif->ctls & 0xff, -1);
3617 }
3618 
cleanup_dig_out_stream(struct hda_codec * codec,hda_nid_t nid)3619 static void cleanup_dig_out_stream(struct hda_codec *codec, hda_nid_t nid)
3620 {
3621 	snd_hda_codec_cleanup_stream(codec, nid);
3622 	if (codec->follower_dig_outs) {
3623 		const hda_nid_t *d;
3624 		for (d = codec->follower_dig_outs; *d; d++)
3625 			snd_hda_codec_cleanup_stream(codec, *d);
3626 	}
3627 }
3628 
3629 /**
3630  * snd_hda_multi_out_dig_open - open the digital out in the exclusive mode
3631  * @codec: the HDA codec
3632  * @mout: hda_multi_out object
3633  */
snd_hda_multi_out_dig_open(struct hda_codec * codec,struct hda_multi_out * mout)3634 int snd_hda_multi_out_dig_open(struct hda_codec *codec,
3635 			       struct hda_multi_out *mout)
3636 {
3637 	mutex_lock(&codec->spdif_mutex);
3638 	if (mout->dig_out_used == HDA_DIG_ANALOG_DUP)
3639 		/* already opened as analog dup; reset it once */
3640 		cleanup_dig_out_stream(codec, mout->dig_out_nid);
3641 	mout->dig_out_used = HDA_DIG_EXCLUSIVE;
3642 	mutex_unlock(&codec->spdif_mutex);
3643 	return 0;
3644 }
3645 EXPORT_SYMBOL_GPL(snd_hda_multi_out_dig_open);
3646 
3647 /**
3648  * snd_hda_multi_out_dig_prepare - prepare the digital out stream
3649  * @codec: the HDA codec
3650  * @mout: hda_multi_out object
3651  * @stream_tag: stream tag to assign
3652  * @format: format id to assign
3653  * @substream: PCM substream to assign
3654  */
snd_hda_multi_out_dig_prepare(struct hda_codec * codec,struct hda_multi_out * mout,unsigned int stream_tag,unsigned int format,struct snd_pcm_substream * substream)3655 int snd_hda_multi_out_dig_prepare(struct hda_codec *codec,
3656 				  struct hda_multi_out *mout,
3657 				  unsigned int stream_tag,
3658 				  unsigned int format,
3659 				  struct snd_pcm_substream *substream)
3660 {
3661 	mutex_lock(&codec->spdif_mutex);
3662 	setup_dig_out_stream(codec, mout->dig_out_nid, stream_tag, format);
3663 	mutex_unlock(&codec->spdif_mutex);
3664 	return 0;
3665 }
3666 EXPORT_SYMBOL_GPL(snd_hda_multi_out_dig_prepare);
3667 
3668 /**
3669  * snd_hda_multi_out_dig_cleanup - clean-up the digital out stream
3670  * @codec: the HDA codec
3671  * @mout: hda_multi_out object
3672  */
snd_hda_multi_out_dig_cleanup(struct hda_codec * codec,struct hda_multi_out * mout)3673 int snd_hda_multi_out_dig_cleanup(struct hda_codec *codec,
3674 				  struct hda_multi_out *mout)
3675 {
3676 	mutex_lock(&codec->spdif_mutex);
3677 	cleanup_dig_out_stream(codec, mout->dig_out_nid);
3678 	mutex_unlock(&codec->spdif_mutex);
3679 	return 0;
3680 }
3681 EXPORT_SYMBOL_GPL(snd_hda_multi_out_dig_cleanup);
3682 
3683 /**
3684  * snd_hda_multi_out_dig_close - release the digital out stream
3685  * @codec: the HDA codec
3686  * @mout: hda_multi_out object
3687  */
snd_hda_multi_out_dig_close(struct hda_codec * codec,struct hda_multi_out * mout)3688 int snd_hda_multi_out_dig_close(struct hda_codec *codec,
3689 				struct hda_multi_out *mout)
3690 {
3691 	mutex_lock(&codec->spdif_mutex);
3692 	mout->dig_out_used = 0;
3693 	mutex_unlock(&codec->spdif_mutex);
3694 	return 0;
3695 }
3696 EXPORT_SYMBOL_GPL(snd_hda_multi_out_dig_close);
3697 
3698 /**
3699  * snd_hda_multi_out_analog_open - open analog outputs
3700  * @codec: the HDA codec
3701  * @mout: hda_multi_out object
3702  * @substream: PCM substream to assign
3703  * @hinfo: PCM information to assign
3704  *
3705  * Open analog outputs and set up the hw-constraints.
3706  * If the digital outputs can be opened as follower, open the digital
3707  * outputs, too.
3708  */
snd_hda_multi_out_analog_open(struct hda_codec * codec,struct hda_multi_out * mout,struct snd_pcm_substream * substream,struct hda_pcm_stream * hinfo)3709 int snd_hda_multi_out_analog_open(struct hda_codec *codec,
3710 				  struct hda_multi_out *mout,
3711 				  struct snd_pcm_substream *substream,
3712 				  struct hda_pcm_stream *hinfo)
3713 {
3714 	struct snd_pcm_runtime *runtime = substream->runtime;
3715 	runtime->hw.channels_max = mout->max_channels;
3716 	if (mout->dig_out_nid) {
3717 		if (!mout->analog_rates) {
3718 			mout->analog_rates = hinfo->rates;
3719 			mout->analog_formats = hinfo->formats;
3720 			mout->analog_maxbps = hinfo->maxbps;
3721 		} else {
3722 			runtime->hw.rates = mout->analog_rates;
3723 			runtime->hw.formats = mout->analog_formats;
3724 			hinfo->maxbps = mout->analog_maxbps;
3725 		}
3726 		if (!mout->spdif_rates) {
3727 			snd_hda_query_supported_pcm(codec, mout->dig_out_nid,
3728 						    &mout->spdif_rates,
3729 						    &mout->spdif_formats,
3730 						    &mout->spdif_maxbps);
3731 		}
3732 		mutex_lock(&codec->spdif_mutex);
3733 		if (mout->share_spdif) {
3734 			if ((runtime->hw.rates & mout->spdif_rates) &&
3735 			    (runtime->hw.formats & mout->spdif_formats)) {
3736 				runtime->hw.rates &= mout->spdif_rates;
3737 				runtime->hw.formats &= mout->spdif_formats;
3738 				if (mout->spdif_maxbps < hinfo->maxbps)
3739 					hinfo->maxbps = mout->spdif_maxbps;
3740 			} else {
3741 				mout->share_spdif = 0;
3742 				/* FIXME: need notify? */
3743 			}
3744 		}
3745 		mutex_unlock(&codec->spdif_mutex);
3746 	}
3747 	return snd_pcm_hw_constraint_step(substream->runtime, 0,
3748 					  SNDRV_PCM_HW_PARAM_CHANNELS, 2);
3749 }
3750 EXPORT_SYMBOL_GPL(snd_hda_multi_out_analog_open);
3751 
3752 /**
3753  * snd_hda_multi_out_analog_prepare - Preapre the analog outputs.
3754  * @codec: the HDA codec
3755  * @mout: hda_multi_out object
3756  * @stream_tag: stream tag to assign
3757  * @format: format id to assign
3758  * @substream: PCM substream to assign
3759  *
3760  * Set up the i/o for analog out.
3761  * When the digital out is available, copy the front out to digital out, too.
3762  */
snd_hda_multi_out_analog_prepare(struct hda_codec * codec,struct hda_multi_out * mout,unsigned int stream_tag,unsigned int format,struct snd_pcm_substream * substream)3763 int snd_hda_multi_out_analog_prepare(struct hda_codec *codec,
3764 				     struct hda_multi_out *mout,
3765 				     unsigned int stream_tag,
3766 				     unsigned int format,
3767 				     struct snd_pcm_substream *substream)
3768 {
3769 	const hda_nid_t *nids = mout->dac_nids;
3770 	int chs = substream->runtime->channels;
3771 	struct hda_spdif_out *spdif;
3772 	int i;
3773 
3774 	mutex_lock(&codec->spdif_mutex);
3775 	spdif = snd_hda_spdif_out_of_nid(codec, mout->dig_out_nid);
3776 	if (mout->dig_out_nid && mout->share_spdif &&
3777 	    mout->dig_out_used != HDA_DIG_EXCLUSIVE) {
3778 		if (chs == 2 && spdif != NULL &&
3779 		    snd_hda_is_supported_format(codec, mout->dig_out_nid,
3780 						format) &&
3781 		    !(spdif->status & IEC958_AES0_NONAUDIO)) {
3782 			mout->dig_out_used = HDA_DIG_ANALOG_DUP;
3783 			setup_dig_out_stream(codec, mout->dig_out_nid,
3784 					     stream_tag, format);
3785 		} else {
3786 			mout->dig_out_used = 0;
3787 			cleanup_dig_out_stream(codec, mout->dig_out_nid);
3788 		}
3789 	}
3790 	mutex_unlock(&codec->spdif_mutex);
3791 
3792 	/* front */
3793 	snd_hda_codec_setup_stream(codec, nids[HDA_FRONT], stream_tag,
3794 				   0, format);
3795 	if (!mout->no_share_stream &&
3796 	    mout->hp_nid && mout->hp_nid != nids[HDA_FRONT])
3797 		/* headphone out will just decode front left/right (stereo) */
3798 		snd_hda_codec_setup_stream(codec, mout->hp_nid, stream_tag,
3799 					   0, format);
3800 	/* extra outputs copied from front */
3801 	for (i = 0; i < ARRAY_SIZE(mout->hp_out_nid); i++)
3802 		if (!mout->no_share_stream && mout->hp_out_nid[i])
3803 			snd_hda_codec_setup_stream(codec,
3804 						   mout->hp_out_nid[i],
3805 						   stream_tag, 0, format);
3806 
3807 	/* surrounds */
3808 	for (i = 1; i < mout->num_dacs; i++) {
3809 		if (chs >= (i + 1) * 2) /* independent out */
3810 			snd_hda_codec_setup_stream(codec, nids[i], stream_tag,
3811 						   i * 2, format);
3812 		else if (!mout->no_share_stream) /* copy front */
3813 			snd_hda_codec_setup_stream(codec, nids[i], stream_tag,
3814 						   0, format);
3815 	}
3816 
3817 	/* extra surrounds */
3818 	for (i = 0; i < ARRAY_SIZE(mout->extra_out_nid); i++) {
3819 		int ch = 0;
3820 		if (!mout->extra_out_nid[i])
3821 			break;
3822 		if (chs >= (i + 1) * 2)
3823 			ch = i * 2;
3824 		else if (!mout->no_share_stream)
3825 			break;
3826 		snd_hda_codec_setup_stream(codec, mout->extra_out_nid[i],
3827 					   stream_tag, ch, format);
3828 	}
3829 
3830 	return 0;
3831 }
3832 EXPORT_SYMBOL_GPL(snd_hda_multi_out_analog_prepare);
3833 
3834 /**
3835  * snd_hda_multi_out_analog_cleanup - clean up the setting for analog out
3836  * @codec: the HDA codec
3837  * @mout: hda_multi_out object
3838  */
snd_hda_multi_out_analog_cleanup(struct hda_codec * codec,struct hda_multi_out * mout)3839 int snd_hda_multi_out_analog_cleanup(struct hda_codec *codec,
3840 				     struct hda_multi_out *mout)
3841 {
3842 	const hda_nid_t *nids = mout->dac_nids;
3843 	int i;
3844 
3845 	for (i = 0; i < mout->num_dacs; i++)
3846 		snd_hda_codec_cleanup_stream(codec, nids[i]);
3847 	if (mout->hp_nid)
3848 		snd_hda_codec_cleanup_stream(codec, mout->hp_nid);
3849 	for (i = 0; i < ARRAY_SIZE(mout->hp_out_nid); i++)
3850 		if (mout->hp_out_nid[i])
3851 			snd_hda_codec_cleanup_stream(codec,
3852 						     mout->hp_out_nid[i]);
3853 	for (i = 0; i < ARRAY_SIZE(mout->extra_out_nid); i++)
3854 		if (mout->extra_out_nid[i])
3855 			snd_hda_codec_cleanup_stream(codec,
3856 						     mout->extra_out_nid[i]);
3857 	mutex_lock(&codec->spdif_mutex);
3858 	if (mout->dig_out_nid && mout->dig_out_used == HDA_DIG_ANALOG_DUP) {
3859 		cleanup_dig_out_stream(codec, mout->dig_out_nid);
3860 		mout->dig_out_used = 0;
3861 	}
3862 	mutex_unlock(&codec->spdif_mutex);
3863 	return 0;
3864 }
3865 EXPORT_SYMBOL_GPL(snd_hda_multi_out_analog_cleanup);
3866 
3867 /**
3868  * snd_hda_get_default_vref - Get the default (mic) VREF pin bits
3869  * @codec: the HDA codec
3870  * @pin: referred pin NID
3871  *
3872  * Guess the suitable VREF pin bits to be set as the pin-control value.
3873  * Note: the function doesn't set the AC_PINCTL_IN_EN bit.
3874  */
snd_hda_get_default_vref(struct hda_codec * codec,hda_nid_t pin)3875 unsigned int snd_hda_get_default_vref(struct hda_codec *codec, hda_nid_t pin)
3876 {
3877 	unsigned int pincap;
3878 	unsigned int oldval;
3879 	oldval = snd_hda_codec_read(codec, pin, 0,
3880 				    AC_VERB_GET_PIN_WIDGET_CONTROL, 0);
3881 	pincap = snd_hda_query_pin_caps(codec, pin);
3882 	pincap = (pincap & AC_PINCAP_VREF) >> AC_PINCAP_VREF_SHIFT;
3883 	/* Exception: if the default pin setup is vref50, we give it priority */
3884 	if ((pincap & AC_PINCAP_VREF_80) && oldval != PIN_VREF50)
3885 		return AC_PINCTL_VREF_80;
3886 	else if (pincap & AC_PINCAP_VREF_50)
3887 		return AC_PINCTL_VREF_50;
3888 	else if (pincap & AC_PINCAP_VREF_100)
3889 		return AC_PINCTL_VREF_100;
3890 	else if (pincap & AC_PINCAP_VREF_GRD)
3891 		return AC_PINCTL_VREF_GRD;
3892 	return AC_PINCTL_VREF_HIZ;
3893 }
3894 EXPORT_SYMBOL_GPL(snd_hda_get_default_vref);
3895 
3896 /**
3897  * snd_hda_correct_pin_ctl - correct the pin ctl value for matching with the pin cap
3898  * @codec: the HDA codec
3899  * @pin: referred pin NID
3900  * @val: pin ctl value to audit
3901  */
snd_hda_correct_pin_ctl(struct hda_codec * codec,hda_nid_t pin,unsigned int val)3902 unsigned int snd_hda_correct_pin_ctl(struct hda_codec *codec,
3903 				     hda_nid_t pin, unsigned int val)
3904 {
3905 	static const unsigned int cap_lists[][2] = {
3906 		{ AC_PINCTL_VREF_100, AC_PINCAP_VREF_100 },
3907 		{ AC_PINCTL_VREF_80, AC_PINCAP_VREF_80 },
3908 		{ AC_PINCTL_VREF_50, AC_PINCAP_VREF_50 },
3909 		{ AC_PINCTL_VREF_GRD, AC_PINCAP_VREF_GRD },
3910 	};
3911 	unsigned int cap;
3912 
3913 	if (!val)
3914 		return 0;
3915 	cap = snd_hda_query_pin_caps(codec, pin);
3916 	if (!cap)
3917 		return val; /* don't know what to do... */
3918 
3919 	if (val & AC_PINCTL_OUT_EN) {
3920 		if (!(cap & AC_PINCAP_OUT))
3921 			val &= ~(AC_PINCTL_OUT_EN | AC_PINCTL_HP_EN);
3922 		else if ((val & AC_PINCTL_HP_EN) && !(cap & AC_PINCAP_HP_DRV))
3923 			val &= ~AC_PINCTL_HP_EN;
3924 	}
3925 
3926 	if (val & AC_PINCTL_IN_EN) {
3927 		if (!(cap & AC_PINCAP_IN))
3928 			val &= ~(AC_PINCTL_IN_EN | AC_PINCTL_VREFEN);
3929 		else {
3930 			unsigned int vcap, vref;
3931 			int i;
3932 			vcap = (cap & AC_PINCAP_VREF) >> AC_PINCAP_VREF_SHIFT;
3933 			vref = val & AC_PINCTL_VREFEN;
3934 			for (i = 0; i < ARRAY_SIZE(cap_lists); i++) {
3935 				if (vref == cap_lists[i][0] &&
3936 				    !(vcap & cap_lists[i][1])) {
3937 					if (i == ARRAY_SIZE(cap_lists) - 1)
3938 						vref = AC_PINCTL_VREF_HIZ;
3939 					else
3940 						vref = cap_lists[i + 1][0];
3941 				}
3942 			}
3943 			val &= ~AC_PINCTL_VREFEN;
3944 			val |= vref;
3945 		}
3946 	}
3947 
3948 	return val;
3949 }
3950 EXPORT_SYMBOL_GPL(snd_hda_correct_pin_ctl);
3951 
3952 /**
3953  * _snd_hda_pin_ctl - Helper to set pin ctl value
3954  * @codec: the HDA codec
3955  * @pin: referred pin NID
3956  * @val: pin control value to set
3957  * @cached: access over codec pinctl cache or direct write
3958  *
3959  * This function is a helper to set a pin ctl value more safely.
3960  * It corrects the pin ctl value via snd_hda_correct_pin_ctl(), stores the
3961  * value in pin target array via snd_hda_codec_set_pin_target(), then
3962  * actually writes the value via either snd_hda_codec_write_cache() or
3963  * snd_hda_codec_write() depending on @cached flag.
3964  */
_snd_hda_set_pin_ctl(struct hda_codec * codec,hda_nid_t pin,unsigned int val,bool cached)3965 int _snd_hda_set_pin_ctl(struct hda_codec *codec, hda_nid_t pin,
3966 			 unsigned int val, bool cached)
3967 {
3968 	val = snd_hda_correct_pin_ctl(codec, pin, val);
3969 	snd_hda_codec_set_pin_target(codec, pin, val);
3970 	if (cached)
3971 		return snd_hda_codec_write_cache(codec, pin, 0,
3972 				AC_VERB_SET_PIN_WIDGET_CONTROL, val);
3973 	else
3974 		return snd_hda_codec_write(codec, pin, 0,
3975 					   AC_VERB_SET_PIN_WIDGET_CONTROL, val);
3976 }
3977 EXPORT_SYMBOL_GPL(_snd_hda_set_pin_ctl);
3978 
3979 /**
3980  * snd_hda_add_imux_item - Add an item to input_mux
3981  * @codec: the HDA codec
3982  * @imux: imux helper object
3983  * @label: the name of imux item to assign
3984  * @index: index number of imux item to assign
3985  * @type_idx: pointer to store the resultant label index
3986  *
3987  * When the same label is used already in the existing items, the number
3988  * suffix is appended to the label.  This label index number is stored
3989  * to type_idx when non-NULL pointer is given.
3990  */
snd_hda_add_imux_item(struct hda_codec * codec,struct hda_input_mux * imux,const char * label,int index,int * type_idx)3991 int snd_hda_add_imux_item(struct hda_codec *codec,
3992 			  struct hda_input_mux *imux, const char *label,
3993 			  int index, int *type_idx)
3994 {
3995 	int i, label_idx = 0;
3996 	if (imux->num_items >= HDA_MAX_NUM_INPUTS) {
3997 		codec_err(codec, "hda_codec: Too many imux items!\n");
3998 		return -EINVAL;
3999 	}
4000 	for (i = 0; i < imux->num_items; i++) {
4001 		if (!strncmp(label, imux->items[i].label, strlen(label)))
4002 			label_idx++;
4003 	}
4004 	if (type_idx)
4005 		*type_idx = label_idx;
4006 	if (label_idx > 0)
4007 		snprintf(imux->items[imux->num_items].label,
4008 			 sizeof(imux->items[imux->num_items].label),
4009 			 "%s %d", label, label_idx);
4010 	else
4011 		strlcpy(imux->items[imux->num_items].label, label,
4012 			sizeof(imux->items[imux->num_items].label));
4013 	imux->items[imux->num_items].index = index;
4014 	imux->num_items++;
4015 	return 0;
4016 }
4017 EXPORT_SYMBOL_GPL(snd_hda_add_imux_item);
4018 
4019 /**
4020  * snd_hda_bus_reset_codecs - Reset the bus
4021  * @bus: HD-audio bus
4022  */
snd_hda_bus_reset_codecs(struct hda_bus * bus)4023 void snd_hda_bus_reset_codecs(struct hda_bus *bus)
4024 {
4025 	struct hda_codec *codec;
4026 
4027 	list_for_each_codec(codec, bus) {
4028 		/* FIXME: maybe a better way needed for forced reset */
4029 		if (current_work() != &codec->jackpoll_work.work)
4030 			cancel_delayed_work_sync(&codec->jackpoll_work);
4031 #ifdef CONFIG_PM
4032 		if (hda_codec_is_power_on(codec)) {
4033 			hda_call_codec_suspend(codec);
4034 			hda_call_codec_resume(codec);
4035 		}
4036 #endif
4037 	}
4038 }
4039 
4040 /**
4041  * snd_print_pcm_bits - Print the supported PCM fmt bits to the string buffer
4042  * @pcm: PCM caps bits
4043  * @buf: the string buffer to write
4044  * @buflen: the max buffer length
4045  *
4046  * used by hda_proc.c and hda_eld.c
4047  */
snd_print_pcm_bits(int pcm,char * buf,int buflen)4048 void snd_print_pcm_bits(int pcm, char *buf, int buflen)
4049 {
4050 	static const unsigned int bits[] = { 8, 16, 20, 24, 32 };
4051 	int i, j;
4052 
4053 	for (i = 0, j = 0; i < ARRAY_SIZE(bits); i++)
4054 		if (pcm & (AC_SUPPCM_BITS_8 << i))
4055 			j += scnprintf(buf + j, buflen - j,  " %d", bits[i]);
4056 
4057 	buf[j] = '\0'; /* necessary when j == 0 */
4058 }
4059 EXPORT_SYMBOL_GPL(snd_print_pcm_bits);
4060 
4061 MODULE_DESCRIPTION("HDA codec core");
4062 MODULE_LICENSE("GPL");
4063