xref: /openbmc/linux/sound/soc/codecs/hdac_hdmi.c (revision 8f8d5745bb520c76b81abef4a2cb3023d0313bfd)
1 /*
2  *  hdac_hdmi.c - ASoc HDA-HDMI codec driver for Intel platforms
3  *
4  *  Copyright (C) 2014-2015 Intel Corp
5  *  Author: Samreen Nilofer <samreen.nilofer@intel.com>
6  *	    Subhransu S. Prusty <subhransu.s.prusty@intel.com>
7  *  ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
8  *
9  *  This program is free software; you can redistribute it and/or modify
10  *  it under the terms of the GNU General Public License as published by
11  *  the Free Software Foundation; version 2 of the License.
12  *
13  *  This program is distributed in the hope that it will be useful, but
14  *  WITHOUT ANY WARRANTY; without even the implied warranty of
15  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
16  *  General Public License for more details.
17  *
18  * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
19  */
20 #include <linux/init.h>
21 #include <linux/delay.h>
22 #include <linux/module.h>
23 #include <linux/pm_runtime.h>
24 #include <linux/hdmi.h>
25 #include <drm/drm_edid.h>
26 #include <sound/pcm_params.h>
27 #include <sound/jack.h>
28 #include <sound/soc.h>
29 #include <sound/hdaudio_ext.h>
30 #include <sound/hda_i915.h>
31 #include <sound/pcm_drm_eld.h>
32 #include <sound/hda_chmap.h>
33 #include "../../hda/local.h"
34 #include "hdac_hdmi.h"
35 
36 #define NAME_SIZE	32
37 
38 #define AMP_OUT_MUTE		0xb080
39 #define AMP_OUT_UNMUTE		0xb000
40 #define PIN_OUT			(AC_PINCTL_OUT_EN)
41 
42 #define HDA_MAX_CONNECTIONS     32
43 
44 #define HDA_MAX_CVTS		3
45 #define HDA_MAX_PORTS		3
46 
47 #define ELD_MAX_SIZE    256
48 #define ELD_FIXED_BYTES	20
49 
50 #define ELD_VER_CEA_861D 2
51 #define ELD_VER_PARTIAL 31
52 #define ELD_MAX_MNL     16
53 
54 struct hdac_hdmi_cvt_params {
55 	unsigned int channels_min;
56 	unsigned int channels_max;
57 	u32 rates;
58 	u64 formats;
59 	unsigned int maxbps;
60 };
61 
62 struct hdac_hdmi_cvt {
63 	struct list_head head;
64 	hda_nid_t nid;
65 	const char *name;
66 	struct hdac_hdmi_cvt_params params;
67 };
68 
69 /* Currently only spk_alloc, more to be added */
70 struct hdac_hdmi_parsed_eld {
71 	u8 spk_alloc;
72 };
73 
74 struct hdac_hdmi_eld {
75 	bool	monitor_present;
76 	bool	eld_valid;
77 	int	eld_size;
78 	char    eld_buffer[ELD_MAX_SIZE];
79 	struct	hdac_hdmi_parsed_eld info;
80 };
81 
82 struct hdac_hdmi_pin {
83 	struct list_head head;
84 	hda_nid_t nid;
85 	bool mst_capable;
86 	struct hdac_hdmi_port *ports;
87 	int num_ports;
88 	struct hdac_device *hdev;
89 };
90 
91 struct hdac_hdmi_port {
92 	struct list_head head;
93 	int id;
94 	struct hdac_hdmi_pin *pin;
95 	int num_mux_nids;
96 	hda_nid_t mux_nids[HDA_MAX_CONNECTIONS];
97 	struct hdac_hdmi_eld eld;
98 	const char *jack_pin;
99 	struct snd_soc_dapm_context *dapm;
100 	const char *output_pin;
101 };
102 
103 struct hdac_hdmi_pcm {
104 	struct list_head head;
105 	int pcm_id;
106 	struct list_head port_list;
107 	struct hdac_hdmi_cvt *cvt;
108 	struct snd_soc_jack *jack;
109 	int stream_tag;
110 	int channels;
111 	int format;
112 	bool chmap_set;
113 	unsigned char chmap[8]; /* ALSA API channel-map */
114 	struct mutex lock;
115 	int jack_event;
116 };
117 
118 struct hdac_hdmi_dai_port_map {
119 	int dai_id;
120 	struct hdac_hdmi_port *port;
121 	struct hdac_hdmi_cvt *cvt;
122 };
123 
124 /*
125  * pin to port mapping table where the value indicate the pin number and
126  * the index indicate the port number with 1 base.
127  */
128 static const int icl_pin2port_map[] = {0x4, 0x6, 0x8, 0xa, 0xb};
129 
130 struct hdac_hdmi_drv_data {
131 	unsigned int vendor_nid;
132 	const int *port_map; /* pin to port mapping table */
133 	int port_num;
134 };
135 
136 struct hdac_hdmi_priv {
137 	struct hdac_device *hdev;
138 	struct snd_soc_component *component;
139 	struct snd_card *card;
140 	struct hdac_hdmi_dai_port_map dai_map[HDA_MAX_CVTS];
141 	struct list_head pin_list;
142 	struct list_head cvt_list;
143 	struct list_head pcm_list;
144 	int num_pin;
145 	int num_cvt;
146 	int num_ports;
147 	struct mutex pin_mutex;
148 	struct hdac_chmap chmap;
149 	struct hdac_hdmi_drv_data *drv_data;
150 	struct snd_soc_dai_driver *dai_drv;
151 };
152 
153 #define hdev_to_hdmi_priv(_hdev) dev_get_drvdata(&(_hdev)->dev)
154 
155 static struct hdac_hdmi_pcm *
156 hdac_hdmi_get_pcm_from_cvt(struct hdac_hdmi_priv *hdmi,
157 			   struct hdac_hdmi_cvt *cvt)
158 {
159 	struct hdac_hdmi_pcm *pcm = NULL;
160 
161 	list_for_each_entry(pcm, &hdmi->pcm_list, head) {
162 		if (pcm->cvt == cvt)
163 			break;
164 	}
165 
166 	return pcm;
167 }
168 
169 static void hdac_hdmi_jack_report(struct hdac_hdmi_pcm *pcm,
170 		struct hdac_hdmi_port *port, bool is_connect)
171 {
172 	struct hdac_device *hdev = port->pin->hdev;
173 
174 	if (is_connect)
175 		snd_soc_dapm_enable_pin(port->dapm, port->jack_pin);
176 	else
177 		snd_soc_dapm_disable_pin(port->dapm, port->jack_pin);
178 
179 	if (is_connect) {
180 		/*
181 		 * Report Jack connect event when a device is connected
182 		 * for the first time where same PCM is attached to multiple
183 		 * ports.
184 		 */
185 		if (pcm->jack_event == 0) {
186 			dev_dbg(&hdev->dev,
187 					"jack report for pcm=%d\n",
188 					pcm->pcm_id);
189 			snd_soc_jack_report(pcm->jack, SND_JACK_AVOUT,
190 						SND_JACK_AVOUT);
191 		}
192 		pcm->jack_event++;
193 	} else {
194 		/*
195 		 * Report Jack disconnect event when a device is disconnected
196 		 * is the only last connected device when same PCM is attached
197 		 * to multiple ports.
198 		 */
199 		if (pcm->jack_event == 1)
200 			snd_soc_jack_report(pcm->jack, 0, SND_JACK_AVOUT);
201 		if (pcm->jack_event > 0)
202 			pcm->jack_event--;
203 	}
204 
205 	snd_soc_dapm_sync(port->dapm);
206 }
207 
208 /* MST supported verbs */
209 /*
210  * Get the no devices that can be connected to a port on the Pin widget.
211  */
212 static int hdac_hdmi_get_port_len(struct hdac_device *hdev, hda_nid_t nid)
213 {
214 	unsigned int caps;
215 	unsigned int type, param;
216 
217 	caps = get_wcaps(hdev, nid);
218 	type = get_wcaps_type(caps);
219 
220 	if (!(caps & AC_WCAP_DIGITAL) || (type != AC_WID_PIN))
221 		return 0;
222 
223 	param = snd_hdac_read_parm_uncached(hdev, nid, AC_PAR_DEVLIST_LEN);
224 	if (param == -1)
225 		return param;
226 
227 	return param & AC_DEV_LIST_LEN_MASK;
228 }
229 
230 /*
231  * Get the port entry select on the pin. Return the port entry
232  * id selected on the pin. Return 0 means the first port entry
233  * is selected or MST is not supported.
234  */
235 static int hdac_hdmi_port_select_get(struct hdac_device *hdev,
236 					struct hdac_hdmi_port *port)
237 {
238 	return snd_hdac_codec_read(hdev, port->pin->nid,
239 				0, AC_VERB_GET_DEVICE_SEL, 0);
240 }
241 
242 /*
243  * Sets the selected port entry for the configuring Pin widget verb.
244  * returns error if port set is not equal to port get otherwise success
245  */
246 static int hdac_hdmi_port_select_set(struct hdac_device *hdev,
247 					struct hdac_hdmi_port *port)
248 {
249 	int num_ports;
250 
251 	if (!port->pin->mst_capable)
252 		return 0;
253 
254 	/* AC_PAR_DEVLIST_LEN is 0 based. */
255 	num_ports = hdac_hdmi_get_port_len(hdev, port->pin->nid);
256 	if (num_ports < 0)
257 		return -EIO;
258 	/*
259 	 * Device List Length is a 0 based integer value indicating the
260 	 * number of sink device that a MST Pin Widget can support.
261 	 */
262 	if (num_ports + 1  < port->id)
263 		return 0;
264 
265 	snd_hdac_codec_write(hdev, port->pin->nid, 0,
266 			AC_VERB_SET_DEVICE_SEL, port->id);
267 
268 	if (port->id != hdac_hdmi_port_select_get(hdev, port))
269 		return -EIO;
270 
271 	dev_dbg(&hdev->dev, "Selected the port=%d\n", port->id);
272 
273 	return 0;
274 }
275 
276 static struct hdac_hdmi_pcm *get_hdmi_pcm_from_id(struct hdac_hdmi_priv *hdmi,
277 						int pcm_idx)
278 {
279 	struct hdac_hdmi_pcm *pcm;
280 
281 	list_for_each_entry(pcm, &hdmi->pcm_list, head) {
282 		if (pcm->pcm_id == pcm_idx)
283 			return pcm;
284 	}
285 
286 	return NULL;
287 }
288 
289 static unsigned int sad_format(const u8 *sad)
290 {
291 	return ((sad[0] >> 0x3) & 0x1f);
292 }
293 
294 static unsigned int sad_sample_bits_lpcm(const u8 *sad)
295 {
296 	return (sad[2] & 7);
297 }
298 
299 static int hdac_hdmi_eld_limit_formats(struct snd_pcm_runtime *runtime,
300 						void *eld)
301 {
302 	u64 formats = SNDRV_PCM_FMTBIT_S16;
303 	int i;
304 	const u8 *sad, *eld_buf = eld;
305 
306 	sad = drm_eld_sad(eld_buf);
307 	if (!sad)
308 		goto format_constraint;
309 
310 	for (i = drm_eld_sad_count(eld_buf); i > 0; i--, sad += 3) {
311 		if (sad_format(sad) == 1) { /* AUDIO_CODING_TYPE_LPCM */
312 
313 			/*
314 			 * the controller support 20 and 24 bits in 32 bit
315 			 * container so we set S32
316 			 */
317 			if (sad_sample_bits_lpcm(sad) & 0x6)
318 				formats |= SNDRV_PCM_FMTBIT_S32;
319 		}
320 	}
321 
322 format_constraint:
323 	return snd_pcm_hw_constraint_mask64(runtime, SNDRV_PCM_HW_PARAM_FORMAT,
324 				formats);
325 
326 }
327 
328 static void
329 hdac_hdmi_set_dip_index(struct hdac_device *hdev, hda_nid_t pin_nid,
330 				int packet_index, int byte_index)
331 {
332 	int val;
333 
334 	val = (packet_index << 5) | (byte_index & 0x1f);
335 	snd_hdac_codec_write(hdev, pin_nid, 0, AC_VERB_SET_HDMI_DIP_INDEX, val);
336 }
337 
338 struct dp_audio_infoframe {
339 	u8 type; /* 0x84 */
340 	u8 len;  /* 0x1b */
341 	u8 ver;  /* 0x11 << 2 */
342 
343 	u8 CC02_CT47;	/* match with HDMI infoframe from this on */
344 	u8 SS01_SF24;
345 	u8 CXT04;
346 	u8 CA;
347 	u8 LFEPBL01_LSV36_DM_INH7;
348 };
349 
350 static int hdac_hdmi_setup_audio_infoframe(struct hdac_device *hdev,
351 		   struct hdac_hdmi_pcm *pcm, struct hdac_hdmi_port *port)
352 {
353 	uint8_t buffer[HDMI_INFOFRAME_HEADER_SIZE + HDMI_AUDIO_INFOFRAME_SIZE];
354 	struct hdmi_audio_infoframe frame;
355 	struct hdac_hdmi_pin *pin = port->pin;
356 	struct dp_audio_infoframe dp_ai;
357 	struct hdac_hdmi_priv *hdmi = hdev_to_hdmi_priv(hdev);
358 	struct hdac_hdmi_cvt *cvt = pcm->cvt;
359 	u8 *dip;
360 	int ret;
361 	int i;
362 	const u8 *eld_buf;
363 	u8 conn_type;
364 	int channels, ca;
365 
366 	ca = snd_hdac_channel_allocation(hdev, port->eld.info.spk_alloc,
367 			pcm->channels, pcm->chmap_set, true, pcm->chmap);
368 
369 	channels = snd_hdac_get_active_channels(ca);
370 	hdmi->chmap.ops.set_channel_count(hdev, cvt->nid, channels);
371 
372 	snd_hdac_setup_channel_mapping(&hdmi->chmap, pin->nid, false, ca,
373 				pcm->channels, pcm->chmap, pcm->chmap_set);
374 
375 	eld_buf = port->eld.eld_buffer;
376 	conn_type = drm_eld_get_conn_type(eld_buf);
377 
378 	switch (conn_type) {
379 	case DRM_ELD_CONN_TYPE_HDMI:
380 		hdmi_audio_infoframe_init(&frame);
381 
382 		frame.channels = channels;
383 		frame.channel_allocation = ca;
384 
385 		ret = hdmi_audio_infoframe_pack(&frame, buffer, sizeof(buffer));
386 		if (ret < 0)
387 			return ret;
388 
389 		break;
390 
391 	case DRM_ELD_CONN_TYPE_DP:
392 		memset(&dp_ai, 0, sizeof(dp_ai));
393 		dp_ai.type	= 0x84;
394 		dp_ai.len	= 0x1b;
395 		dp_ai.ver	= 0x11 << 2;
396 		dp_ai.CC02_CT47	= channels - 1;
397 		dp_ai.CA	= ca;
398 
399 		dip = (u8 *)&dp_ai;
400 		break;
401 
402 	default:
403 		dev_err(&hdev->dev, "Invalid connection type: %d\n", conn_type);
404 		return -EIO;
405 	}
406 
407 	/* stop infoframe transmission */
408 	hdac_hdmi_set_dip_index(hdev, pin->nid, 0x0, 0x0);
409 	snd_hdac_codec_write(hdev, pin->nid, 0,
410 			AC_VERB_SET_HDMI_DIP_XMIT, AC_DIPXMIT_DISABLE);
411 
412 
413 	/*  Fill infoframe. Index auto-incremented */
414 	hdac_hdmi_set_dip_index(hdev, pin->nid, 0x0, 0x0);
415 	if (conn_type == DRM_ELD_CONN_TYPE_HDMI) {
416 		for (i = 0; i < sizeof(buffer); i++)
417 			snd_hdac_codec_write(hdev, pin->nid, 0,
418 				AC_VERB_SET_HDMI_DIP_DATA, buffer[i]);
419 	} else {
420 		for (i = 0; i < sizeof(dp_ai); i++)
421 			snd_hdac_codec_write(hdev, pin->nid, 0,
422 				AC_VERB_SET_HDMI_DIP_DATA, dip[i]);
423 	}
424 
425 	/* Start infoframe */
426 	hdac_hdmi_set_dip_index(hdev, pin->nid, 0x0, 0x0);
427 	snd_hdac_codec_write(hdev, pin->nid, 0,
428 			AC_VERB_SET_HDMI_DIP_XMIT, AC_DIPXMIT_BEST);
429 
430 	return 0;
431 }
432 
433 static int hdac_hdmi_set_tdm_slot(struct snd_soc_dai *dai,
434 		unsigned int tx_mask, unsigned int rx_mask,
435 		int slots, int slot_width)
436 {
437 	struct hdac_hdmi_priv *hdmi = snd_soc_dai_get_drvdata(dai);
438 	struct hdac_device *hdev = hdmi->hdev;
439 	struct hdac_hdmi_dai_port_map *dai_map;
440 	struct hdac_hdmi_pcm *pcm;
441 
442 	dev_dbg(&hdev->dev, "%s: strm_tag: %d\n", __func__, tx_mask);
443 
444 	dai_map = &hdmi->dai_map[dai->id];
445 
446 	pcm = hdac_hdmi_get_pcm_from_cvt(hdmi, dai_map->cvt);
447 
448 	if (pcm)
449 		pcm->stream_tag = (tx_mask << 4);
450 
451 	return 0;
452 }
453 
454 static int hdac_hdmi_set_hw_params(struct snd_pcm_substream *substream,
455 	struct snd_pcm_hw_params *hparams, struct snd_soc_dai *dai)
456 {
457 	struct hdac_hdmi_priv *hdmi = snd_soc_dai_get_drvdata(dai);
458 	struct hdac_device *hdev = hdmi->hdev;
459 	struct hdac_hdmi_dai_port_map *dai_map;
460 	struct hdac_hdmi_port *port;
461 	struct hdac_hdmi_pcm *pcm;
462 	int format;
463 
464 	dai_map = &hdmi->dai_map[dai->id];
465 	port = dai_map->port;
466 
467 	if (!port)
468 		return -ENODEV;
469 
470 	if ((!port->eld.monitor_present) || (!port->eld.eld_valid)) {
471 		dev_err(&hdev->dev,
472 			"device is not configured for this pin:port%d:%d\n",
473 					port->pin->nid, port->id);
474 		return -ENODEV;
475 	}
476 
477 	format = snd_hdac_calc_stream_format(params_rate(hparams),
478 			params_channels(hparams), params_format(hparams),
479 			dai->driver->playback.sig_bits, 0);
480 
481 	pcm = hdac_hdmi_get_pcm_from_cvt(hdmi, dai_map->cvt);
482 	if (!pcm)
483 		return -EIO;
484 
485 	pcm->format = format;
486 	pcm->channels = params_channels(hparams);
487 
488 	return 0;
489 }
490 
491 static int hdac_hdmi_query_port_connlist(struct hdac_device *hdev,
492 					struct hdac_hdmi_pin *pin,
493 					struct hdac_hdmi_port *port)
494 {
495 	if (!(get_wcaps(hdev, pin->nid) & AC_WCAP_CONN_LIST)) {
496 		dev_warn(&hdev->dev,
497 			"HDMI: pin %d wcaps %#x does not support connection list\n",
498 			pin->nid, get_wcaps(hdev, pin->nid));
499 		return -EINVAL;
500 	}
501 
502 	if (hdac_hdmi_port_select_set(hdev, port) < 0)
503 		return -EIO;
504 
505 	port->num_mux_nids = snd_hdac_get_connections(hdev, pin->nid,
506 			port->mux_nids, HDA_MAX_CONNECTIONS);
507 	if (port->num_mux_nids == 0)
508 		dev_warn(&hdev->dev,
509 			"No connections found for pin:port %d:%d\n",
510 						pin->nid, port->id);
511 
512 	dev_dbg(&hdev->dev, "num_mux_nids %d for pin:port %d:%d\n",
513 			port->num_mux_nids, pin->nid, port->id);
514 
515 	return port->num_mux_nids;
516 }
517 
518 /*
519  * Query pcm list and return port to which stream is routed.
520  *
521  * Also query connection list of the pin, to validate the cvt to port map.
522  *
523  * Same stream rendering to multiple ports simultaneously can be done
524  * possibly, but not supported for now in driver. So return the first port
525  * connected.
526  */
527 static struct hdac_hdmi_port *hdac_hdmi_get_port_from_cvt(
528 			struct hdac_device *hdev,
529 			struct hdac_hdmi_priv *hdmi,
530 			struct hdac_hdmi_cvt *cvt)
531 {
532 	struct hdac_hdmi_pcm *pcm;
533 	struct hdac_hdmi_port *port = NULL;
534 	int ret, i;
535 
536 	list_for_each_entry(pcm, &hdmi->pcm_list, head) {
537 		if (pcm->cvt == cvt) {
538 			if (list_empty(&pcm->port_list))
539 				continue;
540 
541 			list_for_each_entry(port, &pcm->port_list, head) {
542 				mutex_lock(&pcm->lock);
543 				ret = hdac_hdmi_query_port_connlist(hdev,
544 							port->pin, port);
545 				mutex_unlock(&pcm->lock);
546 				if (ret < 0)
547 					continue;
548 
549 				for (i = 0; i < port->num_mux_nids; i++) {
550 					if (port->mux_nids[i] == cvt->nid &&
551 						port->eld.monitor_present &&
552 						port->eld.eld_valid)
553 						return port;
554 				}
555 			}
556 		}
557 	}
558 
559 	return NULL;
560 }
561 
562 /*
563  * This tries to get a valid pin and set the HW constraints based on the
564  * ELD. Even if a valid pin is not found return success so that device open
565  * doesn't fail.
566  */
567 static int hdac_hdmi_pcm_open(struct snd_pcm_substream *substream,
568 			struct snd_soc_dai *dai)
569 {
570 	struct hdac_hdmi_priv *hdmi = snd_soc_dai_get_drvdata(dai);
571 	struct hdac_device *hdev = hdmi->hdev;
572 	struct hdac_hdmi_dai_port_map *dai_map;
573 	struct hdac_hdmi_cvt *cvt;
574 	struct hdac_hdmi_port *port;
575 	int ret;
576 
577 	dai_map = &hdmi->dai_map[dai->id];
578 
579 	cvt = dai_map->cvt;
580 	port = hdac_hdmi_get_port_from_cvt(hdev, hdmi, cvt);
581 
582 	/*
583 	 * To make PA and other userland happy.
584 	 * userland scans devices so returning error does not help.
585 	 */
586 	if (!port)
587 		return 0;
588 	if ((!port->eld.monitor_present) ||
589 			(!port->eld.eld_valid)) {
590 
591 		dev_warn(&hdev->dev,
592 			"Failed: present?:%d ELD valid?:%d pin:port: %d:%d\n",
593 			port->eld.monitor_present, port->eld.eld_valid,
594 			port->pin->nid, port->id);
595 
596 		return 0;
597 	}
598 
599 	dai_map->port = port;
600 
601 	ret = hdac_hdmi_eld_limit_formats(substream->runtime,
602 				port->eld.eld_buffer);
603 	if (ret < 0)
604 		return ret;
605 
606 	return snd_pcm_hw_constraint_eld(substream->runtime,
607 				port->eld.eld_buffer);
608 }
609 
610 static void hdac_hdmi_pcm_close(struct snd_pcm_substream *substream,
611 		struct snd_soc_dai *dai)
612 {
613 	struct hdac_hdmi_priv *hdmi = snd_soc_dai_get_drvdata(dai);
614 	struct hdac_hdmi_dai_port_map *dai_map;
615 	struct hdac_hdmi_pcm *pcm;
616 
617 	dai_map = &hdmi->dai_map[dai->id];
618 
619 	pcm = hdac_hdmi_get_pcm_from_cvt(hdmi, dai_map->cvt);
620 
621 	if (pcm) {
622 		mutex_lock(&pcm->lock);
623 		pcm->chmap_set = false;
624 		memset(pcm->chmap, 0, sizeof(pcm->chmap));
625 		pcm->channels = 0;
626 		mutex_unlock(&pcm->lock);
627 	}
628 
629 	if (dai_map->port)
630 		dai_map->port = NULL;
631 }
632 
633 static int
634 hdac_hdmi_query_cvt_params(struct hdac_device *hdev, struct hdac_hdmi_cvt *cvt)
635 {
636 	unsigned int chans;
637 	struct hdac_hdmi_priv *hdmi = hdev_to_hdmi_priv(hdev);
638 	int err;
639 
640 	chans = get_wcaps(hdev, cvt->nid);
641 	chans = get_wcaps_channels(chans);
642 
643 	cvt->params.channels_min = 2;
644 
645 	cvt->params.channels_max = chans;
646 	if (chans > hdmi->chmap.channels_max)
647 		hdmi->chmap.channels_max = chans;
648 
649 	err = snd_hdac_query_supported_pcm(hdev, cvt->nid,
650 			&cvt->params.rates,
651 			&cvt->params.formats,
652 			&cvt->params.maxbps);
653 	if (err < 0)
654 		dev_err(&hdev->dev,
655 			"Failed to query pcm params for nid %d: %d\n",
656 			cvt->nid, err);
657 
658 	return err;
659 }
660 
661 static int hdac_hdmi_fill_widget_info(struct device *dev,
662 		struct snd_soc_dapm_widget *w, enum snd_soc_dapm_type id,
663 		void *priv, const char *wname, const char *stream,
664 		struct snd_kcontrol_new *wc, int numkc,
665 		int (*event)(struct snd_soc_dapm_widget *,
666 		struct snd_kcontrol *, int), unsigned short event_flags)
667 {
668 	w->id = id;
669 	w->name = devm_kstrdup(dev, wname, GFP_KERNEL);
670 	if (!w->name)
671 		return -ENOMEM;
672 
673 	w->sname = stream;
674 	w->reg = SND_SOC_NOPM;
675 	w->shift = 0;
676 	w->kcontrol_news = wc;
677 	w->num_kcontrols = numkc;
678 	w->priv = priv;
679 	w->event = event;
680 	w->event_flags = event_flags;
681 
682 	return 0;
683 }
684 
685 static void hdac_hdmi_fill_route(struct snd_soc_dapm_route *route,
686 		const char *sink, const char *control, const char *src,
687 		int (*handler)(struct snd_soc_dapm_widget *src,
688 			struct snd_soc_dapm_widget *sink))
689 {
690 	route->sink = sink;
691 	route->source = src;
692 	route->control = control;
693 	route->connected = handler;
694 }
695 
696 static struct hdac_hdmi_pcm *hdac_hdmi_get_pcm(struct hdac_device *hdev,
697 					struct hdac_hdmi_port *port)
698 {
699 	struct hdac_hdmi_priv *hdmi = hdev_to_hdmi_priv(hdev);
700 	struct hdac_hdmi_pcm *pcm = NULL;
701 	struct hdac_hdmi_port *p;
702 
703 	list_for_each_entry(pcm, &hdmi->pcm_list, head) {
704 		if (list_empty(&pcm->port_list))
705 			continue;
706 
707 		list_for_each_entry(p, &pcm->port_list, head) {
708 			if (p->id == port->id && port->pin == p->pin)
709 				return pcm;
710 		}
711 	}
712 
713 	return NULL;
714 }
715 
716 static void hdac_hdmi_set_power_state(struct hdac_device *hdev,
717 			     hda_nid_t nid, unsigned int pwr_state)
718 {
719 	int count;
720 	unsigned int state;
721 
722 	if (get_wcaps(hdev, nid) & AC_WCAP_POWER) {
723 		if (!snd_hdac_check_power_state(hdev, nid, pwr_state)) {
724 			for (count = 0; count < 10; count++) {
725 				snd_hdac_codec_read(hdev, nid, 0,
726 						AC_VERB_SET_POWER_STATE,
727 						pwr_state);
728 				state = snd_hdac_sync_power_state(hdev,
729 						nid, pwr_state);
730 				if (!(state & AC_PWRST_ERROR))
731 					break;
732 			}
733 		}
734 	}
735 }
736 
737 static void hdac_hdmi_set_amp(struct hdac_device *hdev,
738 				   hda_nid_t nid, int val)
739 {
740 	if (get_wcaps(hdev, nid) & AC_WCAP_OUT_AMP)
741 		snd_hdac_codec_write(hdev, nid, 0,
742 					AC_VERB_SET_AMP_GAIN_MUTE, val);
743 }
744 
745 
746 static int hdac_hdmi_pin_output_widget_event(struct snd_soc_dapm_widget *w,
747 					struct snd_kcontrol *kc, int event)
748 {
749 	struct hdac_hdmi_port *port = w->priv;
750 	struct hdac_device *hdev = dev_to_hdac_dev(w->dapm->dev);
751 	struct hdac_hdmi_pcm *pcm;
752 
753 	dev_dbg(&hdev->dev, "%s: widget: %s event: %x\n",
754 			__func__, w->name, event);
755 
756 	pcm = hdac_hdmi_get_pcm(hdev, port);
757 	if (!pcm)
758 		return -EIO;
759 
760 	/* set the device if pin is mst_capable */
761 	if (hdac_hdmi_port_select_set(hdev, port) < 0)
762 		return -EIO;
763 
764 	switch (event) {
765 	case SND_SOC_DAPM_PRE_PMU:
766 		hdac_hdmi_set_power_state(hdev, port->pin->nid, AC_PWRST_D0);
767 
768 		/* Enable out path for this pin widget */
769 		snd_hdac_codec_write(hdev, port->pin->nid, 0,
770 				AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT);
771 
772 		hdac_hdmi_set_amp(hdev, port->pin->nid, AMP_OUT_UNMUTE);
773 
774 		return hdac_hdmi_setup_audio_infoframe(hdev, pcm, port);
775 
776 	case SND_SOC_DAPM_POST_PMD:
777 		hdac_hdmi_set_amp(hdev, port->pin->nid, AMP_OUT_MUTE);
778 
779 		/* Disable out path for this pin widget */
780 		snd_hdac_codec_write(hdev, port->pin->nid, 0,
781 				AC_VERB_SET_PIN_WIDGET_CONTROL, 0);
782 
783 		hdac_hdmi_set_power_state(hdev, port->pin->nid, AC_PWRST_D3);
784 		break;
785 
786 	}
787 
788 	return 0;
789 }
790 
791 static int hdac_hdmi_cvt_output_widget_event(struct snd_soc_dapm_widget *w,
792 					struct snd_kcontrol *kc, int event)
793 {
794 	struct hdac_hdmi_cvt *cvt = w->priv;
795 	struct hdac_device *hdev = dev_to_hdac_dev(w->dapm->dev);
796 	struct hdac_hdmi_priv *hdmi = hdev_to_hdmi_priv(hdev);
797 	struct hdac_hdmi_pcm *pcm;
798 
799 	dev_dbg(&hdev->dev, "%s: widget: %s event: %x\n",
800 			__func__, w->name, event);
801 
802 	pcm = hdac_hdmi_get_pcm_from_cvt(hdmi, cvt);
803 	if (!pcm)
804 		return -EIO;
805 
806 	switch (event) {
807 	case SND_SOC_DAPM_PRE_PMU:
808 		hdac_hdmi_set_power_state(hdev, cvt->nid, AC_PWRST_D0);
809 
810 		/* Enable transmission */
811 		snd_hdac_codec_write(hdev, cvt->nid, 0,
812 			AC_VERB_SET_DIGI_CONVERT_1, 1);
813 
814 		/* Category Code (CC) to zero */
815 		snd_hdac_codec_write(hdev, cvt->nid, 0,
816 			AC_VERB_SET_DIGI_CONVERT_2, 0);
817 
818 		snd_hdac_codec_write(hdev, cvt->nid, 0,
819 				AC_VERB_SET_CHANNEL_STREAMID, pcm->stream_tag);
820 		snd_hdac_codec_write(hdev, cvt->nid, 0,
821 				AC_VERB_SET_STREAM_FORMAT, pcm->format);
822 		break;
823 
824 	case SND_SOC_DAPM_POST_PMD:
825 		snd_hdac_codec_write(hdev, cvt->nid, 0,
826 				AC_VERB_SET_CHANNEL_STREAMID, 0);
827 		snd_hdac_codec_write(hdev, cvt->nid, 0,
828 				AC_VERB_SET_STREAM_FORMAT, 0);
829 
830 		hdac_hdmi_set_power_state(hdev, cvt->nid, AC_PWRST_D3);
831 		break;
832 
833 	}
834 
835 	return 0;
836 }
837 
838 static int hdac_hdmi_pin_mux_widget_event(struct snd_soc_dapm_widget *w,
839 					struct snd_kcontrol *kc, int event)
840 {
841 	struct hdac_hdmi_port *port = w->priv;
842 	struct hdac_device *hdev = dev_to_hdac_dev(w->dapm->dev);
843 	int mux_idx;
844 
845 	dev_dbg(&hdev->dev, "%s: widget: %s event: %x\n",
846 			__func__, w->name, event);
847 
848 	if (!kc)
849 		kc  = w->kcontrols[0];
850 
851 	mux_idx = dapm_kcontrol_get_value(kc);
852 
853 	/* set the device if pin is mst_capable */
854 	if (hdac_hdmi_port_select_set(hdev, port) < 0)
855 		return -EIO;
856 
857 	if (mux_idx > 0) {
858 		snd_hdac_codec_write(hdev, port->pin->nid, 0,
859 			AC_VERB_SET_CONNECT_SEL, (mux_idx - 1));
860 	}
861 
862 	return 0;
863 }
864 
865 /*
866  * Based on user selection, map the PINs with the PCMs.
867  */
868 static int hdac_hdmi_set_pin_port_mux(struct snd_kcontrol *kcontrol,
869 		struct snd_ctl_elem_value *ucontrol)
870 {
871 	int ret;
872 	struct hdac_hdmi_port *p, *p_next;
873 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
874 	struct snd_soc_dapm_widget *w = snd_soc_dapm_kcontrol_widget(kcontrol);
875 	struct snd_soc_dapm_context *dapm = w->dapm;
876 	struct hdac_hdmi_port *port = w->priv;
877 	struct hdac_device *hdev = dev_to_hdac_dev(dapm->dev);
878 	struct hdac_hdmi_priv *hdmi = hdev_to_hdmi_priv(hdev);
879 	struct hdac_hdmi_pcm *pcm = NULL;
880 	const char *cvt_name =  e->texts[ucontrol->value.enumerated.item[0]];
881 
882 	ret = snd_soc_dapm_put_enum_double(kcontrol, ucontrol);
883 	if (ret < 0)
884 		return ret;
885 
886 	if (port == NULL)
887 		return -EINVAL;
888 
889 	mutex_lock(&hdmi->pin_mutex);
890 	list_for_each_entry(pcm, &hdmi->pcm_list, head) {
891 		if (list_empty(&pcm->port_list))
892 			continue;
893 
894 		list_for_each_entry_safe(p, p_next, &pcm->port_list, head) {
895 			if (p == port && p->id == port->id &&
896 					p->pin == port->pin) {
897 				hdac_hdmi_jack_report(pcm, port, false);
898 				list_del(&p->head);
899 			}
900 		}
901 	}
902 
903 	/*
904 	 * Jack status is not reported during device probe as the
905 	 * PCMs are not registered by then. So report it here.
906 	 */
907 	list_for_each_entry(pcm, &hdmi->pcm_list, head) {
908 		if (!strcmp(cvt_name, pcm->cvt->name)) {
909 			list_add_tail(&port->head, &pcm->port_list);
910 			if (port->eld.monitor_present && port->eld.eld_valid) {
911 				hdac_hdmi_jack_report(pcm, port, true);
912 				mutex_unlock(&hdmi->pin_mutex);
913 				return ret;
914 			}
915 		}
916 	}
917 	mutex_unlock(&hdmi->pin_mutex);
918 
919 	return ret;
920 }
921 
922 /*
923  * Ideally the Mux inputs should be based on the num_muxs enumerated, but
924  * the display driver seem to be programming the connection list for the pin
925  * widget runtime.
926  *
927  * So programming all the possible inputs for the mux, the user has to take
928  * care of selecting the right one and leaving all other inputs selected to
929  * "NONE"
930  */
931 static int hdac_hdmi_create_pin_port_muxs(struct hdac_device *hdev,
932 				struct hdac_hdmi_port *port,
933 				struct snd_soc_dapm_widget *widget,
934 				const char *widget_name)
935 {
936 	struct hdac_hdmi_priv *hdmi = hdev_to_hdmi_priv(hdev);
937 	struct hdac_hdmi_pin *pin = port->pin;
938 	struct snd_kcontrol_new *kc;
939 	struct hdac_hdmi_cvt *cvt;
940 	struct soc_enum *se;
941 	char kc_name[NAME_SIZE];
942 	char mux_items[NAME_SIZE];
943 	/* To hold inputs to the Pin mux */
944 	char *items[HDA_MAX_CONNECTIONS];
945 	int i = 0;
946 	int num_items = hdmi->num_cvt + 1;
947 
948 	kc = devm_kzalloc(&hdev->dev, sizeof(*kc), GFP_KERNEL);
949 	if (!kc)
950 		return -ENOMEM;
951 
952 	se = devm_kzalloc(&hdev->dev, sizeof(*se), GFP_KERNEL);
953 	if (!se)
954 		return -ENOMEM;
955 
956 	snprintf(kc_name, NAME_SIZE, "Pin %d port %d Input",
957 						pin->nid, port->id);
958 	kc->name = devm_kstrdup(&hdev->dev, kc_name, GFP_KERNEL);
959 	if (!kc->name)
960 		return -ENOMEM;
961 
962 	kc->private_value = (long)se;
963 	kc->iface = SNDRV_CTL_ELEM_IFACE_MIXER;
964 	kc->access = 0;
965 	kc->info = snd_soc_info_enum_double;
966 	kc->put = hdac_hdmi_set_pin_port_mux;
967 	kc->get = snd_soc_dapm_get_enum_double;
968 
969 	se->reg = SND_SOC_NOPM;
970 
971 	/* enum texts: ["NONE", "cvt #", "cvt #", ...] */
972 	se->items = num_items;
973 	se->mask = roundup_pow_of_two(se->items) - 1;
974 
975 	sprintf(mux_items, "NONE");
976 	items[i] = devm_kstrdup(&hdev->dev, mux_items, GFP_KERNEL);
977 	if (!items[i])
978 		return -ENOMEM;
979 
980 	list_for_each_entry(cvt, &hdmi->cvt_list, head) {
981 		i++;
982 		sprintf(mux_items, "cvt %d", cvt->nid);
983 		items[i] = devm_kstrdup(&hdev->dev, mux_items, GFP_KERNEL);
984 		if (!items[i])
985 			return -ENOMEM;
986 	}
987 
988 	se->texts = devm_kmemdup(&hdev->dev, items,
989 			(num_items  * sizeof(char *)), GFP_KERNEL);
990 	if (!se->texts)
991 		return -ENOMEM;
992 
993 	return hdac_hdmi_fill_widget_info(&hdev->dev, widget,
994 			snd_soc_dapm_mux, port, widget_name, NULL, kc, 1,
995 			hdac_hdmi_pin_mux_widget_event,
996 			SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_REG);
997 }
998 
999 /* Add cvt <- input <- mux route map */
1000 static void hdac_hdmi_add_pinmux_cvt_route(struct hdac_device *hdev,
1001 			struct snd_soc_dapm_widget *widgets,
1002 			struct snd_soc_dapm_route *route, int rindex)
1003 {
1004 	struct hdac_hdmi_priv *hdmi = hdev_to_hdmi_priv(hdev);
1005 	const struct snd_kcontrol_new *kc;
1006 	struct soc_enum *se;
1007 	int mux_index = hdmi->num_cvt + hdmi->num_ports;
1008 	int i, j;
1009 
1010 	for (i = 0; i < hdmi->num_ports; i++) {
1011 		kc = widgets[mux_index].kcontrol_news;
1012 		se = (struct soc_enum *)kc->private_value;
1013 		for (j = 0; j < hdmi->num_cvt; j++) {
1014 			hdac_hdmi_fill_route(&route[rindex],
1015 					widgets[mux_index].name,
1016 					se->texts[j + 1],
1017 					widgets[j].name, NULL);
1018 
1019 			rindex++;
1020 		}
1021 
1022 		mux_index++;
1023 	}
1024 }
1025 
1026 /*
1027  * Widgets are added in the below sequence
1028  *	Converter widgets for num converters enumerated
1029  *	Pin-port widgets for num ports for Pins enumerated
1030  *	Pin-port mux widgets to represent connenction list of pin widget
1031  *
1032  * For each port, one Mux and One output widget is added
1033  * Total widgets elements = num_cvt + (num_ports * 2);
1034  *
1035  * Routes are added as below:
1036  *	pin-port mux -> pin (based on num_ports)
1037  *	cvt -> "Input sel control" -> pin-port_mux
1038  *
1039  * Total route elements:
1040  *	num_ports + (pin_muxes * num_cvt)
1041  */
1042 static int create_fill_widget_route_map(struct snd_soc_dapm_context *dapm)
1043 {
1044 	struct snd_soc_dapm_widget *widgets;
1045 	struct snd_soc_dapm_route *route;
1046 	struct hdac_device *hdev = dev_to_hdac_dev(dapm->dev);
1047 	struct hdac_hdmi_priv *hdmi = hdev_to_hdmi_priv(hdev);
1048 	struct snd_soc_dai_driver *dai_drv = hdmi->dai_drv;
1049 	char widget_name[NAME_SIZE];
1050 	struct hdac_hdmi_cvt *cvt;
1051 	struct hdac_hdmi_pin *pin;
1052 	int ret, i = 0, num_routes = 0, j;
1053 
1054 	if (list_empty(&hdmi->cvt_list) || list_empty(&hdmi->pin_list))
1055 		return -EINVAL;
1056 
1057 	widgets = devm_kzalloc(dapm->dev, (sizeof(*widgets) *
1058 				((2 * hdmi->num_ports) + hdmi->num_cvt)),
1059 				GFP_KERNEL);
1060 
1061 	if (!widgets)
1062 		return -ENOMEM;
1063 
1064 	/* DAPM widgets to represent each converter widget */
1065 	list_for_each_entry(cvt, &hdmi->cvt_list, head) {
1066 		sprintf(widget_name, "Converter %d", cvt->nid);
1067 		ret = hdac_hdmi_fill_widget_info(dapm->dev, &widgets[i],
1068 			snd_soc_dapm_aif_in, cvt,
1069 			widget_name, dai_drv[i].playback.stream_name, NULL, 0,
1070 			hdac_hdmi_cvt_output_widget_event,
1071 			SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD);
1072 		if (ret < 0)
1073 			return ret;
1074 		i++;
1075 	}
1076 
1077 	list_for_each_entry(pin, &hdmi->pin_list, head) {
1078 		for (j = 0; j < pin->num_ports; j++) {
1079 			sprintf(widget_name, "hif%d-%d Output",
1080 				pin->nid, pin->ports[j].id);
1081 			ret = hdac_hdmi_fill_widget_info(dapm->dev, &widgets[i],
1082 					snd_soc_dapm_output, &pin->ports[j],
1083 					widget_name, NULL, NULL, 0,
1084 					hdac_hdmi_pin_output_widget_event,
1085 					SND_SOC_DAPM_PRE_PMU |
1086 					SND_SOC_DAPM_POST_PMD);
1087 			if (ret < 0)
1088 				return ret;
1089 			pin->ports[j].output_pin = widgets[i].name;
1090 			i++;
1091 		}
1092 	}
1093 
1094 	/* DAPM widgets to represent the connection list to pin widget */
1095 	list_for_each_entry(pin, &hdmi->pin_list, head) {
1096 		for (j = 0; j < pin->num_ports; j++) {
1097 			sprintf(widget_name, "Pin%d-Port%d Mux",
1098 				pin->nid, pin->ports[j].id);
1099 			ret = hdac_hdmi_create_pin_port_muxs(hdev,
1100 						&pin->ports[j], &widgets[i],
1101 						widget_name);
1102 			if (ret < 0)
1103 				return ret;
1104 			i++;
1105 
1106 			/* For cvt to pin_mux mapping */
1107 			num_routes += hdmi->num_cvt;
1108 
1109 			/* For pin_mux to pin mapping */
1110 			num_routes++;
1111 		}
1112 	}
1113 
1114 	route = devm_kzalloc(dapm->dev, (sizeof(*route) * num_routes),
1115 							GFP_KERNEL);
1116 	if (!route)
1117 		return -ENOMEM;
1118 
1119 	i = 0;
1120 	/* Add pin <- NULL <- mux route map */
1121 	list_for_each_entry(pin, &hdmi->pin_list, head) {
1122 		for (j = 0; j < pin->num_ports; j++) {
1123 			int sink_index = i + hdmi->num_cvt;
1124 			int src_index = sink_index + pin->num_ports *
1125 						hdmi->num_pin;
1126 
1127 			hdac_hdmi_fill_route(&route[i],
1128 				widgets[sink_index].name, NULL,
1129 				widgets[src_index].name, NULL);
1130 			i++;
1131 		}
1132 	}
1133 
1134 	hdac_hdmi_add_pinmux_cvt_route(hdev, widgets, route, i);
1135 
1136 	snd_soc_dapm_new_controls(dapm, widgets,
1137 		((2 * hdmi->num_ports) + hdmi->num_cvt));
1138 
1139 	snd_soc_dapm_add_routes(dapm, route, num_routes);
1140 	snd_soc_dapm_new_widgets(dapm->card);
1141 
1142 	return 0;
1143 
1144 }
1145 
1146 static int hdac_hdmi_init_dai_map(struct hdac_device *hdev)
1147 {
1148 	struct hdac_hdmi_priv *hdmi = hdev_to_hdmi_priv(hdev);
1149 	struct hdac_hdmi_dai_port_map *dai_map;
1150 	struct hdac_hdmi_cvt *cvt;
1151 	int dai_id = 0;
1152 
1153 	if (list_empty(&hdmi->cvt_list))
1154 		return -EINVAL;
1155 
1156 	list_for_each_entry(cvt, &hdmi->cvt_list, head) {
1157 		dai_map = &hdmi->dai_map[dai_id];
1158 		dai_map->dai_id = dai_id;
1159 		dai_map->cvt = cvt;
1160 
1161 		dai_id++;
1162 
1163 		if (dai_id == HDA_MAX_CVTS) {
1164 			dev_warn(&hdev->dev,
1165 				"Max dais supported: %d\n", dai_id);
1166 			break;
1167 		}
1168 	}
1169 
1170 	return 0;
1171 }
1172 
1173 static int hdac_hdmi_add_cvt(struct hdac_device *hdev, hda_nid_t nid)
1174 {
1175 	struct hdac_hdmi_priv *hdmi = hdev_to_hdmi_priv(hdev);
1176 	struct hdac_hdmi_cvt *cvt;
1177 	char name[NAME_SIZE];
1178 
1179 	cvt = devm_kzalloc(&hdev->dev, sizeof(*cvt), GFP_KERNEL);
1180 	if (!cvt)
1181 		return -ENOMEM;
1182 
1183 	cvt->nid = nid;
1184 	sprintf(name, "cvt %d", cvt->nid);
1185 	cvt->name = devm_kstrdup(&hdev->dev, name, GFP_KERNEL);
1186 	if (!cvt->name)
1187 		return -ENOMEM;
1188 
1189 	list_add_tail(&cvt->head, &hdmi->cvt_list);
1190 	hdmi->num_cvt++;
1191 
1192 	return hdac_hdmi_query_cvt_params(hdev, cvt);
1193 }
1194 
1195 static int hdac_hdmi_parse_eld(struct hdac_device *hdev,
1196 			struct hdac_hdmi_port *port)
1197 {
1198 	unsigned int ver, mnl;
1199 
1200 	ver = (port->eld.eld_buffer[DRM_ELD_VER] & DRM_ELD_VER_MASK)
1201 						>> DRM_ELD_VER_SHIFT;
1202 
1203 	if (ver != ELD_VER_CEA_861D && ver != ELD_VER_PARTIAL) {
1204 		dev_err(&hdev->dev, "HDMI: Unknown ELD version %d\n", ver);
1205 		return -EINVAL;
1206 	}
1207 
1208 	mnl = (port->eld.eld_buffer[DRM_ELD_CEA_EDID_VER_MNL] &
1209 		DRM_ELD_MNL_MASK) >> DRM_ELD_MNL_SHIFT;
1210 
1211 	if (mnl > ELD_MAX_MNL) {
1212 		dev_err(&hdev->dev, "HDMI: MNL Invalid %d\n", mnl);
1213 		return -EINVAL;
1214 	}
1215 
1216 	port->eld.info.spk_alloc = port->eld.eld_buffer[DRM_ELD_SPEAKER];
1217 
1218 	return 0;
1219 }
1220 
1221 static void hdac_hdmi_present_sense(struct hdac_hdmi_pin *pin,
1222 				    struct hdac_hdmi_port *port)
1223 {
1224 	struct hdac_device *hdev = pin->hdev;
1225 	struct hdac_hdmi_priv *hdmi = hdev_to_hdmi_priv(hdev);
1226 	struct hdac_hdmi_pcm *pcm;
1227 	int size = 0;
1228 	int port_id = -1;
1229 
1230 	if (!hdmi)
1231 		return;
1232 
1233 	/*
1234 	 * In case of non MST pin, get_eld info API expectes port
1235 	 * to be -1.
1236 	 */
1237 	mutex_lock(&hdmi->pin_mutex);
1238 	port->eld.monitor_present = false;
1239 
1240 	if (pin->mst_capable)
1241 		port_id = port->id;
1242 
1243 	size = snd_hdac_acomp_get_eld(hdev, pin->nid, port_id,
1244 				&port->eld.monitor_present,
1245 				port->eld.eld_buffer,
1246 				ELD_MAX_SIZE);
1247 
1248 	if (size > 0) {
1249 		size = min(size, ELD_MAX_SIZE);
1250 		if (hdac_hdmi_parse_eld(hdev, port) < 0)
1251 			size = -EINVAL;
1252 	}
1253 
1254 	if (size > 0) {
1255 		port->eld.eld_valid = true;
1256 		port->eld.eld_size = size;
1257 	} else {
1258 		port->eld.eld_valid = false;
1259 		port->eld.eld_size = 0;
1260 	}
1261 
1262 	pcm = hdac_hdmi_get_pcm(hdev, port);
1263 
1264 	if (!port->eld.monitor_present || !port->eld.eld_valid) {
1265 
1266 		dev_err(&hdev->dev, "%s: disconnect for pin:port %d:%d\n",
1267 						__func__, pin->nid, port->id);
1268 
1269 		/*
1270 		 * PCMs are not registered during device probe, so don't
1271 		 * report jack here. It will be done in usermode mux
1272 		 * control select.
1273 		 */
1274 		if (pcm)
1275 			hdac_hdmi_jack_report(pcm, port, false);
1276 
1277 		mutex_unlock(&hdmi->pin_mutex);
1278 		return;
1279 	}
1280 
1281 	if (port->eld.monitor_present && port->eld.eld_valid) {
1282 		if (pcm)
1283 			hdac_hdmi_jack_report(pcm, port, true);
1284 
1285 		print_hex_dump_debug("ELD: ", DUMP_PREFIX_OFFSET, 16, 1,
1286 			  port->eld.eld_buffer, port->eld.eld_size, false);
1287 
1288 	}
1289 	mutex_unlock(&hdmi->pin_mutex);
1290 }
1291 
1292 static int hdac_hdmi_add_ports(struct hdac_device *hdev,
1293 			       struct hdac_hdmi_pin *pin)
1294 {
1295 	struct hdac_hdmi_port *ports;
1296 	int max_ports = HDA_MAX_PORTS;
1297 	int i;
1298 
1299 	/*
1300 	 * FIXME: max_port may vary for each platform, so pass this as
1301 	 * as driver data or query from i915 interface when this API is
1302 	 * implemented.
1303 	 */
1304 
1305 	ports = devm_kcalloc(&hdev->dev, max_ports, sizeof(*ports), GFP_KERNEL);
1306 	if (!ports)
1307 		return -ENOMEM;
1308 
1309 	for (i = 0; i < max_ports; i++) {
1310 		ports[i].id = i;
1311 		ports[i].pin = pin;
1312 	}
1313 	pin->ports = ports;
1314 	pin->num_ports = max_ports;
1315 	return 0;
1316 }
1317 
1318 static int hdac_hdmi_add_pin(struct hdac_device *hdev, hda_nid_t nid)
1319 {
1320 	struct hdac_hdmi_priv *hdmi = hdev_to_hdmi_priv(hdev);
1321 	struct hdac_hdmi_pin *pin;
1322 	int ret;
1323 
1324 	pin = devm_kzalloc(&hdev->dev, sizeof(*pin), GFP_KERNEL);
1325 	if (!pin)
1326 		return -ENOMEM;
1327 
1328 	pin->nid = nid;
1329 	pin->mst_capable = false;
1330 	pin->hdev = hdev;
1331 	ret = hdac_hdmi_add_ports(hdev, pin);
1332 	if (ret < 0)
1333 		return ret;
1334 
1335 	list_add_tail(&pin->head, &hdmi->pin_list);
1336 	hdmi->num_pin++;
1337 	hdmi->num_ports += pin->num_ports;
1338 
1339 	return 0;
1340 }
1341 
1342 #define INTEL_VENDOR_NID_0x2 0x02
1343 #define INTEL_VENDOR_NID_0x8 0x08
1344 #define INTEL_VENDOR_NID_0xb 0x0b
1345 #define INTEL_GET_VENDOR_VERB 0xf81
1346 #define INTEL_SET_VENDOR_VERB 0x781
1347 #define INTEL_EN_DP12		0x02 /* enable DP 1.2 features */
1348 #define INTEL_EN_ALL_PIN_CVTS	0x01 /* enable 2nd & 3rd pins and convertors */
1349 
1350 static void hdac_hdmi_skl_enable_all_pins(struct hdac_device *hdev)
1351 {
1352 	unsigned int vendor_param;
1353 	struct hdac_hdmi_priv *hdmi = hdev_to_hdmi_priv(hdev);
1354 	unsigned int vendor_nid = hdmi->drv_data->vendor_nid;
1355 
1356 	vendor_param = snd_hdac_codec_read(hdev, vendor_nid, 0,
1357 				INTEL_GET_VENDOR_VERB, 0);
1358 	if (vendor_param == -1 || vendor_param & INTEL_EN_ALL_PIN_CVTS)
1359 		return;
1360 
1361 	vendor_param |= INTEL_EN_ALL_PIN_CVTS;
1362 	vendor_param = snd_hdac_codec_read(hdev, vendor_nid, 0,
1363 				INTEL_SET_VENDOR_VERB, vendor_param);
1364 	if (vendor_param == -1)
1365 		return;
1366 }
1367 
1368 static void hdac_hdmi_skl_enable_dp12(struct hdac_device *hdev)
1369 {
1370 	unsigned int vendor_param;
1371 	struct hdac_hdmi_priv *hdmi = hdev_to_hdmi_priv(hdev);
1372 	unsigned int vendor_nid = hdmi->drv_data->vendor_nid;
1373 
1374 	vendor_param = snd_hdac_codec_read(hdev, vendor_nid, 0,
1375 				INTEL_GET_VENDOR_VERB, 0);
1376 	if (vendor_param == -1 || vendor_param & INTEL_EN_DP12)
1377 		return;
1378 
1379 	/* enable DP1.2 mode */
1380 	vendor_param |= INTEL_EN_DP12;
1381 	vendor_param = snd_hdac_codec_read(hdev, vendor_nid, 0,
1382 				INTEL_SET_VENDOR_VERB, vendor_param);
1383 	if (vendor_param == -1)
1384 		return;
1385 
1386 }
1387 
1388 static const struct snd_soc_dai_ops hdmi_dai_ops = {
1389 	.startup = hdac_hdmi_pcm_open,
1390 	.shutdown = hdac_hdmi_pcm_close,
1391 	.hw_params = hdac_hdmi_set_hw_params,
1392 	.set_tdm_slot = hdac_hdmi_set_tdm_slot,
1393 };
1394 
1395 /*
1396  * Each converter can support a stream independently. So a dai is created
1397  * based on the number of converter queried.
1398  */
1399 static int hdac_hdmi_create_dais(struct hdac_device *hdev,
1400 		struct snd_soc_dai_driver **dais,
1401 		struct hdac_hdmi_priv *hdmi, int num_dais)
1402 {
1403 	struct snd_soc_dai_driver *hdmi_dais;
1404 	struct hdac_hdmi_cvt *cvt;
1405 	char name[NAME_SIZE], dai_name[NAME_SIZE];
1406 	int i = 0;
1407 	u32 rates, bps;
1408 	unsigned int rate_max = 384000, rate_min = 8000;
1409 	u64 formats;
1410 	int ret;
1411 
1412 	hdmi_dais = devm_kzalloc(&hdev->dev,
1413 			(sizeof(*hdmi_dais) * num_dais),
1414 			GFP_KERNEL);
1415 	if (!hdmi_dais)
1416 		return -ENOMEM;
1417 
1418 	list_for_each_entry(cvt, &hdmi->cvt_list, head) {
1419 		ret = snd_hdac_query_supported_pcm(hdev, cvt->nid,
1420 					&rates,	&formats, &bps);
1421 		if (ret)
1422 			return ret;
1423 
1424 		/* Filter out 44.1, 88.2 and 176.4Khz */
1425 		rates &= ~(SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_88200 |
1426 			   SNDRV_PCM_RATE_176400);
1427 		if (!rates)
1428 			return -EINVAL;
1429 
1430 		sprintf(dai_name, "intel-hdmi-hifi%d", i+1);
1431 		hdmi_dais[i].name = devm_kstrdup(&hdev->dev,
1432 					dai_name, GFP_KERNEL);
1433 
1434 		if (!hdmi_dais[i].name)
1435 			return -ENOMEM;
1436 
1437 		snprintf(name, sizeof(name), "hifi%d", i+1);
1438 		hdmi_dais[i].playback.stream_name =
1439 				devm_kstrdup(&hdev->dev, name, GFP_KERNEL);
1440 		if (!hdmi_dais[i].playback.stream_name)
1441 			return -ENOMEM;
1442 
1443 		/*
1444 		 * Set caps based on capability queried from the converter.
1445 		 * It will be constrained runtime based on ELD queried.
1446 		 */
1447 		hdmi_dais[i].playback.formats = formats;
1448 		hdmi_dais[i].playback.rates = rates;
1449 		hdmi_dais[i].playback.rate_max = rate_max;
1450 		hdmi_dais[i].playback.rate_min = rate_min;
1451 		hdmi_dais[i].playback.channels_min = 2;
1452 		hdmi_dais[i].playback.channels_max = 2;
1453 		hdmi_dais[i].playback.sig_bits = bps;
1454 		hdmi_dais[i].ops = &hdmi_dai_ops;
1455 		i++;
1456 	}
1457 
1458 	*dais = hdmi_dais;
1459 	hdmi->dai_drv = hdmi_dais;
1460 
1461 	return 0;
1462 }
1463 
1464 /*
1465  * Parse all nodes and store the cvt/pin nids in array
1466  * Add one time initialization for pin and cvt widgets
1467  */
1468 static int hdac_hdmi_parse_and_map_nid(struct hdac_device *hdev,
1469 		struct snd_soc_dai_driver **dais, int *num_dais)
1470 {
1471 	hda_nid_t nid;
1472 	int i, num_nodes;
1473 	struct hdac_hdmi_priv *hdmi = hdev_to_hdmi_priv(hdev);
1474 	int ret;
1475 
1476 	hdac_hdmi_skl_enable_all_pins(hdev);
1477 	hdac_hdmi_skl_enable_dp12(hdev);
1478 
1479 	num_nodes = snd_hdac_get_sub_nodes(hdev, hdev->afg, &nid);
1480 	if (!nid || num_nodes <= 0) {
1481 		dev_warn(&hdev->dev, "HDMI: failed to get afg sub nodes\n");
1482 		return -EINVAL;
1483 	}
1484 
1485 	for (i = 0; i < num_nodes; i++, nid++) {
1486 		unsigned int caps;
1487 		unsigned int type;
1488 
1489 		caps = get_wcaps(hdev, nid);
1490 		type = get_wcaps_type(caps);
1491 
1492 		if (!(caps & AC_WCAP_DIGITAL))
1493 			continue;
1494 
1495 		switch (type) {
1496 
1497 		case AC_WID_AUD_OUT:
1498 			ret = hdac_hdmi_add_cvt(hdev, nid);
1499 			if (ret < 0)
1500 				return ret;
1501 			break;
1502 
1503 		case AC_WID_PIN:
1504 			ret = hdac_hdmi_add_pin(hdev, nid);
1505 			if (ret < 0)
1506 				return ret;
1507 			break;
1508 		}
1509 	}
1510 
1511 	if (!hdmi->num_pin || !hdmi->num_cvt) {
1512 		ret = -EIO;
1513 		dev_err(&hdev->dev, "Bad pin/cvt setup in %s\n", __func__);
1514 		return ret;
1515 	}
1516 
1517 	ret = hdac_hdmi_create_dais(hdev, dais, hdmi, hdmi->num_cvt);
1518 	if (ret) {
1519 		dev_err(&hdev->dev, "Failed to create dais with err: %d\n",
1520 			ret);
1521 		return ret;
1522 	}
1523 
1524 	*num_dais = hdmi->num_cvt;
1525 	ret = hdac_hdmi_init_dai_map(hdev);
1526 	if (ret < 0)
1527 		dev_err(&hdev->dev, "Failed to init DAI map with err: %d\n",
1528 			ret);
1529 	return ret;
1530 }
1531 
1532 static int hdac_hdmi_pin2port(void *aptr, int pin)
1533 {
1534 	struct hdac_device *hdev = aptr;
1535 	struct hdac_hdmi_priv *hdmi = hdev_to_hdmi_priv(hdev);
1536 	const int *map = hdmi->drv_data->port_map;
1537 	int i;
1538 
1539 	if (!hdmi->drv_data->port_num)
1540 		return pin - 4; /* map NID 0x05 -> port #1 */
1541 
1542 	/*
1543 	 * looking for the pin number in the mapping table and return
1544 	 * the index which indicate the port number
1545 	 */
1546 	for (i = 0; i < hdmi->drv_data->port_num; i++) {
1547 		if (pin == map[i])
1548 			return i + 1;
1549 	}
1550 
1551 	/* return -1 if pin number exceeds our expectation */
1552 	dev_err(&hdev->dev, "Can't find the port for pin %d\n", pin);
1553 	return -1;
1554 }
1555 
1556 static void hdac_hdmi_eld_notify_cb(void *aptr, int port, int pipe)
1557 {
1558 	struct hdac_device *hdev = aptr;
1559 	struct hdac_hdmi_priv *hdmi = hdev_to_hdmi_priv(hdev);
1560 	struct hdac_hdmi_pin *pin = NULL;
1561 	struct hdac_hdmi_port *hport = NULL;
1562 	struct snd_soc_component *component = hdmi->component;
1563 	int i;
1564 	hda_nid_t pin_nid;
1565 
1566 	if (!hdmi->drv_data->port_num) {
1567 		/* for legacy platforms */
1568 		pin_nid = port + 0x04;
1569 	} else if (port < hdmi->drv_data->port_num) {
1570 		/* get pin number from the pin2port mapping table */
1571 		pin_nid = hdmi->drv_data->port_map[port - 1];
1572 	} else {
1573 		dev_err(&hdev->dev, "Can't find the pin for port %d\n", port);
1574 		return;
1575 	}
1576 
1577 	dev_dbg(&hdev->dev, "%s: for pin:%d port=%d\n", __func__,
1578 							pin_nid, pipe);
1579 
1580 	/*
1581 	 * skip notification during system suspend (but not in runtime PM);
1582 	 * the state will be updated at resume. Also since the ELD and
1583 	 * connection states are updated in anyway at the end of the resume,
1584 	 * we can skip it when received during PM process.
1585 	 */
1586 	if (snd_power_get_state(component->card->snd_card) !=
1587 			SNDRV_CTL_POWER_D0)
1588 		return;
1589 
1590 	if (atomic_read(&hdev->in_pm))
1591 		return;
1592 
1593 	list_for_each_entry(pin, &hdmi->pin_list, head) {
1594 		if (pin->nid != pin_nid)
1595 			continue;
1596 
1597 		/* In case of non MST pin, pipe is -1 */
1598 		if (pipe == -1) {
1599 			pin->mst_capable = false;
1600 			/* if not MST, default is port[0] */
1601 			hport = &pin->ports[0];
1602 		} else {
1603 			for (i = 0; i < pin->num_ports; i++) {
1604 				pin->mst_capable = true;
1605 				if (pin->ports[i].id == pipe) {
1606 					hport = &pin->ports[i];
1607 					break;
1608 				}
1609 			}
1610 		}
1611 
1612 		if (hport)
1613 			hdac_hdmi_present_sense(pin, hport);
1614 	}
1615 
1616 }
1617 
1618 static struct drm_audio_component_audio_ops aops = {
1619 	.pin2port	= hdac_hdmi_pin2port,
1620 	.pin_eld_notify	= hdac_hdmi_eld_notify_cb,
1621 };
1622 
1623 static struct snd_pcm *hdac_hdmi_get_pcm_from_id(struct snd_soc_card *card,
1624 						int device)
1625 {
1626 	struct snd_soc_pcm_runtime *rtd;
1627 
1628 	for_each_card_rtds(card, rtd) {
1629 		if (rtd->pcm && (rtd->pcm->device == device))
1630 			return rtd->pcm;
1631 	}
1632 
1633 	return NULL;
1634 }
1635 
1636 /* create jack pin kcontrols */
1637 static int create_fill_jack_kcontrols(struct snd_soc_card *card,
1638 				    struct hdac_device *hdev)
1639 {
1640 	struct hdac_hdmi_pin *pin;
1641 	struct snd_kcontrol_new *kc;
1642 	char kc_name[NAME_SIZE], xname[NAME_SIZE];
1643 	char *name;
1644 	int i = 0, j;
1645 	struct hdac_hdmi_priv *hdmi = hdev_to_hdmi_priv(hdev);
1646 	struct snd_soc_component *component = hdmi->component;
1647 
1648 	kc = devm_kcalloc(component->dev, hdmi->num_ports,
1649 				sizeof(*kc), GFP_KERNEL);
1650 
1651 	if (!kc)
1652 		return -ENOMEM;
1653 
1654 	list_for_each_entry(pin, &hdmi->pin_list, head) {
1655 		for (j = 0; j < pin->num_ports; j++) {
1656 			snprintf(xname, sizeof(xname), "hif%d-%d Jack",
1657 						pin->nid, pin->ports[j].id);
1658 			name = devm_kstrdup(component->dev, xname, GFP_KERNEL);
1659 			if (!name)
1660 				return -ENOMEM;
1661 			snprintf(kc_name, sizeof(kc_name), "%s Switch", xname);
1662 			kc[i].name = devm_kstrdup(component->dev, kc_name,
1663 							GFP_KERNEL);
1664 			if (!kc[i].name)
1665 				return -ENOMEM;
1666 
1667 			kc[i].private_value = (unsigned long)name;
1668 			kc[i].iface = SNDRV_CTL_ELEM_IFACE_MIXER;
1669 			kc[i].access = 0;
1670 			kc[i].info = snd_soc_dapm_info_pin_switch;
1671 			kc[i].put = snd_soc_dapm_put_pin_switch;
1672 			kc[i].get = snd_soc_dapm_get_pin_switch;
1673 			i++;
1674 		}
1675 	}
1676 
1677 	return snd_soc_add_card_controls(card, kc, i);
1678 }
1679 
1680 int hdac_hdmi_jack_port_init(struct snd_soc_component *component,
1681 			struct snd_soc_dapm_context *dapm)
1682 {
1683 	struct hdac_hdmi_priv *hdmi = snd_soc_component_get_drvdata(component);
1684 	struct hdac_device *hdev = hdmi->hdev;
1685 	struct hdac_hdmi_pin *pin;
1686 	struct snd_soc_dapm_widget *widgets;
1687 	struct snd_soc_dapm_route *route;
1688 	char w_name[NAME_SIZE];
1689 	int i = 0, j, ret;
1690 
1691 	widgets = devm_kcalloc(dapm->dev, hdmi->num_ports,
1692 				sizeof(*widgets), GFP_KERNEL);
1693 
1694 	if (!widgets)
1695 		return -ENOMEM;
1696 
1697 	route = devm_kcalloc(dapm->dev, hdmi->num_ports,
1698 				sizeof(*route), GFP_KERNEL);
1699 	if (!route)
1700 		return -ENOMEM;
1701 
1702 	/* create Jack DAPM widget */
1703 	list_for_each_entry(pin, &hdmi->pin_list, head) {
1704 		for (j = 0; j < pin->num_ports; j++) {
1705 			snprintf(w_name, sizeof(w_name), "hif%d-%d Jack",
1706 						pin->nid, pin->ports[j].id);
1707 
1708 			ret = hdac_hdmi_fill_widget_info(dapm->dev, &widgets[i],
1709 					snd_soc_dapm_spk, NULL,
1710 					w_name, NULL, NULL, 0, NULL, 0);
1711 			if (ret < 0)
1712 				return ret;
1713 
1714 			pin->ports[j].jack_pin = widgets[i].name;
1715 			pin->ports[j].dapm = dapm;
1716 
1717 			/* add to route from Jack widget to output */
1718 			hdac_hdmi_fill_route(&route[i], pin->ports[j].jack_pin,
1719 					NULL, pin->ports[j].output_pin, NULL);
1720 
1721 			i++;
1722 		}
1723 	}
1724 
1725 	/* Add Route from Jack widget to the output widget */
1726 	ret = snd_soc_dapm_new_controls(dapm, widgets, hdmi->num_ports);
1727 	if (ret < 0)
1728 		return ret;
1729 
1730 	ret = snd_soc_dapm_add_routes(dapm, route, hdmi->num_ports);
1731 	if (ret < 0)
1732 		return ret;
1733 
1734 	ret = snd_soc_dapm_new_widgets(dapm->card);
1735 	if (ret < 0)
1736 		return ret;
1737 
1738 	/* Add Jack Pin switch Kcontrol */
1739 	ret = create_fill_jack_kcontrols(dapm->card, hdev);
1740 
1741 	if (ret < 0)
1742 		return ret;
1743 
1744 	/* default set the Jack Pin switch to OFF */
1745 	list_for_each_entry(pin, &hdmi->pin_list, head) {
1746 		for (j = 0; j < pin->num_ports; j++)
1747 			snd_soc_dapm_disable_pin(pin->ports[j].dapm,
1748 						pin->ports[j].jack_pin);
1749 	}
1750 
1751 	return 0;
1752 }
1753 EXPORT_SYMBOL_GPL(hdac_hdmi_jack_port_init);
1754 
1755 int hdac_hdmi_jack_init(struct snd_soc_dai *dai, int device,
1756 				struct snd_soc_jack *jack)
1757 {
1758 	struct snd_soc_component *component = dai->component;
1759 	struct hdac_hdmi_priv *hdmi = snd_soc_component_get_drvdata(component);
1760 	struct hdac_device *hdev = hdmi->hdev;
1761 	struct hdac_hdmi_pcm *pcm;
1762 	struct snd_pcm *snd_pcm;
1763 	int err;
1764 
1765 	/*
1766 	 * this is a new PCM device, create new pcm and
1767 	 * add to the pcm list
1768 	 */
1769 	pcm = devm_kzalloc(&hdev->dev, sizeof(*pcm), GFP_KERNEL);
1770 	if (!pcm)
1771 		return -ENOMEM;
1772 	pcm->pcm_id = device;
1773 	pcm->cvt = hdmi->dai_map[dai->id].cvt;
1774 	pcm->jack_event = 0;
1775 	pcm->jack = jack;
1776 	mutex_init(&pcm->lock);
1777 	INIT_LIST_HEAD(&pcm->port_list);
1778 	snd_pcm = hdac_hdmi_get_pcm_from_id(dai->component->card, device);
1779 	if (snd_pcm) {
1780 		err = snd_hdac_add_chmap_ctls(snd_pcm, device, &hdmi->chmap);
1781 		if (err < 0) {
1782 			dev_err(&hdev->dev,
1783 				"chmap control add failed with err: %d for pcm: %d\n",
1784 				err, device);
1785 			return err;
1786 		}
1787 	}
1788 
1789 	list_add_tail(&pcm->head, &hdmi->pcm_list);
1790 
1791 	return 0;
1792 }
1793 EXPORT_SYMBOL_GPL(hdac_hdmi_jack_init);
1794 
1795 static void hdac_hdmi_present_sense_all_pins(struct hdac_device *hdev,
1796 			struct hdac_hdmi_priv *hdmi, bool detect_pin_caps)
1797 {
1798 	int i;
1799 	struct hdac_hdmi_pin *pin;
1800 
1801 	list_for_each_entry(pin, &hdmi->pin_list, head) {
1802 		if (detect_pin_caps) {
1803 
1804 			if (hdac_hdmi_get_port_len(hdev, pin->nid)  == 0)
1805 				pin->mst_capable = false;
1806 			else
1807 				pin->mst_capable = true;
1808 		}
1809 
1810 		for (i = 0; i < pin->num_ports; i++) {
1811 			if (!pin->mst_capable && i > 0)
1812 				continue;
1813 
1814 			hdac_hdmi_present_sense(pin, &pin->ports[i]);
1815 		}
1816 	}
1817 }
1818 
1819 static int hdmi_codec_probe(struct snd_soc_component *component)
1820 {
1821 	struct hdac_hdmi_priv *hdmi = snd_soc_component_get_drvdata(component);
1822 	struct hdac_device *hdev = hdmi->hdev;
1823 	struct snd_soc_dapm_context *dapm =
1824 		snd_soc_component_get_dapm(component);
1825 	struct hdac_ext_link *hlink = NULL;
1826 	int ret;
1827 
1828 	hdmi->component = component;
1829 
1830 	/*
1831 	 * hold the ref while we probe, also no need to drop the ref on
1832 	 * exit, we call pm_runtime_suspend() so that will do for us
1833 	 */
1834 	hlink = snd_hdac_ext_bus_get_link(hdev->bus, dev_name(&hdev->dev));
1835 	if (!hlink) {
1836 		dev_err(&hdev->dev, "hdac link not found\n");
1837 		return -EIO;
1838 	}
1839 
1840 	snd_hdac_ext_bus_link_get(hdev->bus, hlink);
1841 
1842 	ret = create_fill_widget_route_map(dapm);
1843 	if (ret < 0)
1844 		return ret;
1845 
1846 	aops.audio_ptr = hdev;
1847 	ret = snd_hdac_acomp_register_notifier(hdev->bus, &aops);
1848 	if (ret < 0) {
1849 		dev_err(&hdev->dev, "notifier register failed: err: %d\n", ret);
1850 		return ret;
1851 	}
1852 
1853 	hdac_hdmi_present_sense_all_pins(hdev, hdmi, true);
1854 	/* Imp: Store the card pointer in hda_codec */
1855 	hdmi->card = dapm->card->snd_card;
1856 
1857 	/*
1858 	 * hdac_device core already sets the state to active and calls
1859 	 * get_noresume. So enable runtime and set the device to suspend.
1860 	 */
1861 	pm_runtime_enable(&hdev->dev);
1862 	pm_runtime_put(&hdev->dev);
1863 	pm_runtime_suspend(&hdev->dev);
1864 
1865 	return 0;
1866 }
1867 
1868 static void hdmi_codec_remove(struct snd_soc_component *component)
1869 {
1870 	struct hdac_hdmi_priv *hdmi = snd_soc_component_get_drvdata(component);
1871 	struct hdac_device *hdev = hdmi->hdev;
1872 
1873 	pm_runtime_disable(&hdev->dev);
1874 }
1875 
1876 #ifdef CONFIG_PM_SLEEP
1877 static int hdmi_codec_resume(struct device *dev)
1878 {
1879 	struct hdac_device *hdev = dev_to_hdac_dev(dev);
1880 	struct hdac_hdmi_priv *hdmi = hdev_to_hdmi_priv(hdev);
1881 	int ret;
1882 
1883 	ret = pm_runtime_force_resume(dev);
1884 	if (ret < 0)
1885 		return ret;
1886 	/*
1887 	 * As the ELD notify callback request is not entertained while the
1888 	 * device is in suspend state. Need to manually check detection of
1889 	 * all pins here. pin capablity change is not support, so use the
1890 	 * already set pin caps.
1891 	 *
1892 	 * NOTE: this is safe to call even if the codec doesn't actually resume.
1893 	 * The pin check involves only with DRM audio component hooks, so it
1894 	 * works even if the HD-audio side is still dreaming peacefully.
1895 	 */
1896 	hdac_hdmi_present_sense_all_pins(hdev, hdmi, false);
1897 	return 0;
1898 }
1899 #else
1900 #define hdmi_codec_resume NULL
1901 #endif
1902 
1903 static const struct snd_soc_component_driver hdmi_hda_codec = {
1904 	.probe			= hdmi_codec_probe,
1905 	.remove			= hdmi_codec_remove,
1906 	.use_pmdown_time	= 1,
1907 	.endianness		= 1,
1908 	.non_legacy_dai_naming	= 1,
1909 };
1910 
1911 static void hdac_hdmi_get_chmap(struct hdac_device *hdev, int pcm_idx,
1912 					unsigned char *chmap)
1913 {
1914 	struct hdac_hdmi_priv *hdmi = hdev_to_hdmi_priv(hdev);
1915 	struct hdac_hdmi_pcm *pcm = get_hdmi_pcm_from_id(hdmi, pcm_idx);
1916 
1917 	memcpy(chmap, pcm->chmap, ARRAY_SIZE(pcm->chmap));
1918 }
1919 
1920 static void hdac_hdmi_set_chmap(struct hdac_device *hdev, int pcm_idx,
1921 				unsigned char *chmap, int prepared)
1922 {
1923 	struct hdac_hdmi_priv *hdmi = hdev_to_hdmi_priv(hdev);
1924 	struct hdac_hdmi_pcm *pcm = get_hdmi_pcm_from_id(hdmi, pcm_idx);
1925 	struct hdac_hdmi_port *port;
1926 
1927 	if (!pcm)
1928 		return;
1929 
1930 	if (list_empty(&pcm->port_list))
1931 		return;
1932 
1933 	mutex_lock(&pcm->lock);
1934 	pcm->chmap_set = true;
1935 	memcpy(pcm->chmap, chmap, ARRAY_SIZE(pcm->chmap));
1936 	list_for_each_entry(port, &pcm->port_list, head)
1937 		if (prepared)
1938 			hdac_hdmi_setup_audio_infoframe(hdev, pcm, port);
1939 	mutex_unlock(&pcm->lock);
1940 }
1941 
1942 static bool is_hdac_hdmi_pcm_attached(struct hdac_device *hdev, int pcm_idx)
1943 {
1944 	struct hdac_hdmi_priv *hdmi = hdev_to_hdmi_priv(hdev);
1945 	struct hdac_hdmi_pcm *pcm = get_hdmi_pcm_from_id(hdmi, pcm_idx);
1946 
1947 	if (!pcm)
1948 		return false;
1949 
1950 	if (list_empty(&pcm->port_list))
1951 		return false;
1952 
1953 	return true;
1954 }
1955 
1956 static int hdac_hdmi_get_spk_alloc(struct hdac_device *hdev, int pcm_idx)
1957 {
1958 	struct hdac_hdmi_priv *hdmi = hdev_to_hdmi_priv(hdev);
1959 	struct hdac_hdmi_pcm *pcm = get_hdmi_pcm_from_id(hdmi, pcm_idx);
1960 	struct hdac_hdmi_port *port;
1961 
1962 	if (!pcm)
1963 		return 0;
1964 
1965 	if (list_empty(&pcm->port_list))
1966 		return 0;
1967 
1968 	port = list_first_entry(&pcm->port_list, struct hdac_hdmi_port, head);
1969 
1970 	if (!port || !port->eld.eld_valid)
1971 		return 0;
1972 
1973 	return port->eld.info.spk_alloc;
1974 }
1975 
1976 static struct hdac_hdmi_drv_data intel_icl_drv_data  = {
1977 	.vendor_nid = INTEL_VENDOR_NID_0x2,
1978 	.port_map = icl_pin2port_map,
1979 	.port_num = ARRAY_SIZE(icl_pin2port_map),
1980 };
1981 
1982 static struct hdac_hdmi_drv_data intel_glk_drv_data  = {
1983 	.vendor_nid = INTEL_VENDOR_NID_0xb,
1984 };
1985 
1986 static struct hdac_hdmi_drv_data intel_drv_data  = {
1987 	.vendor_nid = INTEL_VENDOR_NID_0x8,
1988 };
1989 
1990 static int hdac_hdmi_dev_probe(struct hdac_device *hdev)
1991 {
1992 	struct hdac_hdmi_priv *hdmi_priv = NULL;
1993 	struct snd_soc_dai_driver *hdmi_dais = NULL;
1994 	struct hdac_ext_link *hlink = NULL;
1995 	int num_dais = 0;
1996 	int ret = 0;
1997 	struct hdac_driver *hdrv = drv_to_hdac_driver(hdev->dev.driver);
1998 	const struct hda_device_id *hdac_id = hdac_get_device_id(hdev, hdrv);
1999 
2000 	/* hold the ref while we probe */
2001 	hlink = snd_hdac_ext_bus_get_link(hdev->bus, dev_name(&hdev->dev));
2002 	if (!hlink) {
2003 		dev_err(&hdev->dev, "hdac link not found\n");
2004 		return -EIO;
2005 	}
2006 
2007 	snd_hdac_ext_bus_link_get(hdev->bus, hlink);
2008 
2009 	hdmi_priv = devm_kzalloc(&hdev->dev, sizeof(*hdmi_priv), GFP_KERNEL);
2010 	if (hdmi_priv == NULL)
2011 		return -ENOMEM;
2012 
2013 	snd_hdac_register_chmap_ops(hdev, &hdmi_priv->chmap);
2014 	hdmi_priv->chmap.ops.get_chmap = hdac_hdmi_get_chmap;
2015 	hdmi_priv->chmap.ops.set_chmap = hdac_hdmi_set_chmap;
2016 	hdmi_priv->chmap.ops.is_pcm_attached = is_hdac_hdmi_pcm_attached;
2017 	hdmi_priv->chmap.ops.get_spk_alloc = hdac_hdmi_get_spk_alloc;
2018 	hdmi_priv->hdev = hdev;
2019 
2020 	if (!hdac_id)
2021 		return -ENODEV;
2022 
2023 	if (hdac_id->driver_data)
2024 		hdmi_priv->drv_data =
2025 			(struct hdac_hdmi_drv_data *)hdac_id->driver_data;
2026 	else
2027 		hdmi_priv->drv_data = &intel_drv_data;
2028 
2029 	dev_set_drvdata(&hdev->dev, hdmi_priv);
2030 
2031 	INIT_LIST_HEAD(&hdmi_priv->pin_list);
2032 	INIT_LIST_HEAD(&hdmi_priv->cvt_list);
2033 	INIT_LIST_HEAD(&hdmi_priv->pcm_list);
2034 	mutex_init(&hdmi_priv->pin_mutex);
2035 
2036 	/*
2037 	 * Turned off in the runtime_suspend during the first explicit
2038 	 * pm_runtime_suspend call.
2039 	 */
2040 	snd_hdac_display_power(hdev->bus, hdev->addr, true);
2041 
2042 	ret = hdac_hdmi_parse_and_map_nid(hdev, &hdmi_dais, &num_dais);
2043 	if (ret < 0) {
2044 		dev_err(&hdev->dev,
2045 			"Failed in parse and map nid with err: %d\n", ret);
2046 		return ret;
2047 	}
2048 	snd_hdac_refresh_widgets(hdev, true);
2049 
2050 	/* ASoC specific initialization */
2051 	ret = devm_snd_soc_register_component(&hdev->dev, &hdmi_hda_codec,
2052 					hdmi_dais, num_dais);
2053 
2054 	snd_hdac_ext_bus_link_put(hdev->bus, hlink);
2055 
2056 	return ret;
2057 }
2058 
2059 static int hdac_hdmi_dev_remove(struct hdac_device *hdev)
2060 {
2061 	snd_hdac_display_power(hdev->bus, hdev->addr, false);
2062 
2063 	return 0;
2064 }
2065 
2066 #ifdef CONFIG_PM
2067 static int hdac_hdmi_runtime_suspend(struct device *dev)
2068 {
2069 	struct hdac_device *hdev = dev_to_hdac_dev(dev);
2070 	struct hdac_bus *bus = hdev->bus;
2071 	struct hdac_ext_link *hlink = NULL;
2072 
2073 	dev_dbg(dev, "Enter: %s\n", __func__);
2074 
2075 	/* controller may not have been initialized for the first time */
2076 	if (!bus)
2077 		return 0;
2078 
2079 	/*
2080 	 * Power down afg.
2081 	 * codec_read is preferred over codec_write to set the power state.
2082 	 * This way verb is send to set the power state and response
2083 	 * is received. So setting power state is ensured without using loop
2084 	 * to read the state.
2085 	 */
2086 	snd_hdac_codec_read(hdev, hdev->afg, 0,	AC_VERB_SET_POWER_STATE,
2087 							AC_PWRST_D3);
2088 
2089 	hlink = snd_hdac_ext_bus_get_link(bus, dev_name(dev));
2090 	if (!hlink) {
2091 		dev_err(dev, "hdac link not found\n");
2092 		return -EIO;
2093 	}
2094 
2095 	snd_hdac_ext_bus_link_put(bus, hlink);
2096 
2097 	snd_hdac_display_power(bus, hdev->addr, false);
2098 
2099 	return 0;
2100 }
2101 
2102 static int hdac_hdmi_runtime_resume(struct device *dev)
2103 {
2104 	struct hdac_device *hdev = dev_to_hdac_dev(dev);
2105 	struct hdac_bus *bus = hdev->bus;
2106 	struct hdac_ext_link *hlink = NULL;
2107 
2108 	dev_dbg(dev, "Enter: %s\n", __func__);
2109 
2110 	/* controller may not have been initialized for the first time */
2111 	if (!bus)
2112 		return 0;
2113 
2114 	hlink = snd_hdac_ext_bus_get_link(bus, dev_name(dev));
2115 	if (!hlink) {
2116 		dev_err(dev, "hdac link not found\n");
2117 		return -EIO;
2118 	}
2119 
2120 	snd_hdac_ext_bus_link_get(bus, hlink);
2121 
2122 	snd_hdac_display_power(bus, hdev->addr, true);
2123 
2124 	hdac_hdmi_skl_enable_all_pins(hdev);
2125 	hdac_hdmi_skl_enable_dp12(hdev);
2126 
2127 	/* Power up afg */
2128 	snd_hdac_codec_read(hdev, hdev->afg, 0,	AC_VERB_SET_POWER_STATE,
2129 							AC_PWRST_D0);
2130 
2131 	return 0;
2132 }
2133 #else
2134 #define hdac_hdmi_runtime_suspend NULL
2135 #define hdac_hdmi_runtime_resume NULL
2136 #endif
2137 
2138 static const struct dev_pm_ops hdac_hdmi_pm = {
2139 	SET_RUNTIME_PM_OPS(hdac_hdmi_runtime_suspend, hdac_hdmi_runtime_resume, NULL)
2140 	SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend, hdmi_codec_resume)
2141 };
2142 
2143 static const struct hda_device_id hdmi_list[] = {
2144 	HDA_CODEC_EXT_ENTRY(0x80862809, 0x100000, "Skylake HDMI", 0),
2145 	HDA_CODEC_EXT_ENTRY(0x8086280a, 0x100000, "Broxton HDMI", 0),
2146 	HDA_CODEC_EXT_ENTRY(0x8086280b, 0x100000, "Kabylake HDMI", 0),
2147 	HDA_CODEC_EXT_ENTRY(0x8086280c, 0x100000, "Cannonlake HDMI",
2148 						   &intel_glk_drv_data),
2149 	HDA_CODEC_EXT_ENTRY(0x8086280d, 0x100000, "Geminilake HDMI",
2150 						   &intel_glk_drv_data),
2151 	HDA_CODEC_EXT_ENTRY(0x8086280f, 0x100000, "Icelake HDMI",
2152 						   &intel_icl_drv_data),
2153 	{}
2154 };
2155 
2156 MODULE_DEVICE_TABLE(hdaudio, hdmi_list);
2157 
2158 static struct hdac_driver hdmi_driver = {
2159 	.driver = {
2160 		.name   = "HDMI HDA Codec",
2161 		.pm = &hdac_hdmi_pm,
2162 	},
2163 	.id_table       = hdmi_list,
2164 	.probe          = hdac_hdmi_dev_probe,
2165 	.remove         = hdac_hdmi_dev_remove,
2166 };
2167 
2168 static int __init hdmi_init(void)
2169 {
2170 	return snd_hda_ext_driver_register(&hdmi_driver);
2171 }
2172 
2173 static void __exit hdmi_exit(void)
2174 {
2175 	snd_hda_ext_driver_unregister(&hdmi_driver);
2176 }
2177 
2178 module_init(hdmi_init);
2179 module_exit(hdmi_exit);
2180 
2181 MODULE_LICENSE("GPL v2");
2182 MODULE_DESCRIPTION("HDMI HD codec");
2183 MODULE_AUTHOR("Samreen Nilofer<samreen.nilofer@intel.com>");
2184 MODULE_AUTHOR("Subhransu S. Prusty<subhransu.s.prusty@intel.com>");
2185