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