Merge tag 'asoc-v5.3' of https://git.kernel.org/pub/scm/linux/kernel/git/broonie...
[linux-2.6-block.git] / sound / pci / hda / patch_hdmi.c
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  *
4  *  patch_hdmi.c - routines for HDMI/DisplayPort codecs
5  *
6  *  Copyright(c) 2008-2010 Intel Corporation. All rights reserved.
7  *  Copyright (c) 2006 ATI Technologies Inc.
8  *  Copyright (c) 2008 NVIDIA Corp.  All rights reserved.
9  *  Copyright (c) 2008 Wei Ni <wni@nvidia.com>
10  *  Copyright (c) 2013 Anssi Hannula <anssi.hannula@iki.fi>
11  *
12  *  Authors:
13  *                      Wu Fengguang <wfg@linux.intel.com>
14  *
15  *  Maintained by:
16  *                      Wu Fengguang <wfg@linux.intel.com>
17  */
18
19 #include <linux/init.h>
20 #include <linux/delay.h>
21 #include <linux/slab.h>
22 #include <linux/module.h>
23 #include <linux/pm_runtime.h>
24 #include <sound/core.h>
25 #include <sound/jack.h>
26 #include <sound/asoundef.h>
27 #include <sound/tlv.h>
28 #include <sound/hdaudio.h>
29 #include <sound/hda_i915.h>
30 #include <sound/hda_chmap.h>
31 #include <sound/hda_codec.h>
32 #include "hda_local.h"
33 #include "hda_jack.h"
34
35 static bool static_hdmi_pcm;
36 module_param(static_hdmi_pcm, bool, 0644);
37 MODULE_PARM_DESC(static_hdmi_pcm, "Don't restrict PCM parameters per ELD info");
38
39 #define is_haswell(codec)  ((codec)->core.vendor_id == 0x80862807)
40 #define is_broadwell(codec)    ((codec)->core.vendor_id == 0x80862808)
41 #define is_skylake(codec) ((codec)->core.vendor_id == 0x80862809)
42 #define is_broxton(codec) ((codec)->core.vendor_id == 0x8086280a)
43 #define is_kabylake(codec) ((codec)->core.vendor_id == 0x8086280b)
44 #define is_geminilake(codec) (((codec)->core.vendor_id == 0x8086280d) || \
45                                 ((codec)->core.vendor_id == 0x80862800))
46 #define is_cannonlake(codec) ((codec)->core.vendor_id == 0x8086280c)
47 #define is_icelake(codec) ((codec)->core.vendor_id == 0x8086280f)
48 #define is_haswell_plus(codec) (is_haswell(codec) || is_broadwell(codec) \
49                                 || is_skylake(codec) || is_broxton(codec) \
50                                 || is_kabylake(codec) || is_geminilake(codec) \
51                                 || is_cannonlake(codec) || is_icelake(codec))
52 #define is_valleyview(codec) ((codec)->core.vendor_id == 0x80862882)
53 #define is_cherryview(codec) ((codec)->core.vendor_id == 0x80862883)
54 #define is_valleyview_plus(codec) (is_valleyview(codec) || is_cherryview(codec))
55
56 struct hdmi_spec_per_cvt {
57         hda_nid_t cvt_nid;
58         int assigned;
59         unsigned int channels_min;
60         unsigned int channels_max;
61         u32 rates;
62         u64 formats;
63         unsigned int maxbps;
64 };
65
66 /* max. connections to a widget */
67 #define HDA_MAX_CONNECTIONS     32
68
69 struct hdmi_spec_per_pin {
70         hda_nid_t pin_nid;
71         int dev_id;
72         /* pin idx, different device entries on the same pin use the same idx */
73         int pin_nid_idx;
74         int num_mux_nids;
75         hda_nid_t mux_nids[HDA_MAX_CONNECTIONS];
76         int mux_idx;
77         hda_nid_t cvt_nid;
78
79         struct hda_codec *codec;
80         struct hdmi_eld sink_eld;
81         struct mutex lock;
82         struct delayed_work work;
83         struct hdmi_pcm *pcm; /* pointer to spec->pcm_rec[n] dynamically*/
84         int pcm_idx; /* which pcm is attached. -1 means no pcm is attached */
85         int repoll_count;
86         bool setup; /* the stream has been set up by prepare callback */
87         int channels; /* current number of channels */
88         bool non_pcm;
89         bool chmap_set;         /* channel-map override by ALSA API? */
90         unsigned char chmap[8]; /* ALSA API channel-map */
91 #ifdef CONFIG_SND_PROC_FS
92         struct snd_info_entry *proc_entry;
93 #endif
94 };
95
96 /* operations used by generic code that can be overridden by patches */
97 struct hdmi_ops {
98         int (*pin_get_eld)(struct hda_codec *codec, hda_nid_t pin_nid,
99                            unsigned char *buf, int *eld_size);
100
101         void (*pin_setup_infoframe)(struct hda_codec *codec, hda_nid_t pin_nid,
102                                     int ca, int active_channels, int conn_type);
103
104         /* enable/disable HBR (HD passthrough) */
105         int (*pin_hbr_setup)(struct hda_codec *codec, hda_nid_t pin_nid, bool hbr);
106
107         int (*setup_stream)(struct hda_codec *codec, hda_nid_t cvt_nid,
108                             hda_nid_t pin_nid, u32 stream_tag, int format);
109
110         void (*pin_cvt_fixup)(struct hda_codec *codec,
111                               struct hdmi_spec_per_pin *per_pin,
112                               hda_nid_t cvt_nid);
113 };
114
115 struct hdmi_pcm {
116         struct hda_pcm *pcm;
117         struct snd_jack *jack;
118         struct snd_kcontrol *eld_ctl;
119 };
120
121 struct hdmi_spec {
122         int num_cvts;
123         struct snd_array cvts; /* struct hdmi_spec_per_cvt */
124         hda_nid_t cvt_nids[4]; /* only for haswell fix */
125
126         /*
127          * num_pins is the number of virtual pins
128          * for example, there are 3 pins, and each pin
129          * has 4 device entries, then the num_pins is 12
130          */
131         int num_pins;
132         /*
133          * num_nids is the number of real pins
134          * In the above example, num_nids is 3
135          */
136         int num_nids;
137         /*
138          * dev_num is the number of device entries
139          * on each pin.
140          * In the above example, dev_num is 4
141          */
142         int dev_num;
143         struct snd_array pins; /* struct hdmi_spec_per_pin */
144         struct hdmi_pcm pcm_rec[16];
145         struct mutex pcm_lock;
146         /* pcm_bitmap means which pcms have been assigned to pins*/
147         unsigned long pcm_bitmap;
148         int pcm_used;   /* counter of pcm_rec[] */
149         /* bitmap shows whether the pcm is opened in user space
150          * bit 0 means the first playback PCM (PCM3);
151          * bit 1 means the second playback PCM, and so on.
152          */
153         unsigned long pcm_in_use;
154
155         struct hdmi_eld temp_eld;
156         struct hdmi_ops ops;
157
158         bool dyn_pin_out;
159         bool dyn_pcm_assign;
160         /*
161          * Non-generic VIA/NVIDIA specific
162          */
163         struct hda_multi_out multiout;
164         struct hda_pcm_stream pcm_playback;
165
166         /* i915/powerwell (Haswell+/Valleyview+) specific */
167         bool use_acomp_notifier; /* use i915 eld_notify callback for hotplug */
168         struct drm_audio_component_audio_ops drm_audio_ops;
169
170         struct hdac_chmap chmap;
171         hda_nid_t vendor_nid;
172         const int *port_map;
173         int port_num;
174 };
175
176 #ifdef CONFIG_SND_HDA_COMPONENT
177 static inline bool codec_has_acomp(struct hda_codec *codec)
178 {
179         struct hdmi_spec *spec = codec->spec;
180         return spec->use_acomp_notifier;
181 }
182 #else
183 #define codec_has_acomp(codec)  false
184 #endif
185
186 struct hdmi_audio_infoframe {
187         u8 type; /* 0x84 */
188         u8 ver;  /* 0x01 */
189         u8 len;  /* 0x0a */
190
191         u8 checksum;
192
193         u8 CC02_CT47;   /* CC in bits 0:2, CT in 4:7 */
194         u8 SS01_SF24;
195         u8 CXT04;
196         u8 CA;
197         u8 LFEPBL01_LSV36_DM_INH7;
198 };
199
200 struct dp_audio_infoframe {
201         u8 type; /* 0x84 */
202         u8 len;  /* 0x1b */
203         u8 ver;  /* 0x11 << 2 */
204
205         u8 CC02_CT47;   /* match with HDMI infoframe from this on */
206         u8 SS01_SF24;
207         u8 CXT04;
208         u8 CA;
209         u8 LFEPBL01_LSV36_DM_INH7;
210 };
211
212 union audio_infoframe {
213         struct hdmi_audio_infoframe hdmi;
214         struct dp_audio_infoframe dp;
215         u8 bytes[0];
216 };
217
218 /*
219  * HDMI routines
220  */
221
222 #define get_pin(spec, idx) \
223         ((struct hdmi_spec_per_pin *)snd_array_elem(&spec->pins, idx))
224 #define get_cvt(spec, idx) \
225         ((struct hdmi_spec_per_cvt  *)snd_array_elem(&spec->cvts, idx))
226 /* obtain hdmi_pcm object assigned to idx */
227 #define get_hdmi_pcm(spec, idx) (&(spec)->pcm_rec[idx])
228 /* obtain hda_pcm object assigned to idx */
229 #define get_pcm_rec(spec, idx)  (get_hdmi_pcm(spec, idx)->pcm)
230
231 static int pin_id_to_pin_index(struct hda_codec *codec,
232                                hda_nid_t pin_nid, int dev_id)
233 {
234         struct hdmi_spec *spec = codec->spec;
235         int pin_idx;
236         struct hdmi_spec_per_pin *per_pin;
237
238         /*
239          * (dev_id == -1) means it is NON-MST pin
240          * return the first virtual pin on this port
241          */
242         if (dev_id == -1)
243                 dev_id = 0;
244
245         for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
246                 per_pin = get_pin(spec, pin_idx);
247                 if ((per_pin->pin_nid == pin_nid) &&
248                         (per_pin->dev_id == dev_id))
249                         return pin_idx;
250         }
251
252         codec_warn(codec, "HDMI: pin nid %d not registered\n", pin_nid);
253         return -EINVAL;
254 }
255
256 static int hinfo_to_pcm_index(struct hda_codec *codec,
257                         struct hda_pcm_stream *hinfo)
258 {
259         struct hdmi_spec *spec = codec->spec;
260         int pcm_idx;
261
262         for (pcm_idx = 0; pcm_idx < spec->pcm_used; pcm_idx++)
263                 if (get_pcm_rec(spec, pcm_idx)->stream == hinfo)
264                         return pcm_idx;
265
266         codec_warn(codec, "HDMI: hinfo %p not registered\n", hinfo);
267         return -EINVAL;
268 }
269
270 static int hinfo_to_pin_index(struct hda_codec *codec,
271                               struct hda_pcm_stream *hinfo)
272 {
273         struct hdmi_spec *spec = codec->spec;
274         struct hdmi_spec_per_pin *per_pin;
275         int pin_idx;
276
277         for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
278                 per_pin = get_pin(spec, pin_idx);
279                 if (per_pin->pcm &&
280                         per_pin->pcm->pcm->stream == hinfo)
281                         return pin_idx;
282         }
283
284         codec_dbg(codec, "HDMI: hinfo %p not registered\n", hinfo);
285         return -EINVAL;
286 }
287
288 static struct hdmi_spec_per_pin *pcm_idx_to_pin(struct hdmi_spec *spec,
289                                                 int pcm_idx)
290 {
291         int i;
292         struct hdmi_spec_per_pin *per_pin;
293
294         for (i = 0; i < spec->num_pins; i++) {
295                 per_pin = get_pin(spec, i);
296                 if (per_pin->pcm_idx == pcm_idx)
297                         return per_pin;
298         }
299         return NULL;
300 }
301
302 static int cvt_nid_to_cvt_index(struct hda_codec *codec, hda_nid_t cvt_nid)
303 {
304         struct hdmi_spec *spec = codec->spec;
305         int cvt_idx;
306
307         for (cvt_idx = 0; cvt_idx < spec->num_cvts; cvt_idx++)
308                 if (get_cvt(spec, cvt_idx)->cvt_nid == cvt_nid)
309                         return cvt_idx;
310
311         codec_warn(codec, "HDMI: cvt nid %d not registered\n", cvt_nid);
312         return -EINVAL;
313 }
314
315 static int hdmi_eld_ctl_info(struct snd_kcontrol *kcontrol,
316                         struct snd_ctl_elem_info *uinfo)
317 {
318         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
319         struct hdmi_spec *spec = codec->spec;
320         struct hdmi_spec_per_pin *per_pin;
321         struct hdmi_eld *eld;
322         int pcm_idx;
323
324         uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES;
325
326         pcm_idx = kcontrol->private_value;
327         mutex_lock(&spec->pcm_lock);
328         per_pin = pcm_idx_to_pin(spec, pcm_idx);
329         if (!per_pin) {
330                 /* no pin is bound to the pcm */
331                 uinfo->count = 0;
332                 goto unlock;
333         }
334         eld = &per_pin->sink_eld;
335         uinfo->count = eld->eld_valid ? eld->eld_size : 0;
336
337  unlock:
338         mutex_unlock(&spec->pcm_lock);
339         return 0;
340 }
341
342 static int hdmi_eld_ctl_get(struct snd_kcontrol *kcontrol,
343                         struct snd_ctl_elem_value *ucontrol)
344 {
345         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
346         struct hdmi_spec *spec = codec->spec;
347         struct hdmi_spec_per_pin *per_pin;
348         struct hdmi_eld *eld;
349         int pcm_idx;
350         int err = 0;
351
352         pcm_idx = kcontrol->private_value;
353         mutex_lock(&spec->pcm_lock);
354         per_pin = pcm_idx_to_pin(spec, pcm_idx);
355         if (!per_pin) {
356                 /* no pin is bound to the pcm */
357                 memset(ucontrol->value.bytes.data, 0,
358                        ARRAY_SIZE(ucontrol->value.bytes.data));
359                 goto unlock;
360         }
361
362         eld = &per_pin->sink_eld;
363         if (eld->eld_size > ARRAY_SIZE(ucontrol->value.bytes.data) ||
364             eld->eld_size > ELD_MAX_SIZE) {
365                 snd_BUG();
366                 err = -EINVAL;
367                 goto unlock;
368         }
369
370         memset(ucontrol->value.bytes.data, 0,
371                ARRAY_SIZE(ucontrol->value.bytes.data));
372         if (eld->eld_valid)
373                 memcpy(ucontrol->value.bytes.data, eld->eld_buffer,
374                        eld->eld_size);
375
376  unlock:
377         mutex_unlock(&spec->pcm_lock);
378         return err;
379 }
380
381 static const struct snd_kcontrol_new eld_bytes_ctl = {
382         .access = SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_VOLATILE,
383         .iface = SNDRV_CTL_ELEM_IFACE_PCM,
384         .name = "ELD",
385         .info = hdmi_eld_ctl_info,
386         .get = hdmi_eld_ctl_get,
387 };
388
389 static int hdmi_create_eld_ctl(struct hda_codec *codec, int pcm_idx,
390                         int device)
391 {
392         struct snd_kcontrol *kctl;
393         struct hdmi_spec *spec = codec->spec;
394         int err;
395
396         kctl = snd_ctl_new1(&eld_bytes_ctl, codec);
397         if (!kctl)
398                 return -ENOMEM;
399         kctl->private_value = pcm_idx;
400         kctl->id.device = device;
401
402         /* no pin nid is associated with the kctl now
403          * tbd: associate pin nid to eld ctl later
404          */
405         err = snd_hda_ctl_add(codec, 0, kctl);
406         if (err < 0)
407                 return err;
408
409         get_hdmi_pcm(spec, pcm_idx)->eld_ctl = kctl;
410         return 0;
411 }
412
413 #ifdef BE_PARANOID
414 static void hdmi_get_dip_index(struct hda_codec *codec, hda_nid_t pin_nid,
415                                 int *packet_index, int *byte_index)
416 {
417         int val;
418
419         val = snd_hda_codec_read(codec, pin_nid, 0,
420                                  AC_VERB_GET_HDMI_DIP_INDEX, 0);
421
422         *packet_index = val >> 5;
423         *byte_index = val & 0x1f;
424 }
425 #endif
426
427 static void hdmi_set_dip_index(struct hda_codec *codec, hda_nid_t pin_nid,
428                                 int packet_index, int byte_index)
429 {
430         int val;
431
432         val = (packet_index << 5) | (byte_index & 0x1f);
433
434         snd_hda_codec_write(codec, pin_nid, 0, AC_VERB_SET_HDMI_DIP_INDEX, val);
435 }
436
437 static void hdmi_write_dip_byte(struct hda_codec *codec, hda_nid_t pin_nid,
438                                 unsigned char val)
439 {
440         snd_hda_codec_write(codec, pin_nid, 0, AC_VERB_SET_HDMI_DIP_DATA, val);
441 }
442
443 static void hdmi_init_pin(struct hda_codec *codec, hda_nid_t pin_nid)
444 {
445         struct hdmi_spec *spec = codec->spec;
446         int pin_out;
447
448         /* Unmute */
449         if (get_wcaps(codec, pin_nid) & AC_WCAP_OUT_AMP)
450                 snd_hda_codec_write(codec, pin_nid, 0,
451                                 AC_VERB_SET_AMP_GAIN_MUTE, AMP_OUT_UNMUTE);
452
453         if (spec->dyn_pin_out)
454                 /* Disable pin out until stream is active */
455                 pin_out = 0;
456         else
457                 /* Enable pin out: some machines with GM965 gets broken output
458                  * when the pin is disabled or changed while using with HDMI
459                  */
460                 pin_out = PIN_OUT;
461
462         snd_hda_codec_write(codec, pin_nid, 0,
463                             AC_VERB_SET_PIN_WIDGET_CONTROL, pin_out);
464 }
465
466 /*
467  * ELD proc files
468  */
469
470 #ifdef CONFIG_SND_PROC_FS
471 static void print_eld_info(struct snd_info_entry *entry,
472                            struct snd_info_buffer *buffer)
473 {
474         struct hdmi_spec_per_pin *per_pin = entry->private_data;
475
476         mutex_lock(&per_pin->lock);
477         snd_hdmi_print_eld_info(&per_pin->sink_eld, buffer);
478         mutex_unlock(&per_pin->lock);
479 }
480
481 static void write_eld_info(struct snd_info_entry *entry,
482                            struct snd_info_buffer *buffer)
483 {
484         struct hdmi_spec_per_pin *per_pin = entry->private_data;
485
486         mutex_lock(&per_pin->lock);
487         snd_hdmi_write_eld_info(&per_pin->sink_eld, buffer);
488         mutex_unlock(&per_pin->lock);
489 }
490
491 static int eld_proc_new(struct hdmi_spec_per_pin *per_pin, int index)
492 {
493         char name[32];
494         struct hda_codec *codec = per_pin->codec;
495         struct snd_info_entry *entry;
496         int err;
497
498         snprintf(name, sizeof(name), "eld#%d.%d", codec->addr, index);
499         err = snd_card_proc_new(codec->card, name, &entry);
500         if (err < 0)
501                 return err;
502
503         snd_info_set_text_ops(entry, per_pin, print_eld_info);
504         entry->c.text.write = write_eld_info;
505         entry->mode |= 0200;
506         per_pin->proc_entry = entry;
507
508         return 0;
509 }
510
511 static void eld_proc_free(struct hdmi_spec_per_pin *per_pin)
512 {
513         if (!per_pin->codec->bus->shutdown) {
514                 snd_info_free_entry(per_pin->proc_entry);
515                 per_pin->proc_entry = NULL;
516         }
517 }
518 #else
519 static inline int eld_proc_new(struct hdmi_spec_per_pin *per_pin,
520                                int index)
521 {
522         return 0;
523 }
524 static inline void eld_proc_free(struct hdmi_spec_per_pin *per_pin)
525 {
526 }
527 #endif
528
529 /*
530  * Audio InfoFrame routines
531  */
532
533 /*
534  * Enable Audio InfoFrame Transmission
535  */
536 static void hdmi_start_infoframe_trans(struct hda_codec *codec,
537                                        hda_nid_t pin_nid)
538 {
539         hdmi_set_dip_index(codec, pin_nid, 0x0, 0x0);
540         snd_hda_codec_write(codec, pin_nid, 0, AC_VERB_SET_HDMI_DIP_XMIT,
541                                                 AC_DIPXMIT_BEST);
542 }
543
544 /*
545  * Disable Audio InfoFrame Transmission
546  */
547 static void hdmi_stop_infoframe_trans(struct hda_codec *codec,
548                                       hda_nid_t pin_nid)
549 {
550         hdmi_set_dip_index(codec, pin_nid, 0x0, 0x0);
551         snd_hda_codec_write(codec, pin_nid, 0, AC_VERB_SET_HDMI_DIP_XMIT,
552                                                 AC_DIPXMIT_DISABLE);
553 }
554
555 static void hdmi_debug_dip_size(struct hda_codec *codec, hda_nid_t pin_nid)
556 {
557 #ifdef CONFIG_SND_DEBUG_VERBOSE
558         int i;
559         int size;
560
561         size = snd_hdmi_get_eld_size(codec, pin_nid);
562         codec_dbg(codec, "HDMI: ELD buf size is %d\n", size);
563
564         for (i = 0; i < 8; i++) {
565                 size = snd_hda_codec_read(codec, pin_nid, 0,
566                                                 AC_VERB_GET_HDMI_DIP_SIZE, i);
567                 codec_dbg(codec, "HDMI: DIP GP[%d] buf size is %d\n", i, size);
568         }
569 #endif
570 }
571
572 static void hdmi_clear_dip_buffers(struct hda_codec *codec, hda_nid_t pin_nid)
573 {
574 #ifdef BE_PARANOID
575         int i, j;
576         int size;
577         int pi, bi;
578         for (i = 0; i < 8; i++) {
579                 size = snd_hda_codec_read(codec, pin_nid, 0,
580                                                 AC_VERB_GET_HDMI_DIP_SIZE, i);
581                 if (size == 0)
582                         continue;
583
584                 hdmi_set_dip_index(codec, pin_nid, i, 0x0);
585                 for (j = 1; j < 1000; j++) {
586                         hdmi_write_dip_byte(codec, pin_nid, 0x0);
587                         hdmi_get_dip_index(codec, pin_nid, &pi, &bi);
588                         if (pi != i)
589                                 codec_dbg(codec, "dip index %d: %d != %d\n",
590                                                 bi, pi, i);
591                         if (bi == 0) /* byte index wrapped around */
592                                 break;
593                 }
594                 codec_dbg(codec,
595                         "HDMI: DIP GP[%d] buf reported size=%d, written=%d\n",
596                         i, size, j);
597         }
598 #endif
599 }
600
601 static void hdmi_checksum_audio_infoframe(struct hdmi_audio_infoframe *hdmi_ai)
602 {
603         u8 *bytes = (u8 *)hdmi_ai;
604         u8 sum = 0;
605         int i;
606
607         hdmi_ai->checksum = 0;
608
609         for (i = 0; i < sizeof(*hdmi_ai); i++)
610                 sum += bytes[i];
611
612         hdmi_ai->checksum = -sum;
613 }
614
615 static void hdmi_fill_audio_infoframe(struct hda_codec *codec,
616                                       hda_nid_t pin_nid,
617                                       u8 *dip, int size)
618 {
619         int i;
620
621         hdmi_debug_dip_size(codec, pin_nid);
622         hdmi_clear_dip_buffers(codec, pin_nid); /* be paranoid */
623
624         hdmi_set_dip_index(codec, pin_nid, 0x0, 0x0);
625         for (i = 0; i < size; i++)
626                 hdmi_write_dip_byte(codec, pin_nid, dip[i]);
627 }
628
629 static bool hdmi_infoframe_uptodate(struct hda_codec *codec, hda_nid_t pin_nid,
630                                     u8 *dip, int size)
631 {
632         u8 val;
633         int i;
634
635         if (snd_hda_codec_read(codec, pin_nid, 0, AC_VERB_GET_HDMI_DIP_XMIT, 0)
636                                                             != AC_DIPXMIT_BEST)
637                 return false;
638
639         hdmi_set_dip_index(codec, pin_nid, 0x0, 0x0);
640         for (i = 0; i < size; i++) {
641                 val = snd_hda_codec_read(codec, pin_nid, 0,
642                                          AC_VERB_GET_HDMI_DIP_DATA, 0);
643                 if (val != dip[i])
644                         return false;
645         }
646
647         return true;
648 }
649
650 static void hdmi_pin_setup_infoframe(struct hda_codec *codec,
651                                      hda_nid_t pin_nid,
652                                      int ca, int active_channels,
653                                      int conn_type)
654 {
655         union audio_infoframe ai;
656
657         memset(&ai, 0, sizeof(ai));
658         if (conn_type == 0) { /* HDMI */
659                 struct hdmi_audio_infoframe *hdmi_ai = &ai.hdmi;
660
661                 hdmi_ai->type           = 0x84;
662                 hdmi_ai->ver            = 0x01;
663                 hdmi_ai->len            = 0x0a;
664                 hdmi_ai->CC02_CT47      = active_channels - 1;
665                 hdmi_ai->CA             = ca;
666                 hdmi_checksum_audio_infoframe(hdmi_ai);
667         } else if (conn_type == 1) { /* DisplayPort */
668                 struct dp_audio_infoframe *dp_ai = &ai.dp;
669
670                 dp_ai->type             = 0x84;
671                 dp_ai->len              = 0x1b;
672                 dp_ai->ver              = 0x11 << 2;
673                 dp_ai->CC02_CT47        = active_channels - 1;
674                 dp_ai->CA               = ca;
675         } else {
676                 codec_dbg(codec, "HDMI: unknown connection type at pin %d\n",
677                             pin_nid);
678                 return;
679         }
680
681         /*
682          * sizeof(ai) is used instead of sizeof(*hdmi_ai) or
683          * sizeof(*dp_ai) to avoid partial match/update problems when
684          * the user switches between HDMI/DP monitors.
685          */
686         if (!hdmi_infoframe_uptodate(codec, pin_nid, ai.bytes,
687                                         sizeof(ai))) {
688                 codec_dbg(codec,
689                           "hdmi_pin_setup_infoframe: pin=%d channels=%d ca=0x%02x\n",
690                             pin_nid,
691                             active_channels, ca);
692                 hdmi_stop_infoframe_trans(codec, pin_nid);
693                 hdmi_fill_audio_infoframe(codec, pin_nid,
694                                             ai.bytes, sizeof(ai));
695                 hdmi_start_infoframe_trans(codec, pin_nid);
696         }
697 }
698
699 static void hdmi_setup_audio_infoframe(struct hda_codec *codec,
700                                        struct hdmi_spec_per_pin *per_pin,
701                                        bool non_pcm)
702 {
703         struct hdmi_spec *spec = codec->spec;
704         struct hdac_chmap *chmap = &spec->chmap;
705         hda_nid_t pin_nid = per_pin->pin_nid;
706         int channels = per_pin->channels;
707         int active_channels;
708         struct hdmi_eld *eld;
709         int ca;
710
711         if (!channels)
712                 return;
713
714         /* some HW (e.g. HSW+) needs reprogramming the amp at each time */
715         if (get_wcaps(codec, pin_nid) & AC_WCAP_OUT_AMP)
716                 snd_hda_codec_write(codec, pin_nid, 0,
717                                             AC_VERB_SET_AMP_GAIN_MUTE,
718                                             AMP_OUT_UNMUTE);
719
720         eld = &per_pin->sink_eld;
721
722         ca = snd_hdac_channel_allocation(&codec->core,
723                         eld->info.spk_alloc, channels,
724                         per_pin->chmap_set, non_pcm, per_pin->chmap);
725
726         active_channels = snd_hdac_get_active_channels(ca);
727
728         chmap->ops.set_channel_count(&codec->core, per_pin->cvt_nid,
729                                                 active_channels);
730
731         /*
732          * always configure channel mapping, it may have been changed by the
733          * user in the meantime
734          */
735         snd_hdac_setup_channel_mapping(&spec->chmap,
736                                 pin_nid, non_pcm, ca, channels,
737                                 per_pin->chmap, per_pin->chmap_set);
738
739         spec->ops.pin_setup_infoframe(codec, pin_nid, ca, active_channels,
740                                       eld->info.conn_type);
741
742         per_pin->non_pcm = non_pcm;
743 }
744
745 /*
746  * Unsolicited events
747  */
748
749 static bool hdmi_present_sense(struct hdmi_spec_per_pin *per_pin, int repoll);
750
751 static void check_presence_and_report(struct hda_codec *codec, hda_nid_t nid,
752                                       int dev_id)
753 {
754         struct hdmi_spec *spec = codec->spec;
755         int pin_idx = pin_id_to_pin_index(codec, nid, dev_id);
756
757         if (pin_idx < 0)
758                 return;
759         mutex_lock(&spec->pcm_lock);
760         if (hdmi_present_sense(get_pin(spec, pin_idx), 1))
761                 snd_hda_jack_report_sync(codec);
762         mutex_unlock(&spec->pcm_lock);
763 }
764
765 static void jack_callback(struct hda_codec *codec,
766                           struct hda_jack_callback *jack)
767 {
768         /* hda_jack don't support DP MST */
769         check_presence_and_report(codec, jack->nid, 0);
770 }
771
772 static void hdmi_intrinsic_event(struct hda_codec *codec, unsigned int res)
773 {
774         int tag = res >> AC_UNSOL_RES_TAG_SHIFT;
775         struct hda_jack_tbl *jack;
776         int dev_entry = (res & AC_UNSOL_RES_DE) >> AC_UNSOL_RES_DE_SHIFT;
777
778         /*
779          * assume DP MST uses dyn_pcm_assign and acomp and
780          * never comes here
781          * if DP MST supports unsol event, below code need
782          * consider dev_entry
783          */
784         jack = snd_hda_jack_tbl_get_from_tag(codec, tag);
785         if (!jack)
786                 return;
787         jack->jack_dirty = 1;
788
789         codec_dbg(codec,
790                 "HDMI hot plug event: Codec=%d Pin=%d Device=%d Inactive=%d Presence_Detect=%d ELD_Valid=%d\n",
791                 codec->addr, jack->nid, dev_entry, !!(res & AC_UNSOL_RES_IA),
792                 !!(res & AC_UNSOL_RES_PD), !!(res & AC_UNSOL_RES_ELDV));
793
794         /* hda_jack don't support DP MST */
795         check_presence_and_report(codec, jack->nid, 0);
796 }
797
798 static void hdmi_non_intrinsic_event(struct hda_codec *codec, unsigned int res)
799 {
800         int tag = res >> AC_UNSOL_RES_TAG_SHIFT;
801         int subtag = (res & AC_UNSOL_RES_SUBTAG) >> AC_UNSOL_RES_SUBTAG_SHIFT;
802         int cp_state = !!(res & AC_UNSOL_RES_CP_STATE);
803         int cp_ready = !!(res & AC_UNSOL_RES_CP_READY);
804
805         codec_info(codec,
806                 "HDMI CP event: CODEC=%d TAG=%d SUBTAG=0x%x CP_STATE=%d CP_READY=%d\n",
807                 codec->addr,
808                 tag,
809                 subtag,
810                 cp_state,
811                 cp_ready);
812
813         /* TODO */
814         if (cp_state)
815                 ;
816         if (cp_ready)
817                 ;
818 }
819
820
821 static void hdmi_unsol_event(struct hda_codec *codec, unsigned int res)
822 {
823         int tag = res >> AC_UNSOL_RES_TAG_SHIFT;
824         int subtag = (res & AC_UNSOL_RES_SUBTAG) >> AC_UNSOL_RES_SUBTAG_SHIFT;
825
826         if (!snd_hda_jack_tbl_get_from_tag(codec, tag)) {
827                 codec_dbg(codec, "Unexpected HDMI event tag 0x%x\n", tag);
828                 return;
829         }
830
831         if (subtag == 0)
832                 hdmi_intrinsic_event(codec, res);
833         else
834                 hdmi_non_intrinsic_event(codec, res);
835 }
836
837 static void haswell_verify_D0(struct hda_codec *codec,
838                 hda_nid_t cvt_nid, hda_nid_t nid)
839 {
840         int pwr;
841
842         /* For Haswell, the converter 1/2 may keep in D3 state after bootup,
843          * thus pins could only choose converter 0 for use. Make sure the
844          * converters are in correct power state */
845         if (!snd_hda_check_power_state(codec, cvt_nid, AC_PWRST_D0))
846                 snd_hda_codec_write(codec, cvt_nid, 0, AC_VERB_SET_POWER_STATE, AC_PWRST_D0);
847
848         if (!snd_hda_check_power_state(codec, nid, AC_PWRST_D0)) {
849                 snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_POWER_STATE,
850                                     AC_PWRST_D0);
851                 msleep(40);
852                 pwr = snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_POWER_STATE, 0);
853                 pwr = (pwr & AC_PWRST_ACTUAL) >> AC_PWRST_ACTUAL_SHIFT;
854                 codec_dbg(codec, "Haswell HDMI audio: Power for pin 0x%x is now D%d\n", nid, pwr);
855         }
856 }
857
858 /*
859  * Callbacks
860  */
861
862 /* HBR should be Non-PCM, 8 channels */
863 #define is_hbr_format(format) \
864         ((format & AC_FMT_TYPE_NON_PCM) && (format & AC_FMT_CHAN_MASK) == 7)
865
866 static int hdmi_pin_hbr_setup(struct hda_codec *codec, hda_nid_t pin_nid,
867                               bool hbr)
868 {
869         int pinctl, new_pinctl;
870
871         if (snd_hda_query_pin_caps(codec, pin_nid) & AC_PINCAP_HBR) {
872                 pinctl = snd_hda_codec_read(codec, pin_nid, 0,
873                                             AC_VERB_GET_PIN_WIDGET_CONTROL, 0);
874
875                 if (pinctl < 0)
876                         return hbr ? -EINVAL : 0;
877
878                 new_pinctl = pinctl & ~AC_PINCTL_EPT;
879                 if (hbr)
880                         new_pinctl |= AC_PINCTL_EPT_HBR;
881                 else
882                         new_pinctl |= AC_PINCTL_EPT_NATIVE;
883
884                 codec_dbg(codec,
885                           "hdmi_pin_hbr_setup: NID=0x%x, %spinctl=0x%x\n",
886                             pin_nid,
887                             pinctl == new_pinctl ? "" : "new-",
888                             new_pinctl);
889
890                 if (pinctl != new_pinctl)
891                         snd_hda_codec_write(codec, pin_nid, 0,
892                                             AC_VERB_SET_PIN_WIDGET_CONTROL,
893                                             new_pinctl);
894         } else if (hbr)
895                 return -EINVAL;
896
897         return 0;
898 }
899
900 static int hdmi_setup_stream(struct hda_codec *codec, hda_nid_t cvt_nid,
901                               hda_nid_t pin_nid, u32 stream_tag, int format)
902 {
903         struct hdmi_spec *spec = codec->spec;
904         unsigned int param;
905         int err;
906
907         err = spec->ops.pin_hbr_setup(codec, pin_nid, is_hbr_format(format));
908
909         if (err) {
910                 codec_dbg(codec, "hdmi_setup_stream: HBR is not supported\n");
911                 return err;
912         }
913
914         if (is_haswell_plus(codec)) {
915
916                 /*
917                  * on recent platforms IEC Coding Type is required for HBR
918                  * support, read current Digital Converter settings and set
919                  * ICT bitfield if needed.
920                  */
921                 param = snd_hda_codec_read(codec, cvt_nid, 0,
922                                            AC_VERB_GET_DIGI_CONVERT_1, 0);
923
924                 param = (param >> 16) & ~(AC_DIG3_ICT);
925
926                 /* on recent platforms ICT mode is required for HBR support */
927                 if (is_hbr_format(format))
928                         param |= 0x1;
929
930                 snd_hda_codec_write(codec, cvt_nid, 0,
931                                     AC_VERB_SET_DIGI_CONVERT_3, param);
932         }
933
934         snd_hda_codec_setup_stream(codec, cvt_nid, stream_tag, 0, format);
935         return 0;
936 }
937
938 /* Try to find an available converter
939  * If pin_idx is less then zero, just try to find an available converter.
940  * Otherwise, try to find an available converter and get the cvt mux index
941  * of the pin.
942  */
943 static int hdmi_choose_cvt(struct hda_codec *codec,
944                            int pin_idx, int *cvt_id)
945 {
946         struct hdmi_spec *spec = codec->spec;
947         struct hdmi_spec_per_pin *per_pin;
948         struct hdmi_spec_per_cvt *per_cvt = NULL;
949         int cvt_idx, mux_idx = 0;
950
951         /* pin_idx < 0 means no pin will be bound to the converter */
952         if (pin_idx < 0)
953                 per_pin = NULL;
954         else
955                 per_pin = get_pin(spec, pin_idx);
956
957         /* Dynamically assign converter to stream */
958         for (cvt_idx = 0; cvt_idx < spec->num_cvts; cvt_idx++) {
959                 per_cvt = get_cvt(spec, cvt_idx);
960
961                 /* Must not already be assigned */
962                 if (per_cvt->assigned)
963                         continue;
964                 if (per_pin == NULL)
965                         break;
966                 /* Must be in pin's mux's list of converters */
967                 for (mux_idx = 0; mux_idx < per_pin->num_mux_nids; mux_idx++)
968                         if (per_pin->mux_nids[mux_idx] == per_cvt->cvt_nid)
969                                 break;
970                 /* Not in mux list */
971                 if (mux_idx == per_pin->num_mux_nids)
972                         continue;
973                 break;
974         }
975
976         /* No free converters */
977         if (cvt_idx == spec->num_cvts)
978                 return -EBUSY;
979
980         if (per_pin != NULL)
981                 per_pin->mux_idx = mux_idx;
982
983         if (cvt_id)
984                 *cvt_id = cvt_idx;
985
986         return 0;
987 }
988
989 /* Assure the pin select the right convetor */
990 static void intel_verify_pin_cvt_connect(struct hda_codec *codec,
991                         struct hdmi_spec_per_pin *per_pin)
992 {
993         hda_nid_t pin_nid = per_pin->pin_nid;
994         int mux_idx, curr;
995
996         mux_idx = per_pin->mux_idx;
997         curr = snd_hda_codec_read(codec, pin_nid, 0,
998                                           AC_VERB_GET_CONNECT_SEL, 0);
999         if (curr != mux_idx)
1000                 snd_hda_codec_write_cache(codec, pin_nid, 0,
1001                                             AC_VERB_SET_CONNECT_SEL,
1002                                             mux_idx);
1003 }
1004
1005 /* get the mux index for the converter of the pins
1006  * converter's mux index is the same for all pins on Intel platform
1007  */
1008 static int intel_cvt_id_to_mux_idx(struct hdmi_spec *spec,
1009                         hda_nid_t cvt_nid)
1010 {
1011         int i;
1012
1013         for (i = 0; i < spec->num_cvts; i++)
1014                 if (spec->cvt_nids[i] == cvt_nid)
1015                         return i;
1016         return -EINVAL;
1017 }
1018
1019 /* Intel HDMI workaround to fix audio routing issue:
1020  * For some Intel display codecs, pins share the same connection list.
1021  * So a conveter can be selected by multiple pins and playback on any of these
1022  * pins will generate sound on the external display, because audio flows from
1023  * the same converter to the display pipeline. Also muting one pin may make
1024  * other pins have no sound output.
1025  * So this function assures that an assigned converter for a pin is not selected
1026  * by any other pins.
1027  */
1028 static void intel_not_share_assigned_cvt(struct hda_codec *codec,
1029                                          hda_nid_t pin_nid,
1030                                          int dev_id, int mux_idx)
1031 {
1032         struct hdmi_spec *spec = codec->spec;
1033         hda_nid_t nid;
1034         int cvt_idx, curr;
1035         struct hdmi_spec_per_cvt *per_cvt;
1036         struct hdmi_spec_per_pin *per_pin;
1037         int pin_idx;
1038
1039         /* configure the pins connections */
1040         for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
1041                 int dev_id_saved;
1042                 int dev_num;
1043
1044                 per_pin = get_pin(spec, pin_idx);
1045                 /*
1046                  * pin not connected to monitor
1047                  * no need to operate on it
1048                  */
1049                 if (!per_pin->pcm)
1050                         continue;
1051
1052                 if ((per_pin->pin_nid == pin_nid) &&
1053                         (per_pin->dev_id == dev_id))
1054                         continue;
1055
1056                 /*
1057                  * if per_pin->dev_id >= dev_num,
1058                  * snd_hda_get_dev_select() will fail,
1059                  * and the following operation is unpredictable.
1060                  * So skip this situation.
1061                  */
1062                 dev_num = snd_hda_get_num_devices(codec, per_pin->pin_nid) + 1;
1063                 if (per_pin->dev_id >= dev_num)
1064                         continue;
1065
1066                 nid = per_pin->pin_nid;
1067
1068                 /*
1069                  * Calling this function should not impact
1070                  * on the device entry selection
1071                  * So let's save the dev id for each pin,
1072                  * and restore it when return
1073                  */
1074                 dev_id_saved = snd_hda_get_dev_select(codec, nid);
1075                 snd_hda_set_dev_select(codec, nid, per_pin->dev_id);
1076                 curr = snd_hda_codec_read(codec, nid, 0,
1077                                           AC_VERB_GET_CONNECT_SEL, 0);
1078                 if (curr != mux_idx) {
1079                         snd_hda_set_dev_select(codec, nid, dev_id_saved);
1080                         continue;
1081                 }
1082
1083
1084                 /* choose an unassigned converter. The conveters in the
1085                  * connection list are in the same order as in the codec.
1086                  */
1087                 for (cvt_idx = 0; cvt_idx < spec->num_cvts; cvt_idx++) {
1088                         per_cvt = get_cvt(spec, cvt_idx);
1089                         if (!per_cvt->assigned) {
1090                                 codec_dbg(codec,
1091                                           "choose cvt %d for pin nid %d\n",
1092                                         cvt_idx, nid);
1093                                 snd_hda_codec_write_cache(codec, nid, 0,
1094                                             AC_VERB_SET_CONNECT_SEL,
1095                                             cvt_idx);
1096                                 break;
1097                         }
1098                 }
1099                 snd_hda_set_dev_select(codec, nid, dev_id_saved);
1100         }
1101 }
1102
1103 /* A wrapper of intel_not_share_asigned_cvt() */
1104 static void intel_not_share_assigned_cvt_nid(struct hda_codec *codec,
1105                         hda_nid_t pin_nid, int dev_id, hda_nid_t cvt_nid)
1106 {
1107         int mux_idx;
1108         struct hdmi_spec *spec = codec->spec;
1109
1110         /* On Intel platform, the mapping of converter nid to
1111          * mux index of the pins are always the same.
1112          * The pin nid may be 0, this means all pins will not
1113          * share the converter.
1114          */
1115         mux_idx = intel_cvt_id_to_mux_idx(spec, cvt_nid);
1116         if (mux_idx >= 0)
1117                 intel_not_share_assigned_cvt(codec, pin_nid, dev_id, mux_idx);
1118 }
1119
1120 /* skeleton caller of pin_cvt_fixup ops */
1121 static void pin_cvt_fixup(struct hda_codec *codec,
1122                           struct hdmi_spec_per_pin *per_pin,
1123                           hda_nid_t cvt_nid)
1124 {
1125         struct hdmi_spec *spec = codec->spec;
1126
1127         if (spec->ops.pin_cvt_fixup)
1128                 spec->ops.pin_cvt_fixup(codec, per_pin, cvt_nid);
1129 }
1130
1131 /* called in hdmi_pcm_open when no pin is assigned to the PCM
1132  * in dyn_pcm_assign mode.
1133  */
1134 static int hdmi_pcm_open_no_pin(struct hda_pcm_stream *hinfo,
1135                          struct hda_codec *codec,
1136                          struct snd_pcm_substream *substream)
1137 {
1138         struct hdmi_spec *spec = codec->spec;
1139         struct snd_pcm_runtime *runtime = substream->runtime;
1140         int cvt_idx, pcm_idx;
1141         struct hdmi_spec_per_cvt *per_cvt = NULL;
1142         int err;
1143
1144         pcm_idx = hinfo_to_pcm_index(codec, hinfo);
1145         if (pcm_idx < 0)
1146                 return -EINVAL;
1147
1148         err = hdmi_choose_cvt(codec, -1, &cvt_idx);
1149         if (err)
1150                 return err;
1151
1152         per_cvt = get_cvt(spec, cvt_idx);
1153         per_cvt->assigned = 1;
1154         hinfo->nid = per_cvt->cvt_nid;
1155
1156         pin_cvt_fixup(codec, NULL, per_cvt->cvt_nid);
1157
1158         set_bit(pcm_idx, &spec->pcm_in_use);
1159         /* todo: setup spdif ctls assign */
1160
1161         /* Initially set the converter's capabilities */
1162         hinfo->channels_min = per_cvt->channels_min;
1163         hinfo->channels_max = per_cvt->channels_max;
1164         hinfo->rates = per_cvt->rates;
1165         hinfo->formats = per_cvt->formats;
1166         hinfo->maxbps = per_cvt->maxbps;
1167
1168         /* Store the updated parameters */
1169         runtime->hw.channels_min = hinfo->channels_min;
1170         runtime->hw.channels_max = hinfo->channels_max;
1171         runtime->hw.formats = hinfo->formats;
1172         runtime->hw.rates = hinfo->rates;
1173
1174         snd_pcm_hw_constraint_step(substream->runtime, 0,
1175                                    SNDRV_PCM_HW_PARAM_CHANNELS, 2);
1176         return 0;
1177 }
1178
1179 /*
1180  * HDA PCM callbacks
1181  */
1182 static int hdmi_pcm_open(struct hda_pcm_stream *hinfo,
1183                          struct hda_codec *codec,
1184                          struct snd_pcm_substream *substream)
1185 {
1186         struct hdmi_spec *spec = codec->spec;
1187         struct snd_pcm_runtime *runtime = substream->runtime;
1188         int pin_idx, cvt_idx, pcm_idx;
1189         struct hdmi_spec_per_pin *per_pin;
1190         struct hdmi_eld *eld;
1191         struct hdmi_spec_per_cvt *per_cvt = NULL;
1192         int err;
1193
1194         /* Validate hinfo */
1195         pcm_idx = hinfo_to_pcm_index(codec, hinfo);
1196         if (pcm_idx < 0)
1197                 return -EINVAL;
1198
1199         mutex_lock(&spec->pcm_lock);
1200         pin_idx = hinfo_to_pin_index(codec, hinfo);
1201         if (!spec->dyn_pcm_assign) {
1202                 if (snd_BUG_ON(pin_idx < 0)) {
1203                         err = -EINVAL;
1204                         goto unlock;
1205                 }
1206         } else {
1207                 /* no pin is assigned to the PCM
1208                  * PA need pcm open successfully when probe
1209                  */
1210                 if (pin_idx < 0) {
1211                         err = hdmi_pcm_open_no_pin(hinfo, codec, substream);
1212                         goto unlock;
1213                 }
1214         }
1215
1216         err = hdmi_choose_cvt(codec, pin_idx, &cvt_idx);
1217         if (err < 0)
1218                 goto unlock;
1219
1220         per_cvt = get_cvt(spec, cvt_idx);
1221         /* Claim converter */
1222         per_cvt->assigned = 1;
1223
1224         set_bit(pcm_idx, &spec->pcm_in_use);
1225         per_pin = get_pin(spec, pin_idx);
1226         per_pin->cvt_nid = per_cvt->cvt_nid;
1227         hinfo->nid = per_cvt->cvt_nid;
1228
1229         snd_hda_set_dev_select(codec, per_pin->pin_nid, per_pin->dev_id);
1230         snd_hda_codec_write_cache(codec, per_pin->pin_nid, 0,
1231                             AC_VERB_SET_CONNECT_SEL,
1232                             per_pin->mux_idx);
1233
1234         /* configure unused pins to choose other converters */
1235         pin_cvt_fixup(codec, per_pin, 0);
1236
1237         snd_hda_spdif_ctls_assign(codec, pcm_idx, per_cvt->cvt_nid);
1238
1239         /* Initially set the converter's capabilities */
1240         hinfo->channels_min = per_cvt->channels_min;
1241         hinfo->channels_max = per_cvt->channels_max;
1242         hinfo->rates = per_cvt->rates;
1243         hinfo->formats = per_cvt->formats;
1244         hinfo->maxbps = per_cvt->maxbps;
1245
1246         eld = &per_pin->sink_eld;
1247         /* Restrict capabilities by ELD if this isn't disabled */
1248         if (!static_hdmi_pcm && eld->eld_valid) {
1249                 snd_hdmi_eld_update_pcm_info(&eld->info, hinfo);
1250                 if (hinfo->channels_min > hinfo->channels_max ||
1251                     !hinfo->rates || !hinfo->formats) {
1252                         per_cvt->assigned = 0;
1253                         hinfo->nid = 0;
1254                         snd_hda_spdif_ctls_unassign(codec, pcm_idx);
1255                         err = -ENODEV;
1256                         goto unlock;
1257                 }
1258         }
1259
1260         /* Store the updated parameters */
1261         runtime->hw.channels_min = hinfo->channels_min;
1262         runtime->hw.channels_max = hinfo->channels_max;
1263         runtime->hw.formats = hinfo->formats;
1264         runtime->hw.rates = hinfo->rates;
1265
1266         snd_pcm_hw_constraint_step(substream->runtime, 0,
1267                                    SNDRV_PCM_HW_PARAM_CHANNELS, 2);
1268  unlock:
1269         mutex_unlock(&spec->pcm_lock);
1270         return err;
1271 }
1272
1273 /*
1274  * HDA/HDMI auto parsing
1275  */
1276 static int hdmi_read_pin_conn(struct hda_codec *codec, int pin_idx)
1277 {
1278         struct hdmi_spec *spec = codec->spec;
1279         struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
1280         hda_nid_t pin_nid = per_pin->pin_nid;
1281
1282         if (!(get_wcaps(codec, pin_nid) & AC_WCAP_CONN_LIST)) {
1283                 codec_warn(codec,
1284                            "HDMI: pin %d wcaps %#x does not support connection list\n",
1285                            pin_nid, get_wcaps(codec, pin_nid));
1286                 return -EINVAL;
1287         }
1288
1289         /* all the device entries on the same pin have the same conn list */
1290         per_pin->num_mux_nids = snd_hda_get_connections(codec, pin_nid,
1291                                                         per_pin->mux_nids,
1292                                                         HDA_MAX_CONNECTIONS);
1293
1294         return 0;
1295 }
1296
1297 static int hdmi_find_pcm_slot(struct hdmi_spec *spec,
1298                                 struct hdmi_spec_per_pin *per_pin)
1299 {
1300         int i;
1301
1302         /* try the prefer PCM */
1303         if (!test_bit(per_pin->pin_nid_idx, &spec->pcm_bitmap))
1304                 return per_pin->pin_nid_idx;
1305
1306         /* have a second try; check the "reserved area" over num_pins */
1307         for (i = spec->num_nids; i < spec->pcm_used; i++) {
1308                 if (!test_bit(i, &spec->pcm_bitmap))
1309                         return i;
1310         }
1311
1312         /* the last try; check the empty slots in pins */
1313         for (i = 0; i < spec->num_nids; i++) {
1314                 if (!test_bit(i, &spec->pcm_bitmap))
1315                         return i;
1316         }
1317         return -EBUSY;
1318 }
1319
1320 static void hdmi_attach_hda_pcm(struct hdmi_spec *spec,
1321                                 struct hdmi_spec_per_pin *per_pin)
1322 {
1323         int idx;
1324
1325         /* pcm already be attached to the pin */
1326         if (per_pin->pcm)
1327                 return;
1328         idx = hdmi_find_pcm_slot(spec, per_pin);
1329         if (idx == -EBUSY)
1330                 return;
1331         per_pin->pcm_idx = idx;
1332         per_pin->pcm = get_hdmi_pcm(spec, idx);
1333         set_bit(idx, &spec->pcm_bitmap);
1334 }
1335
1336 static void hdmi_detach_hda_pcm(struct hdmi_spec *spec,
1337                                 struct hdmi_spec_per_pin *per_pin)
1338 {
1339         int idx;
1340
1341         /* pcm already be detached from the pin */
1342         if (!per_pin->pcm)
1343                 return;
1344         idx = per_pin->pcm_idx;
1345         per_pin->pcm_idx = -1;
1346         per_pin->pcm = NULL;
1347         if (idx >= 0 && idx < spec->pcm_used)
1348                 clear_bit(idx, &spec->pcm_bitmap);
1349 }
1350
1351 static int hdmi_get_pin_cvt_mux(struct hdmi_spec *spec,
1352                 struct hdmi_spec_per_pin *per_pin, hda_nid_t cvt_nid)
1353 {
1354         int mux_idx;
1355
1356         for (mux_idx = 0; mux_idx < per_pin->num_mux_nids; mux_idx++)
1357                 if (per_pin->mux_nids[mux_idx] == cvt_nid)
1358                         break;
1359         return mux_idx;
1360 }
1361
1362 static bool check_non_pcm_per_cvt(struct hda_codec *codec, hda_nid_t cvt_nid);
1363
1364 static void hdmi_pcm_setup_pin(struct hdmi_spec *spec,
1365                            struct hdmi_spec_per_pin *per_pin)
1366 {
1367         struct hda_codec *codec = per_pin->codec;
1368         struct hda_pcm *pcm;
1369         struct hda_pcm_stream *hinfo;
1370         struct snd_pcm_substream *substream;
1371         int mux_idx;
1372         bool non_pcm;
1373
1374         if (per_pin->pcm_idx >= 0 && per_pin->pcm_idx < spec->pcm_used)
1375                 pcm = get_pcm_rec(spec, per_pin->pcm_idx);
1376         else
1377                 return;
1378         if (!pcm->pcm)
1379                 return;
1380         if (!test_bit(per_pin->pcm_idx, &spec->pcm_in_use))
1381                 return;
1382
1383         /* hdmi audio only uses playback and one substream */
1384         hinfo = pcm->stream;
1385         substream = pcm->pcm->streams[0].substream;
1386
1387         per_pin->cvt_nid = hinfo->nid;
1388
1389         mux_idx = hdmi_get_pin_cvt_mux(spec, per_pin, hinfo->nid);
1390         if (mux_idx < per_pin->num_mux_nids) {
1391                 snd_hda_set_dev_select(codec, per_pin->pin_nid,
1392                                    per_pin->dev_id);
1393                 snd_hda_codec_write_cache(codec, per_pin->pin_nid, 0,
1394                                 AC_VERB_SET_CONNECT_SEL,
1395                                 mux_idx);
1396         }
1397         snd_hda_spdif_ctls_assign(codec, per_pin->pcm_idx, hinfo->nid);
1398
1399         non_pcm = check_non_pcm_per_cvt(codec, hinfo->nid);
1400         if (substream->runtime)
1401                 per_pin->channels = substream->runtime->channels;
1402         per_pin->setup = true;
1403         per_pin->mux_idx = mux_idx;
1404
1405         hdmi_setup_audio_infoframe(codec, per_pin, non_pcm);
1406 }
1407
1408 static void hdmi_pcm_reset_pin(struct hdmi_spec *spec,
1409                            struct hdmi_spec_per_pin *per_pin)
1410 {
1411         if (per_pin->pcm_idx >= 0 && per_pin->pcm_idx < spec->pcm_used)
1412                 snd_hda_spdif_ctls_unassign(per_pin->codec, per_pin->pcm_idx);
1413
1414         per_pin->chmap_set = false;
1415         memset(per_pin->chmap, 0, sizeof(per_pin->chmap));
1416
1417         per_pin->setup = false;
1418         per_pin->channels = 0;
1419 }
1420
1421 /* update per_pin ELD from the given new ELD;
1422  * setup info frame and notification accordingly
1423  */
1424 static void update_eld(struct hda_codec *codec,
1425                        struct hdmi_spec_per_pin *per_pin,
1426                        struct hdmi_eld *eld)
1427 {
1428         struct hdmi_eld *pin_eld = &per_pin->sink_eld;
1429         struct hdmi_spec *spec = codec->spec;
1430         bool old_eld_valid = pin_eld->eld_valid;
1431         bool eld_changed;
1432         int pcm_idx = -1;
1433
1434         /* for monitor disconnection, save pcm_idx firstly */
1435         pcm_idx = per_pin->pcm_idx;
1436         if (spec->dyn_pcm_assign) {
1437                 if (eld->eld_valid) {
1438                         hdmi_attach_hda_pcm(spec, per_pin);
1439                         hdmi_pcm_setup_pin(spec, per_pin);
1440                 } else {
1441                         hdmi_pcm_reset_pin(spec, per_pin);
1442                         hdmi_detach_hda_pcm(spec, per_pin);
1443                 }
1444         }
1445         /* if pcm_idx == -1, it means this is in monitor connection event
1446          * we can get the correct pcm_idx now.
1447          */
1448         if (pcm_idx == -1)
1449                 pcm_idx = per_pin->pcm_idx;
1450
1451         if (eld->eld_valid)
1452                 snd_hdmi_show_eld(codec, &eld->info);
1453
1454         eld_changed = (pin_eld->eld_valid != eld->eld_valid);
1455         if (eld->eld_valid && pin_eld->eld_valid)
1456                 if (pin_eld->eld_size != eld->eld_size ||
1457                     memcmp(pin_eld->eld_buffer, eld->eld_buffer,
1458                            eld->eld_size) != 0)
1459                         eld_changed = true;
1460
1461         pin_eld->monitor_present = eld->monitor_present;
1462         pin_eld->eld_valid = eld->eld_valid;
1463         pin_eld->eld_size = eld->eld_size;
1464         if (eld->eld_valid)
1465                 memcpy(pin_eld->eld_buffer, eld->eld_buffer, eld->eld_size);
1466         pin_eld->info = eld->info;
1467
1468         /*
1469          * Re-setup pin and infoframe. This is needed e.g. when
1470          * - sink is first plugged-in
1471          * - transcoder can change during stream playback on Haswell
1472          *   and this can make HW reset converter selection on a pin.
1473          */
1474         if (eld->eld_valid && !old_eld_valid && per_pin->setup) {
1475                 pin_cvt_fixup(codec, per_pin, 0);
1476                 hdmi_setup_audio_infoframe(codec, per_pin, per_pin->non_pcm);
1477         }
1478
1479         if (eld_changed && pcm_idx >= 0)
1480                 snd_ctl_notify(codec->card,
1481                                SNDRV_CTL_EVENT_MASK_VALUE |
1482                                SNDRV_CTL_EVENT_MASK_INFO,
1483                                &get_hdmi_pcm(spec, pcm_idx)->eld_ctl->id);
1484 }
1485
1486 /* update ELD and jack state via HD-audio verbs */
1487 static bool hdmi_present_sense_via_verbs(struct hdmi_spec_per_pin *per_pin,
1488                                          int repoll)
1489 {
1490         struct hda_jack_tbl *jack;
1491         struct hda_codec *codec = per_pin->codec;
1492         struct hdmi_spec *spec = codec->spec;
1493         struct hdmi_eld *eld = &spec->temp_eld;
1494         hda_nid_t pin_nid = per_pin->pin_nid;
1495         /*
1496          * Always execute a GetPinSense verb here, even when called from
1497          * hdmi_intrinsic_event; for some NVIDIA HW, the unsolicited
1498          * response's PD bit is not the real PD value, but indicates that
1499          * the real PD value changed. An older version of the HD-audio
1500          * specification worked this way. Hence, we just ignore the data in
1501          * the unsolicited response to avoid custom WARs.
1502          */
1503         int present;
1504         bool ret;
1505         bool do_repoll = false;
1506
1507         present = snd_hda_pin_sense(codec, pin_nid);
1508
1509         mutex_lock(&per_pin->lock);
1510         eld->monitor_present = !!(present & AC_PINSENSE_PRESENCE);
1511         if (eld->monitor_present)
1512                 eld->eld_valid  = !!(present & AC_PINSENSE_ELDV);
1513         else
1514                 eld->eld_valid = false;
1515
1516         codec_dbg(codec,
1517                 "HDMI status: Codec=%d Pin=%d Presence_Detect=%d ELD_Valid=%d\n",
1518                 codec->addr, pin_nid, eld->monitor_present, eld->eld_valid);
1519
1520         if (eld->eld_valid) {
1521                 if (spec->ops.pin_get_eld(codec, pin_nid, eld->eld_buffer,
1522                                                      &eld->eld_size) < 0)
1523                         eld->eld_valid = false;
1524                 else {
1525                         if (snd_hdmi_parse_eld(codec, &eld->info, eld->eld_buffer,
1526                                                     eld->eld_size) < 0)
1527                                 eld->eld_valid = false;
1528                 }
1529                 if (!eld->eld_valid && repoll)
1530                         do_repoll = true;
1531         }
1532
1533         if (do_repoll)
1534                 schedule_delayed_work(&per_pin->work, msecs_to_jiffies(300));
1535         else
1536                 update_eld(codec, per_pin, eld);
1537
1538         ret = !repoll || !eld->monitor_present || eld->eld_valid;
1539
1540         jack = snd_hda_jack_tbl_get(codec, pin_nid);
1541         if (jack) {
1542                 jack->block_report = !ret;
1543                 jack->pin_sense = (eld->monitor_present && eld->eld_valid) ?
1544                         AC_PINSENSE_PRESENCE : 0;
1545         }
1546         mutex_unlock(&per_pin->lock);
1547         return ret;
1548 }
1549
1550 static struct snd_jack *pin_idx_to_jack(struct hda_codec *codec,
1551                                  struct hdmi_spec_per_pin *per_pin)
1552 {
1553         struct hdmi_spec *spec = codec->spec;
1554         struct snd_jack *jack = NULL;
1555         struct hda_jack_tbl *jack_tbl;
1556
1557         /* if !dyn_pcm_assign, get jack from hda_jack_tbl
1558          * in !dyn_pcm_assign case, spec->pcm_rec[].jack is not
1559          * NULL even after snd_hda_jack_tbl_clear() is called to
1560          * free snd_jack. This may cause access invalid memory
1561          * when calling snd_jack_report
1562          */
1563         if (per_pin->pcm_idx >= 0 && spec->dyn_pcm_assign)
1564                 jack = spec->pcm_rec[per_pin->pcm_idx].jack;
1565         else if (!spec->dyn_pcm_assign) {
1566                 /*
1567                  * jack tbl doesn't support DP MST
1568                  * DP MST will use dyn_pcm_assign,
1569                  * so DP MST will never come here
1570                  */
1571                 jack_tbl = snd_hda_jack_tbl_get(codec, per_pin->pin_nid);
1572                 if (jack_tbl)
1573                         jack = jack_tbl->jack;
1574         }
1575         return jack;
1576 }
1577
1578 /* update ELD and jack state via audio component */
1579 static void sync_eld_via_acomp(struct hda_codec *codec,
1580                                struct hdmi_spec_per_pin *per_pin)
1581 {
1582         struct hdmi_spec *spec = codec->spec;
1583         struct hdmi_eld *eld = &spec->temp_eld;
1584         struct snd_jack *jack = NULL;
1585         int size;
1586
1587         mutex_lock(&per_pin->lock);
1588         eld->monitor_present = false;
1589         size = snd_hdac_acomp_get_eld(&codec->core, per_pin->pin_nid,
1590                                       per_pin->dev_id, &eld->monitor_present,
1591                                       eld->eld_buffer, ELD_MAX_SIZE);
1592         if (size > 0) {
1593                 size = min(size, ELD_MAX_SIZE);
1594                 if (snd_hdmi_parse_eld(codec, &eld->info,
1595                                        eld->eld_buffer, size) < 0)
1596                         size = -EINVAL;
1597         }
1598
1599         if (size > 0) {
1600                 eld->eld_valid = true;
1601                 eld->eld_size = size;
1602         } else {
1603                 eld->eld_valid = false;
1604                 eld->eld_size = 0;
1605         }
1606
1607         /* pcm_idx >=0 before update_eld() means it is in monitor
1608          * disconnected event. Jack must be fetched before update_eld()
1609          */
1610         jack = pin_idx_to_jack(codec, per_pin);
1611         update_eld(codec, per_pin, eld);
1612         if (jack == NULL)
1613                 jack = pin_idx_to_jack(codec, per_pin);
1614         if (jack == NULL)
1615                 goto unlock;
1616         snd_jack_report(jack,
1617                         (eld->monitor_present && eld->eld_valid) ?
1618                                 SND_JACK_AVOUT : 0);
1619  unlock:
1620         mutex_unlock(&per_pin->lock);
1621 }
1622
1623 static bool hdmi_present_sense(struct hdmi_spec_per_pin *per_pin, int repoll)
1624 {
1625         struct hda_codec *codec = per_pin->codec;
1626         int ret;
1627
1628         /* no temporary power up/down needed for component notifier */
1629         if (!codec_has_acomp(codec)) {
1630                 ret = snd_hda_power_up_pm(codec);
1631                 if (ret < 0 && pm_runtime_suspended(hda_codec_dev(codec))) {
1632                         snd_hda_power_down_pm(codec);
1633                         return false;
1634                 }
1635         }
1636
1637         if (codec_has_acomp(codec)) {
1638                 sync_eld_via_acomp(codec, per_pin);
1639                 ret = false; /* don't call snd_hda_jack_report_sync() */
1640         } else {
1641                 ret = hdmi_present_sense_via_verbs(per_pin, repoll);
1642         }
1643
1644         if (!codec_has_acomp(codec))
1645                 snd_hda_power_down_pm(codec);
1646
1647         return ret;
1648 }
1649
1650 static void hdmi_repoll_eld(struct work_struct *work)
1651 {
1652         struct hdmi_spec_per_pin *per_pin =
1653         container_of(to_delayed_work(work), struct hdmi_spec_per_pin, work);
1654         struct hda_codec *codec = per_pin->codec;
1655         struct hdmi_spec *spec = codec->spec;
1656         struct hda_jack_tbl *jack;
1657
1658         jack = snd_hda_jack_tbl_get(codec, per_pin->pin_nid);
1659         if (jack)
1660                 jack->jack_dirty = 1;
1661
1662         if (per_pin->repoll_count++ > 6)
1663                 per_pin->repoll_count = 0;
1664
1665         mutex_lock(&spec->pcm_lock);
1666         if (hdmi_present_sense(per_pin, per_pin->repoll_count))
1667                 snd_hda_jack_report_sync(per_pin->codec);
1668         mutex_unlock(&spec->pcm_lock);
1669 }
1670
1671 static void intel_haswell_fixup_connect_list(struct hda_codec *codec,
1672                                              hda_nid_t nid);
1673
1674 static int hdmi_add_pin(struct hda_codec *codec, hda_nid_t pin_nid)
1675 {
1676         struct hdmi_spec *spec = codec->spec;
1677         unsigned int caps, config;
1678         int pin_idx;
1679         struct hdmi_spec_per_pin *per_pin;
1680         int err;
1681         int dev_num, i;
1682
1683         caps = snd_hda_query_pin_caps(codec, pin_nid);
1684         if (!(caps & (AC_PINCAP_HDMI | AC_PINCAP_DP)))
1685                 return 0;
1686
1687         /*
1688          * For DP MST audio, Configuration Default is the same for
1689          * all device entries on the same pin
1690          */
1691         config = snd_hda_codec_get_pincfg(codec, pin_nid);
1692         if (get_defcfg_connect(config) == AC_JACK_PORT_NONE)
1693                 return 0;
1694
1695         /*
1696          * To simplify the implementation, malloc all
1697          * the virtual pins in the initialization statically
1698          */
1699         if (is_haswell_plus(codec)) {
1700                 /*
1701                  * On Intel platforms, device entries number is
1702                  * changed dynamically. If there is a DP MST
1703                  * hub connected, the device entries number is 3.
1704                  * Otherwise, it is 1.
1705                  * Here we manually set dev_num to 3, so that
1706                  * we can initialize all the device entries when
1707                  * bootup statically.
1708                  */
1709                 dev_num = 3;
1710                 spec->dev_num = 3;
1711         } else if (spec->dyn_pcm_assign && codec->dp_mst) {
1712                 dev_num = snd_hda_get_num_devices(codec, pin_nid) + 1;
1713                 /*
1714                  * spec->dev_num is the maxinum number of device entries
1715                  * among all the pins
1716                  */
1717                 spec->dev_num = (spec->dev_num > dev_num) ?
1718                         spec->dev_num : dev_num;
1719         } else {
1720                 /*
1721                  * If the platform doesn't support DP MST,
1722                  * manually set dev_num to 1. This means
1723                  * the pin has only one device entry.
1724                  */
1725                 dev_num = 1;
1726                 spec->dev_num = 1;
1727         }
1728
1729         for (i = 0; i < dev_num; i++) {
1730                 pin_idx = spec->num_pins;
1731                 per_pin = snd_array_new(&spec->pins);
1732
1733                 if (!per_pin)
1734                         return -ENOMEM;
1735
1736                 if (spec->dyn_pcm_assign) {
1737                         per_pin->pcm = NULL;
1738                         per_pin->pcm_idx = -1;
1739                 } else {
1740                         per_pin->pcm = get_hdmi_pcm(spec, pin_idx);
1741                         per_pin->pcm_idx = pin_idx;
1742                 }
1743                 per_pin->pin_nid = pin_nid;
1744                 per_pin->pin_nid_idx = spec->num_nids;
1745                 per_pin->dev_id = i;
1746                 per_pin->non_pcm = false;
1747                 snd_hda_set_dev_select(codec, pin_nid, i);
1748                 if (is_haswell_plus(codec))
1749                         intel_haswell_fixup_connect_list(codec, pin_nid);
1750                 err = hdmi_read_pin_conn(codec, pin_idx);
1751                 if (err < 0)
1752                         return err;
1753                 spec->num_pins++;
1754         }
1755         spec->num_nids++;
1756
1757         return 0;
1758 }
1759
1760 static int hdmi_add_cvt(struct hda_codec *codec, hda_nid_t cvt_nid)
1761 {
1762         struct hdmi_spec *spec = codec->spec;
1763         struct hdmi_spec_per_cvt *per_cvt;
1764         unsigned int chans;
1765         int err;
1766
1767         chans = get_wcaps(codec, cvt_nid);
1768         chans = get_wcaps_channels(chans);
1769
1770         per_cvt = snd_array_new(&spec->cvts);
1771         if (!per_cvt)
1772                 return -ENOMEM;
1773
1774         per_cvt->cvt_nid = cvt_nid;
1775         per_cvt->channels_min = 2;
1776         if (chans <= 16) {
1777                 per_cvt->channels_max = chans;
1778                 if (chans > spec->chmap.channels_max)
1779                         spec->chmap.channels_max = chans;
1780         }
1781
1782         err = snd_hda_query_supported_pcm(codec, cvt_nid,
1783                                           &per_cvt->rates,
1784                                           &per_cvt->formats,
1785                                           &per_cvt->maxbps);
1786         if (err < 0)
1787                 return err;
1788
1789         if (spec->num_cvts < ARRAY_SIZE(spec->cvt_nids))
1790                 spec->cvt_nids[spec->num_cvts] = cvt_nid;
1791         spec->num_cvts++;
1792
1793         return 0;
1794 }
1795
1796 static int hdmi_parse_codec(struct hda_codec *codec)
1797 {
1798         hda_nid_t nid;
1799         int i, nodes;
1800
1801         nodes = snd_hda_get_sub_nodes(codec, codec->core.afg, &nid);
1802         if (!nid || nodes < 0) {
1803                 codec_warn(codec, "HDMI: failed to get afg sub nodes\n");
1804                 return -EINVAL;
1805         }
1806
1807         for (i = 0; i < nodes; i++, nid++) {
1808                 unsigned int caps;
1809                 unsigned int type;
1810
1811                 caps = get_wcaps(codec, nid);
1812                 type = get_wcaps_type(caps);
1813
1814                 if (!(caps & AC_WCAP_DIGITAL))
1815                         continue;
1816
1817                 switch (type) {
1818                 case AC_WID_AUD_OUT:
1819                         hdmi_add_cvt(codec, nid);
1820                         break;
1821                 case AC_WID_PIN:
1822                         hdmi_add_pin(codec, nid);
1823                         break;
1824                 }
1825         }
1826
1827         return 0;
1828 }
1829
1830 /*
1831  */
1832 static bool check_non_pcm_per_cvt(struct hda_codec *codec, hda_nid_t cvt_nid)
1833 {
1834         struct hda_spdif_out *spdif;
1835         bool non_pcm;
1836
1837         mutex_lock(&codec->spdif_mutex);
1838         spdif = snd_hda_spdif_out_of_nid(codec, cvt_nid);
1839         /* Add sanity check to pass klockwork check.
1840          * This should never happen.
1841          */
1842         if (WARN_ON(spdif == NULL))
1843                 return true;
1844         non_pcm = !!(spdif->status & IEC958_AES0_NONAUDIO);
1845         mutex_unlock(&codec->spdif_mutex);
1846         return non_pcm;
1847 }
1848
1849 /*
1850  * HDMI callbacks
1851  */
1852
1853 static int generic_hdmi_playback_pcm_prepare(struct hda_pcm_stream *hinfo,
1854                                            struct hda_codec *codec,
1855                                            unsigned int stream_tag,
1856                                            unsigned int format,
1857                                            struct snd_pcm_substream *substream)
1858 {
1859         hda_nid_t cvt_nid = hinfo->nid;
1860         struct hdmi_spec *spec = codec->spec;
1861         int pin_idx;
1862         struct hdmi_spec_per_pin *per_pin;
1863         hda_nid_t pin_nid;
1864         struct snd_pcm_runtime *runtime = substream->runtime;
1865         bool non_pcm;
1866         int pinctl, stripe;
1867         int err = 0;
1868
1869         mutex_lock(&spec->pcm_lock);
1870         pin_idx = hinfo_to_pin_index(codec, hinfo);
1871         if (spec->dyn_pcm_assign && pin_idx < 0) {
1872                 /* when dyn_pcm_assign and pcm is not bound to a pin
1873                  * skip pin setup and return 0 to make audio playback
1874                  * be ongoing
1875                  */
1876                 pin_cvt_fixup(codec, NULL, cvt_nid);
1877                 snd_hda_codec_setup_stream(codec, cvt_nid,
1878                                         stream_tag, 0, format);
1879                 goto unlock;
1880         }
1881
1882         if (snd_BUG_ON(pin_idx < 0)) {
1883                 err = -EINVAL;
1884                 goto unlock;
1885         }
1886         per_pin = get_pin(spec, pin_idx);
1887         pin_nid = per_pin->pin_nid;
1888
1889         /* Verify pin:cvt selections to avoid silent audio after S3.
1890          * After S3, the audio driver restores pin:cvt selections
1891          * but this can happen before gfx is ready and such selection
1892          * is overlooked by HW. Thus multiple pins can share a same
1893          * default convertor and mute control will affect each other,
1894          * which can cause a resumed audio playback become silent
1895          * after S3.
1896          */
1897         pin_cvt_fixup(codec, per_pin, 0);
1898
1899         /* Call sync_audio_rate to set the N/CTS/M manually if necessary */
1900         /* Todo: add DP1.2 MST audio support later */
1901         if (codec_has_acomp(codec))
1902                 snd_hdac_sync_audio_rate(&codec->core, pin_nid, per_pin->dev_id,
1903                                          runtime->rate);
1904
1905         non_pcm = check_non_pcm_per_cvt(codec, cvt_nid);
1906         mutex_lock(&per_pin->lock);
1907         per_pin->channels = substream->runtime->channels;
1908         per_pin->setup = true;
1909
1910         if (get_wcaps(codec, cvt_nid) & AC_WCAP_STRIPE) {
1911                 stripe = snd_hdac_get_stream_stripe_ctl(&codec->bus->core,
1912                                                         substream);
1913                 snd_hda_codec_write(codec, cvt_nid, 0,
1914                                     AC_VERB_SET_STRIPE_CONTROL,
1915                                     stripe);
1916         }
1917
1918         hdmi_setup_audio_infoframe(codec, per_pin, non_pcm);
1919         mutex_unlock(&per_pin->lock);
1920         if (spec->dyn_pin_out) {
1921                 pinctl = snd_hda_codec_read(codec, pin_nid, 0,
1922                                             AC_VERB_GET_PIN_WIDGET_CONTROL, 0);
1923                 snd_hda_codec_write(codec, pin_nid, 0,
1924                                     AC_VERB_SET_PIN_WIDGET_CONTROL,
1925                                     pinctl | PIN_OUT);
1926         }
1927
1928         /* snd_hda_set_dev_select() has been called before */
1929         err = spec->ops.setup_stream(codec, cvt_nid, pin_nid,
1930                                  stream_tag, format);
1931  unlock:
1932         mutex_unlock(&spec->pcm_lock);
1933         return err;
1934 }
1935
1936 static int generic_hdmi_playback_pcm_cleanup(struct hda_pcm_stream *hinfo,
1937                                              struct hda_codec *codec,
1938                                              struct snd_pcm_substream *substream)
1939 {
1940         snd_hda_codec_cleanup_stream(codec, hinfo->nid);
1941         return 0;
1942 }
1943
1944 static int hdmi_pcm_close(struct hda_pcm_stream *hinfo,
1945                           struct hda_codec *codec,
1946                           struct snd_pcm_substream *substream)
1947 {
1948         struct hdmi_spec *spec = codec->spec;
1949         int cvt_idx, pin_idx, pcm_idx;
1950         struct hdmi_spec_per_cvt *per_cvt;
1951         struct hdmi_spec_per_pin *per_pin;
1952         int pinctl;
1953         int err = 0;
1954
1955         if (hinfo->nid) {
1956                 pcm_idx = hinfo_to_pcm_index(codec, hinfo);
1957                 if (snd_BUG_ON(pcm_idx < 0))
1958                         return -EINVAL;
1959                 cvt_idx = cvt_nid_to_cvt_index(codec, hinfo->nid);
1960                 if (snd_BUG_ON(cvt_idx < 0))
1961                         return -EINVAL;
1962                 per_cvt = get_cvt(spec, cvt_idx);
1963
1964                 snd_BUG_ON(!per_cvt->assigned);
1965                 per_cvt->assigned = 0;
1966                 hinfo->nid = 0;
1967
1968                 mutex_lock(&spec->pcm_lock);
1969                 snd_hda_spdif_ctls_unassign(codec, pcm_idx);
1970                 clear_bit(pcm_idx, &spec->pcm_in_use);
1971                 pin_idx = hinfo_to_pin_index(codec, hinfo);
1972                 if (spec->dyn_pcm_assign && pin_idx < 0)
1973                         goto unlock;
1974
1975                 if (snd_BUG_ON(pin_idx < 0)) {
1976                         err = -EINVAL;
1977                         goto unlock;
1978                 }
1979                 per_pin = get_pin(spec, pin_idx);
1980
1981                 if (spec->dyn_pin_out) {
1982                         pinctl = snd_hda_codec_read(codec, per_pin->pin_nid, 0,
1983                                         AC_VERB_GET_PIN_WIDGET_CONTROL, 0);
1984                         snd_hda_codec_write(codec, per_pin->pin_nid, 0,
1985                                             AC_VERB_SET_PIN_WIDGET_CONTROL,
1986                                             pinctl & ~PIN_OUT);
1987                 }
1988
1989                 mutex_lock(&per_pin->lock);
1990                 per_pin->chmap_set = false;
1991                 memset(per_pin->chmap, 0, sizeof(per_pin->chmap));
1992
1993                 per_pin->setup = false;
1994                 per_pin->channels = 0;
1995                 mutex_unlock(&per_pin->lock);
1996         unlock:
1997                 mutex_unlock(&spec->pcm_lock);
1998         }
1999
2000         return err;
2001 }
2002
2003 static const struct hda_pcm_ops generic_ops = {
2004         .open = hdmi_pcm_open,
2005         .close = hdmi_pcm_close,
2006         .prepare = generic_hdmi_playback_pcm_prepare,
2007         .cleanup = generic_hdmi_playback_pcm_cleanup,
2008 };
2009
2010 static int hdmi_get_spk_alloc(struct hdac_device *hdac, int pcm_idx)
2011 {
2012         struct hda_codec *codec = container_of(hdac, struct hda_codec, core);
2013         struct hdmi_spec *spec = codec->spec;
2014         struct hdmi_spec_per_pin *per_pin = pcm_idx_to_pin(spec, pcm_idx);
2015
2016         if (!per_pin)
2017                 return 0;
2018
2019         return per_pin->sink_eld.info.spk_alloc;
2020 }
2021
2022 static void hdmi_get_chmap(struct hdac_device *hdac, int pcm_idx,
2023                                         unsigned char *chmap)
2024 {
2025         struct hda_codec *codec = container_of(hdac, struct hda_codec, core);
2026         struct hdmi_spec *spec = codec->spec;
2027         struct hdmi_spec_per_pin *per_pin = pcm_idx_to_pin(spec, pcm_idx);
2028
2029         /* chmap is already set to 0 in caller */
2030         if (!per_pin)
2031                 return;
2032
2033         memcpy(chmap, per_pin->chmap, ARRAY_SIZE(per_pin->chmap));
2034 }
2035
2036 static void hdmi_set_chmap(struct hdac_device *hdac, int pcm_idx,
2037                                 unsigned char *chmap, int prepared)
2038 {
2039         struct hda_codec *codec = container_of(hdac, struct hda_codec, core);
2040         struct hdmi_spec *spec = codec->spec;
2041         struct hdmi_spec_per_pin *per_pin = pcm_idx_to_pin(spec, pcm_idx);
2042
2043         if (!per_pin)
2044                 return;
2045         mutex_lock(&per_pin->lock);
2046         per_pin->chmap_set = true;
2047         memcpy(per_pin->chmap, chmap, ARRAY_SIZE(per_pin->chmap));
2048         if (prepared)
2049                 hdmi_setup_audio_infoframe(codec, per_pin, per_pin->non_pcm);
2050         mutex_unlock(&per_pin->lock);
2051 }
2052
2053 static bool is_hdmi_pcm_attached(struct hdac_device *hdac, int pcm_idx)
2054 {
2055         struct hda_codec *codec = container_of(hdac, struct hda_codec, core);
2056         struct hdmi_spec *spec = codec->spec;
2057         struct hdmi_spec_per_pin *per_pin = pcm_idx_to_pin(spec, pcm_idx);
2058
2059         return per_pin ? true:false;
2060 }
2061
2062 static int generic_hdmi_build_pcms(struct hda_codec *codec)
2063 {
2064         struct hdmi_spec *spec = codec->spec;
2065         int idx;
2066
2067         /*
2068          * for non-mst mode, pcm number is the same as before
2069          * for DP MST mode, pcm number is (nid number + dev_num - 1)
2070          *  dev_num is the device entry number in a pin
2071          *
2072          */
2073         for (idx = 0; idx < spec->num_nids + spec->dev_num - 1; idx++) {
2074                 struct hda_pcm *info;
2075                 struct hda_pcm_stream *pstr;
2076
2077                 info = snd_hda_codec_pcm_new(codec, "HDMI %d", idx);
2078                 if (!info)
2079                         return -ENOMEM;
2080
2081                 spec->pcm_rec[idx].pcm = info;
2082                 spec->pcm_used++;
2083                 info->pcm_type = HDA_PCM_TYPE_HDMI;
2084                 info->own_chmap = true;
2085
2086                 pstr = &info->stream[SNDRV_PCM_STREAM_PLAYBACK];
2087                 pstr->substreams = 1;
2088                 pstr->ops = generic_ops;
2089                 /* pcm number is less than 16 */
2090                 if (spec->pcm_used >= 16)
2091                         break;
2092                 /* other pstr fields are set in open */
2093         }
2094
2095         return 0;
2096 }
2097
2098 static void free_hdmi_jack_priv(struct snd_jack *jack)
2099 {
2100         struct hdmi_pcm *pcm = jack->private_data;
2101
2102         pcm->jack = NULL;
2103 }
2104
2105 static int add_hdmi_jack_kctl(struct hda_codec *codec,
2106                                struct hdmi_spec *spec,
2107                                int pcm_idx,
2108                                const char *name)
2109 {
2110         struct snd_jack *jack;
2111         int err;
2112
2113         err = snd_jack_new(codec->card, name, SND_JACK_AVOUT, &jack,
2114                            true, false);
2115         if (err < 0)
2116                 return err;
2117
2118         spec->pcm_rec[pcm_idx].jack = jack;
2119         jack->private_data = &spec->pcm_rec[pcm_idx];
2120         jack->private_free = free_hdmi_jack_priv;
2121         return 0;
2122 }
2123
2124 static int generic_hdmi_build_jack(struct hda_codec *codec, int pcm_idx)
2125 {
2126         char hdmi_str[32] = "HDMI/DP";
2127         struct hdmi_spec *spec = codec->spec;
2128         struct hdmi_spec_per_pin *per_pin;
2129         struct hda_jack_tbl *jack;
2130         int pcmdev = get_pcm_rec(spec, pcm_idx)->device;
2131         bool phantom_jack;
2132         int ret;
2133
2134         if (pcmdev > 0)
2135                 sprintf(hdmi_str + strlen(hdmi_str), ",pcm=%d", pcmdev);
2136
2137         if (spec->dyn_pcm_assign)
2138                 return add_hdmi_jack_kctl(codec, spec, pcm_idx, hdmi_str);
2139
2140         /* for !dyn_pcm_assign, we still use hda_jack for compatibility */
2141         /* if !dyn_pcm_assign, it must be non-MST mode.
2142          * This means pcms and pins are statically mapped.
2143          * And pcm_idx is pin_idx.
2144          */
2145         per_pin = get_pin(spec, pcm_idx);
2146         phantom_jack = !is_jack_detectable(codec, per_pin->pin_nid);
2147         if (phantom_jack)
2148                 strncat(hdmi_str, " Phantom",
2149                         sizeof(hdmi_str) - strlen(hdmi_str) - 1);
2150         ret = snd_hda_jack_add_kctl(codec, per_pin->pin_nid, hdmi_str,
2151                                     phantom_jack, 0, NULL);
2152         if (ret < 0)
2153                 return ret;
2154         jack = snd_hda_jack_tbl_get(codec, per_pin->pin_nid);
2155         if (jack == NULL)
2156                 return 0;
2157         /* assign jack->jack to pcm_rec[].jack to
2158          * align with dyn_pcm_assign mode
2159          */
2160         spec->pcm_rec[pcm_idx].jack = jack->jack;
2161         return 0;
2162 }
2163
2164 static int generic_hdmi_build_controls(struct hda_codec *codec)
2165 {
2166         struct hdmi_spec *spec = codec->spec;
2167         int dev, err;
2168         int pin_idx, pcm_idx;
2169
2170         for (pcm_idx = 0; pcm_idx < spec->pcm_used; pcm_idx++) {
2171                 if (!get_pcm_rec(spec, pcm_idx)->pcm) {
2172                         /* no PCM: mark this for skipping permanently */
2173                         set_bit(pcm_idx, &spec->pcm_bitmap);
2174                         continue;
2175                 }
2176
2177                 err = generic_hdmi_build_jack(codec, pcm_idx);
2178                 if (err < 0)
2179                         return err;
2180
2181                 /* create the spdif for each pcm
2182                  * pin will be bound when monitor is connected
2183                  */
2184                 if (spec->dyn_pcm_assign)
2185                         err = snd_hda_create_dig_out_ctls(codec,
2186                                           0, spec->cvt_nids[0],
2187                                           HDA_PCM_TYPE_HDMI);
2188                 else {
2189                         struct hdmi_spec_per_pin *per_pin =
2190                                 get_pin(spec, pcm_idx);
2191                         err = snd_hda_create_dig_out_ctls(codec,
2192                                                   per_pin->pin_nid,
2193                                                   per_pin->mux_nids[0],
2194                                                   HDA_PCM_TYPE_HDMI);
2195                 }
2196                 if (err < 0)
2197                         return err;
2198                 snd_hda_spdif_ctls_unassign(codec, pcm_idx);
2199
2200                 dev = get_pcm_rec(spec, pcm_idx)->device;
2201                 if (dev != SNDRV_PCM_INVALID_DEVICE) {
2202                         /* add control for ELD Bytes */
2203                         err = hdmi_create_eld_ctl(codec, pcm_idx, dev);
2204                         if (err < 0)
2205                                 return err;
2206                 }
2207         }
2208
2209         for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
2210                 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
2211
2212                 hdmi_present_sense(per_pin, 0);
2213         }
2214
2215         /* add channel maps */
2216         for (pcm_idx = 0; pcm_idx < spec->pcm_used; pcm_idx++) {
2217                 struct hda_pcm *pcm;
2218
2219                 pcm = get_pcm_rec(spec, pcm_idx);
2220                 if (!pcm || !pcm->pcm)
2221                         break;
2222                 err = snd_hdac_add_chmap_ctls(pcm->pcm, pcm_idx, &spec->chmap);
2223                 if (err < 0)
2224                         return err;
2225         }
2226
2227         return 0;
2228 }
2229
2230 static int generic_hdmi_init_per_pins(struct hda_codec *codec)
2231 {
2232         struct hdmi_spec *spec = codec->spec;
2233         int pin_idx;
2234
2235         for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
2236                 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
2237
2238                 per_pin->codec = codec;
2239                 mutex_init(&per_pin->lock);
2240                 INIT_DELAYED_WORK(&per_pin->work, hdmi_repoll_eld);
2241                 eld_proc_new(per_pin, pin_idx);
2242         }
2243         return 0;
2244 }
2245
2246 static int generic_hdmi_init(struct hda_codec *codec)
2247 {
2248         struct hdmi_spec *spec = codec->spec;
2249         int pin_idx;
2250
2251         for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
2252                 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
2253                 hda_nid_t pin_nid = per_pin->pin_nid;
2254                 int dev_id = per_pin->dev_id;
2255
2256                 snd_hda_set_dev_select(codec, pin_nid, dev_id);
2257                 hdmi_init_pin(codec, pin_nid);
2258                 if (!codec_has_acomp(codec))
2259                         snd_hda_jack_detect_enable_callback(codec, pin_nid,
2260                                 codec->jackpoll_interval > 0 ?
2261                                 jack_callback : NULL);
2262         }
2263         return 0;
2264 }
2265
2266 static void hdmi_array_init(struct hdmi_spec *spec, int nums)
2267 {
2268         snd_array_init(&spec->pins, sizeof(struct hdmi_spec_per_pin), nums);
2269         snd_array_init(&spec->cvts, sizeof(struct hdmi_spec_per_cvt), nums);
2270 }
2271
2272 static void hdmi_array_free(struct hdmi_spec *spec)
2273 {
2274         snd_array_free(&spec->pins);
2275         snd_array_free(&spec->cvts);
2276 }
2277
2278 static void generic_spec_free(struct hda_codec *codec)
2279 {
2280         struct hdmi_spec *spec = codec->spec;
2281
2282         if (spec) {
2283                 hdmi_array_free(spec);
2284                 kfree(spec);
2285                 codec->spec = NULL;
2286         }
2287         codec->dp_mst = false;
2288 }
2289
2290 static void generic_hdmi_free(struct hda_codec *codec)
2291 {
2292         struct hdmi_spec *spec = codec->spec;
2293         int pin_idx, pcm_idx;
2294
2295         if (codec_has_acomp(codec))
2296                 snd_hdac_acomp_register_notifier(&codec->bus->core, NULL);
2297
2298         for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
2299                 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
2300                 cancel_delayed_work_sync(&per_pin->work);
2301                 eld_proc_free(per_pin);
2302         }
2303
2304         for (pcm_idx = 0; pcm_idx < spec->pcm_used; pcm_idx++) {
2305                 if (spec->pcm_rec[pcm_idx].jack == NULL)
2306                         continue;
2307                 if (spec->dyn_pcm_assign)
2308                         snd_device_free(codec->card,
2309                                         spec->pcm_rec[pcm_idx].jack);
2310                 else
2311                         spec->pcm_rec[pcm_idx].jack = NULL;
2312         }
2313
2314         generic_spec_free(codec);
2315 }
2316
2317 #ifdef CONFIG_PM
2318 static int generic_hdmi_resume(struct hda_codec *codec)
2319 {
2320         struct hdmi_spec *spec = codec->spec;
2321         int pin_idx;
2322
2323         codec->patch_ops.init(codec);
2324         regcache_sync(codec->core.regmap);
2325
2326         for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
2327                 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
2328                 hdmi_present_sense(per_pin, 1);
2329         }
2330         return 0;
2331 }
2332 #endif
2333
2334 static const struct hda_codec_ops generic_hdmi_patch_ops = {
2335         .init                   = generic_hdmi_init,
2336         .free                   = generic_hdmi_free,
2337         .build_pcms             = generic_hdmi_build_pcms,
2338         .build_controls         = generic_hdmi_build_controls,
2339         .unsol_event            = hdmi_unsol_event,
2340 #ifdef CONFIG_PM
2341         .resume                 = generic_hdmi_resume,
2342 #endif
2343 };
2344
2345 static const struct hdmi_ops generic_standard_hdmi_ops = {
2346         .pin_get_eld                            = snd_hdmi_get_eld,
2347         .pin_setup_infoframe                    = hdmi_pin_setup_infoframe,
2348         .pin_hbr_setup                          = hdmi_pin_hbr_setup,
2349         .setup_stream                           = hdmi_setup_stream,
2350 };
2351
2352 /* allocate codec->spec and assign/initialize generic parser ops */
2353 static int alloc_generic_hdmi(struct hda_codec *codec)
2354 {
2355         struct hdmi_spec *spec;
2356
2357         spec = kzalloc(sizeof(*spec), GFP_KERNEL);
2358         if (!spec)
2359                 return -ENOMEM;
2360
2361         spec->ops = generic_standard_hdmi_ops;
2362         spec->dev_num = 1;      /* initialize to 1 */
2363         mutex_init(&spec->pcm_lock);
2364         snd_hdac_register_chmap_ops(&codec->core, &spec->chmap);
2365
2366         spec->chmap.ops.get_chmap = hdmi_get_chmap;
2367         spec->chmap.ops.set_chmap = hdmi_set_chmap;
2368         spec->chmap.ops.is_pcm_attached = is_hdmi_pcm_attached;
2369         spec->chmap.ops.get_spk_alloc = hdmi_get_spk_alloc,
2370
2371         codec->spec = spec;
2372         hdmi_array_init(spec, 4);
2373
2374         codec->patch_ops = generic_hdmi_patch_ops;
2375
2376         return 0;
2377 }
2378
2379 /* generic HDMI parser */
2380 static int patch_generic_hdmi(struct hda_codec *codec)
2381 {
2382         int err;
2383
2384         err = alloc_generic_hdmi(codec);
2385         if (err < 0)
2386                 return err;
2387
2388         err = hdmi_parse_codec(codec);
2389         if (err < 0) {
2390                 generic_spec_free(codec);
2391                 return err;
2392         }
2393
2394         generic_hdmi_init_per_pins(codec);
2395         return 0;
2396 }
2397
2398 /*
2399  * Intel codec parsers and helpers
2400  */
2401
2402 static void intel_haswell_fixup_connect_list(struct hda_codec *codec,
2403                                              hda_nid_t nid)
2404 {
2405         struct hdmi_spec *spec = codec->spec;
2406         hda_nid_t conns[4];
2407         int nconns;
2408
2409         nconns = snd_hda_get_connections(codec, nid, conns, ARRAY_SIZE(conns));
2410         if (nconns == spec->num_cvts &&
2411             !memcmp(conns, spec->cvt_nids, spec->num_cvts * sizeof(hda_nid_t)))
2412                 return;
2413
2414         /* override pins connection list */
2415         codec_dbg(codec, "hdmi: haswell: override pin connection 0x%x\n", nid);
2416         snd_hda_override_conn_list(codec, nid, spec->num_cvts, spec->cvt_nids);
2417 }
2418
2419 #define INTEL_GET_VENDOR_VERB   0xf81
2420 #define INTEL_GET_VENDOR_VERB   0xf81
2421 #define INTEL_SET_VENDOR_VERB   0x781
2422 #define INTEL_EN_DP12           0x02    /* enable DP 1.2 features */
2423 #define INTEL_EN_ALL_PIN_CVTS   0x01    /* enable 2nd & 3rd pins and convertors */
2424
2425 static void intel_haswell_enable_all_pins(struct hda_codec *codec,
2426                                           bool update_tree)
2427 {
2428         unsigned int vendor_param;
2429         struct hdmi_spec *spec = codec->spec;
2430
2431         vendor_param = snd_hda_codec_read(codec, spec->vendor_nid, 0,
2432                                 INTEL_GET_VENDOR_VERB, 0);
2433         if (vendor_param == -1 || vendor_param & INTEL_EN_ALL_PIN_CVTS)
2434                 return;
2435
2436         vendor_param |= INTEL_EN_ALL_PIN_CVTS;
2437         vendor_param = snd_hda_codec_read(codec, spec->vendor_nid, 0,
2438                                 INTEL_SET_VENDOR_VERB, vendor_param);
2439         if (vendor_param == -1)
2440                 return;
2441
2442         if (update_tree)
2443                 snd_hda_codec_update_widgets(codec);
2444 }
2445
2446 static void intel_haswell_fixup_enable_dp12(struct hda_codec *codec)
2447 {
2448         unsigned int vendor_param;
2449         struct hdmi_spec *spec = codec->spec;
2450
2451         vendor_param = snd_hda_codec_read(codec, spec->vendor_nid, 0,
2452                                 INTEL_GET_VENDOR_VERB, 0);
2453         if (vendor_param == -1 || vendor_param & INTEL_EN_DP12)
2454                 return;
2455
2456         /* enable DP1.2 mode */
2457         vendor_param |= INTEL_EN_DP12;
2458         snd_hdac_regmap_add_vendor_verb(&codec->core, INTEL_SET_VENDOR_VERB);
2459         snd_hda_codec_write_cache(codec, spec->vendor_nid, 0,
2460                                 INTEL_SET_VENDOR_VERB, vendor_param);
2461 }
2462
2463 /* Haswell needs to re-issue the vendor-specific verbs before turning to D0.
2464  * Otherwise you may get severe h/w communication errors.
2465  */
2466 static void haswell_set_power_state(struct hda_codec *codec, hda_nid_t fg,
2467                                 unsigned int power_state)
2468 {
2469         if (power_state == AC_PWRST_D0) {
2470                 intel_haswell_enable_all_pins(codec, false);
2471                 intel_haswell_fixup_enable_dp12(codec);
2472         }
2473
2474         snd_hda_codec_read(codec, fg, 0, AC_VERB_SET_POWER_STATE, power_state);
2475         snd_hda_codec_set_power_to_all(codec, fg, power_state);
2476 }
2477
2478 /* There is a fixed mapping between audio pin node and display port.
2479  * on SNB, IVY, HSW, BSW, SKL, BXT, KBL:
2480  * Pin Widget 5 - PORT B (port = 1 in i915 driver)
2481  * Pin Widget 6 - PORT C (port = 2 in i915 driver)
2482  * Pin Widget 7 - PORT D (port = 3 in i915 driver)
2483  *
2484  * on VLV, ILK:
2485  * Pin Widget 4 - PORT B (port = 1 in i915 driver)
2486  * Pin Widget 5 - PORT C (port = 2 in i915 driver)
2487  * Pin Widget 6 - PORT D (port = 3 in i915 driver)
2488  */
2489 static int intel_base_nid(struct hda_codec *codec)
2490 {
2491         switch (codec->core.vendor_id) {
2492         case 0x80860054: /* ILK */
2493         case 0x80862804: /* ILK */
2494         case 0x80862882: /* VLV */
2495                 return 4;
2496         default:
2497                 return 5;
2498         }
2499 }
2500
2501 static int intel_pin2port(void *audio_ptr, int pin_nid)
2502 {
2503         struct hda_codec *codec = audio_ptr;
2504         struct hdmi_spec *spec = codec->spec;
2505         int base_nid, i;
2506
2507         if (!spec->port_num) {
2508                 base_nid = intel_base_nid(codec);
2509                 if (WARN_ON(pin_nid < base_nid || pin_nid >= base_nid + 3))
2510                         return -1;
2511                 return pin_nid - base_nid + 1; /* intel port is 1-based */
2512         }
2513
2514         /*
2515          * looking for the pin number in the mapping table and return
2516          * the index which indicate the port number
2517          */
2518         for (i = 0; i < spec->port_num; i++) {
2519                 if (pin_nid == spec->port_map[i])
2520                         return i + 1;
2521         }
2522
2523         /* return -1 if pin number exceeds our expectation */
2524         codec_info(codec, "Can't find the HDMI/DP port for pin %d\n", pin_nid);
2525         return -1;
2526 }
2527
2528 static void intel_pin_eld_notify(void *audio_ptr, int port, int pipe)
2529 {
2530         struct hda_codec *codec = audio_ptr;
2531         int pin_nid;
2532         int dev_id = pipe;
2533
2534         /* we assume only from port-B to port-D */
2535         if (port < 1 || port > 3)
2536                 return;
2537
2538         pin_nid = port + intel_base_nid(codec) - 1; /* intel port is 1-based */
2539
2540         /* skip notification during system suspend (but not in runtime PM);
2541          * the state will be updated at resume
2542          */
2543         if (snd_power_get_state(codec->card) != SNDRV_CTL_POWER_D0)
2544                 return;
2545         /* ditto during suspend/resume process itself */
2546         if (snd_hdac_is_in_pm(&codec->core))
2547                 return;
2548
2549         snd_hdac_i915_set_bclk(&codec->bus->core);
2550         check_presence_and_report(codec, pin_nid, dev_id);
2551 }
2552
2553 /* register i915 component pin_eld_notify callback */
2554 static void register_i915_notifier(struct hda_codec *codec)
2555 {
2556         struct hdmi_spec *spec = codec->spec;
2557
2558         spec->use_acomp_notifier = true;
2559         spec->drm_audio_ops.audio_ptr = codec;
2560         /* intel_audio_codec_enable() or intel_audio_codec_disable()
2561          * will call pin_eld_notify with using audio_ptr pointer
2562          * We need make sure audio_ptr is really setup
2563          */
2564         wmb();
2565         spec->drm_audio_ops.pin2port = intel_pin2port;
2566         spec->drm_audio_ops.pin_eld_notify = intel_pin_eld_notify;
2567         snd_hdac_acomp_register_notifier(&codec->bus->core,
2568                                         &spec->drm_audio_ops);
2569 }
2570
2571 /* setup_stream ops override for HSW+ */
2572 static int i915_hsw_setup_stream(struct hda_codec *codec, hda_nid_t cvt_nid,
2573                                  hda_nid_t pin_nid, u32 stream_tag, int format)
2574 {
2575         haswell_verify_D0(codec, cvt_nid, pin_nid);
2576         return hdmi_setup_stream(codec, cvt_nid, pin_nid, stream_tag, format);
2577 }
2578
2579 /* pin_cvt_fixup ops override for HSW+ and VLV+ */
2580 static void i915_pin_cvt_fixup(struct hda_codec *codec,
2581                                struct hdmi_spec_per_pin *per_pin,
2582                                hda_nid_t cvt_nid)
2583 {
2584         if (per_pin) {
2585                 snd_hda_set_dev_select(codec, per_pin->pin_nid,
2586                                per_pin->dev_id);
2587                 intel_verify_pin_cvt_connect(codec, per_pin);
2588                 intel_not_share_assigned_cvt(codec, per_pin->pin_nid,
2589                                      per_pin->dev_id, per_pin->mux_idx);
2590         } else {
2591                 intel_not_share_assigned_cvt_nid(codec, 0, 0, cvt_nid);
2592         }
2593 }
2594
2595 /* precondition and allocation for Intel codecs */
2596 static int alloc_intel_hdmi(struct hda_codec *codec)
2597 {
2598         /* requires i915 binding */
2599         if (!codec->bus->core.audio_component) {
2600                 codec_info(codec, "No i915 binding for Intel HDMI/DP codec\n");
2601                 /* set probe_id here to prevent generic fallback binding */
2602                 codec->probe_id = HDA_CODEC_ID_SKIP_PROBE;
2603                 return -ENODEV;
2604         }
2605
2606         return alloc_generic_hdmi(codec);
2607 }
2608
2609 /* parse and post-process for Intel codecs */
2610 static int parse_intel_hdmi(struct hda_codec *codec)
2611 {
2612         int err;
2613
2614         err = hdmi_parse_codec(codec);
2615         if (err < 0) {
2616                 generic_spec_free(codec);
2617                 return err;
2618         }
2619
2620         generic_hdmi_init_per_pins(codec);
2621         register_i915_notifier(codec);
2622         return 0;
2623 }
2624
2625 /* Intel Haswell and onwards; audio component with eld notifier */
2626 static int intel_hsw_common_init(struct hda_codec *codec, hda_nid_t vendor_nid,
2627                                  const int *port_map, int port_num)
2628 {
2629         struct hdmi_spec *spec;
2630         int err;
2631
2632         err = alloc_intel_hdmi(codec);
2633         if (err < 0)
2634                 return err;
2635         spec = codec->spec;
2636         codec->dp_mst = true;
2637         spec->dyn_pcm_assign = true;
2638         spec->vendor_nid = vendor_nid;
2639         spec->port_map = port_map;
2640         spec->port_num = port_num;
2641
2642         intel_haswell_enable_all_pins(codec, true);
2643         intel_haswell_fixup_enable_dp12(codec);
2644
2645         codec->display_power_control = 1;
2646
2647         codec->patch_ops.set_power_state = haswell_set_power_state;
2648         codec->depop_delay = 0;
2649         codec->auto_runtime_pm = 1;
2650
2651         spec->ops.setup_stream = i915_hsw_setup_stream;
2652         spec->ops.pin_cvt_fixup = i915_pin_cvt_fixup;
2653
2654         return parse_intel_hdmi(codec);
2655 }
2656
2657 static int patch_i915_hsw_hdmi(struct hda_codec *codec)
2658 {
2659         return intel_hsw_common_init(codec, 0x08, NULL, 0);
2660 }
2661
2662 static int patch_i915_glk_hdmi(struct hda_codec *codec)
2663 {
2664         return intel_hsw_common_init(codec, 0x0b, NULL, 0);
2665 }
2666
2667 static int patch_i915_icl_hdmi(struct hda_codec *codec)
2668 {
2669         /*
2670          * pin to port mapping table where the value indicate the pin number and
2671          * the index indicate the port number with 1 base.
2672          */
2673         static const int map[] = {0x4, 0x6, 0x8, 0xa, 0xb};
2674
2675         return intel_hsw_common_init(codec, 0x02, map, ARRAY_SIZE(map));
2676 }
2677
2678 /* Intel Baytrail and Braswell; with eld notifier */
2679 static int patch_i915_byt_hdmi(struct hda_codec *codec)
2680 {
2681         struct hdmi_spec *spec;
2682         int err;
2683
2684         err = alloc_intel_hdmi(codec);
2685         if (err < 0)
2686                 return err;
2687         spec = codec->spec;
2688
2689         /* For Valleyview/Cherryview, only the display codec is in the display
2690          * power well and can use link_power ops to request/release the power.
2691          */
2692         codec->display_power_control = 1;
2693
2694         codec->depop_delay = 0;
2695         codec->auto_runtime_pm = 1;
2696
2697         spec->ops.pin_cvt_fixup = i915_pin_cvt_fixup;
2698
2699         return parse_intel_hdmi(codec);
2700 }
2701
2702 /* Intel IronLake, SandyBridge and IvyBridge; with eld notifier */
2703 static int patch_i915_cpt_hdmi(struct hda_codec *codec)
2704 {
2705         int err;
2706
2707         err = alloc_intel_hdmi(codec);
2708         if (err < 0)
2709                 return err;
2710         return parse_intel_hdmi(codec);
2711 }
2712
2713 /*
2714  * Shared non-generic implementations
2715  */
2716
2717 static int simple_playback_build_pcms(struct hda_codec *codec)
2718 {
2719         struct hdmi_spec *spec = codec->spec;
2720         struct hda_pcm *info;
2721         unsigned int chans;
2722         struct hda_pcm_stream *pstr;
2723         struct hdmi_spec_per_cvt *per_cvt;
2724
2725         per_cvt = get_cvt(spec, 0);
2726         chans = get_wcaps(codec, per_cvt->cvt_nid);
2727         chans = get_wcaps_channels(chans);
2728
2729         info = snd_hda_codec_pcm_new(codec, "HDMI 0");
2730         if (!info)
2731                 return -ENOMEM;
2732         spec->pcm_rec[0].pcm = info;
2733         info->pcm_type = HDA_PCM_TYPE_HDMI;
2734         pstr = &info->stream[SNDRV_PCM_STREAM_PLAYBACK];
2735         *pstr = spec->pcm_playback;
2736         pstr->nid = per_cvt->cvt_nid;
2737         if (pstr->channels_max <= 2 && chans && chans <= 16)
2738                 pstr->channels_max = chans;
2739
2740         return 0;
2741 }
2742
2743 /* unsolicited event for jack sensing */
2744 static void simple_hdmi_unsol_event(struct hda_codec *codec,
2745                                     unsigned int res)
2746 {
2747         snd_hda_jack_set_dirty_all(codec);
2748         snd_hda_jack_report_sync(codec);
2749 }
2750
2751 /* generic_hdmi_build_jack can be used for simple_hdmi, too,
2752  * as long as spec->pins[] is set correctly
2753  */
2754 #define simple_hdmi_build_jack  generic_hdmi_build_jack
2755
2756 static int simple_playback_build_controls(struct hda_codec *codec)
2757 {
2758         struct hdmi_spec *spec = codec->spec;
2759         struct hdmi_spec_per_cvt *per_cvt;
2760         int err;
2761
2762         per_cvt = get_cvt(spec, 0);
2763         err = snd_hda_create_dig_out_ctls(codec, per_cvt->cvt_nid,
2764                                           per_cvt->cvt_nid,
2765                                           HDA_PCM_TYPE_HDMI);
2766         if (err < 0)
2767                 return err;
2768         return simple_hdmi_build_jack(codec, 0);
2769 }
2770
2771 static int simple_playback_init(struct hda_codec *codec)
2772 {
2773         struct hdmi_spec *spec = codec->spec;
2774         struct hdmi_spec_per_pin *per_pin = get_pin(spec, 0);
2775         hda_nid_t pin = per_pin->pin_nid;
2776
2777         snd_hda_codec_write(codec, pin, 0,
2778                             AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT);
2779         /* some codecs require to unmute the pin */
2780         if (get_wcaps(codec, pin) & AC_WCAP_OUT_AMP)
2781                 snd_hda_codec_write(codec, pin, 0, AC_VERB_SET_AMP_GAIN_MUTE,
2782                                     AMP_OUT_UNMUTE);
2783         snd_hda_jack_detect_enable(codec, pin);
2784         return 0;
2785 }
2786
2787 static void simple_playback_free(struct hda_codec *codec)
2788 {
2789         struct hdmi_spec *spec = codec->spec;
2790
2791         hdmi_array_free(spec);
2792         kfree(spec);
2793 }
2794
2795 /*
2796  * Nvidia specific implementations
2797  */
2798
2799 #define Nv_VERB_SET_Channel_Allocation          0xF79
2800 #define Nv_VERB_SET_Info_Frame_Checksum         0xF7A
2801 #define Nv_VERB_SET_Audio_Protection_On         0xF98
2802 #define Nv_VERB_SET_Audio_Protection_Off        0xF99
2803
2804 #define nvhdmi_master_con_nid_7x        0x04
2805 #define nvhdmi_master_pin_nid_7x        0x05
2806
2807 static const hda_nid_t nvhdmi_con_nids_7x[4] = {
2808         /*front, rear, clfe, rear_surr */
2809         0x6, 0x8, 0xa, 0xc,
2810 };
2811
2812 static const struct hda_verb nvhdmi_basic_init_7x_2ch[] = {
2813         /* set audio protect on */
2814         { 0x1, Nv_VERB_SET_Audio_Protection_On, 0x1},
2815         /* enable digital output on pin widget */
2816         { 0x5, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 },
2817         {} /* terminator */
2818 };
2819
2820 static const struct hda_verb nvhdmi_basic_init_7x_8ch[] = {
2821         /* set audio protect on */
2822         { 0x1, Nv_VERB_SET_Audio_Protection_On, 0x1},
2823         /* enable digital output on pin widget */
2824         { 0x5, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 },
2825         { 0x7, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 },
2826         { 0x9, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 },
2827         { 0xb, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 },
2828         { 0xd, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 },
2829         {} /* terminator */
2830 };
2831
2832 #ifdef LIMITED_RATE_FMT_SUPPORT
2833 /* support only the safe format and rate */
2834 #define SUPPORTED_RATES         SNDRV_PCM_RATE_48000
2835 #define SUPPORTED_MAXBPS        16
2836 #define SUPPORTED_FORMATS       SNDRV_PCM_FMTBIT_S16_LE
2837 #else
2838 /* support all rates and formats */
2839 #define SUPPORTED_RATES \
2840         (SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |\
2841         SNDRV_PCM_RATE_88200 | SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |\
2842          SNDRV_PCM_RATE_192000)
2843 #define SUPPORTED_MAXBPS        24
2844 #define SUPPORTED_FORMATS \
2845         (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S32_LE)
2846 #endif
2847
2848 static int nvhdmi_7x_init_2ch(struct hda_codec *codec)
2849 {
2850         snd_hda_sequence_write(codec, nvhdmi_basic_init_7x_2ch);
2851         return 0;
2852 }
2853
2854 static int nvhdmi_7x_init_8ch(struct hda_codec *codec)
2855 {
2856         snd_hda_sequence_write(codec, nvhdmi_basic_init_7x_8ch);
2857         return 0;
2858 }
2859
2860 static const unsigned int channels_2_6_8[] = {
2861         2, 6, 8
2862 };
2863
2864 static const unsigned int channels_2_8[] = {
2865         2, 8
2866 };
2867
2868 static const struct snd_pcm_hw_constraint_list hw_constraints_2_6_8_channels = {
2869         .count = ARRAY_SIZE(channels_2_6_8),
2870         .list = channels_2_6_8,
2871         .mask = 0,
2872 };
2873
2874 static const struct snd_pcm_hw_constraint_list hw_constraints_2_8_channels = {
2875         .count = ARRAY_SIZE(channels_2_8),
2876         .list = channels_2_8,
2877         .mask = 0,
2878 };
2879
2880 static int simple_playback_pcm_open(struct hda_pcm_stream *hinfo,
2881                                     struct hda_codec *codec,
2882                                     struct snd_pcm_substream *substream)
2883 {
2884         struct hdmi_spec *spec = codec->spec;
2885         const struct snd_pcm_hw_constraint_list *hw_constraints_channels = NULL;
2886
2887         switch (codec->preset->vendor_id) {
2888         case 0x10de0002:
2889         case 0x10de0003:
2890         case 0x10de0005:
2891         case 0x10de0006:
2892                 hw_constraints_channels = &hw_constraints_2_8_channels;
2893                 break;
2894         case 0x10de0007:
2895                 hw_constraints_channels = &hw_constraints_2_6_8_channels;
2896                 break;
2897         default:
2898                 break;
2899         }
2900
2901         if (hw_constraints_channels != NULL) {
2902                 snd_pcm_hw_constraint_list(substream->runtime, 0,
2903                                 SNDRV_PCM_HW_PARAM_CHANNELS,
2904                                 hw_constraints_channels);
2905         } else {
2906                 snd_pcm_hw_constraint_step(substream->runtime, 0,
2907                                            SNDRV_PCM_HW_PARAM_CHANNELS, 2);
2908         }
2909
2910         return snd_hda_multi_out_dig_open(codec, &spec->multiout);
2911 }
2912
2913 static int simple_playback_pcm_close(struct hda_pcm_stream *hinfo,
2914                                      struct hda_codec *codec,
2915                                      struct snd_pcm_substream *substream)
2916 {
2917         struct hdmi_spec *spec = codec->spec;
2918         return snd_hda_multi_out_dig_close(codec, &spec->multiout);
2919 }
2920
2921 static int simple_playback_pcm_prepare(struct hda_pcm_stream *hinfo,
2922                                        struct hda_codec *codec,
2923                                        unsigned int stream_tag,
2924                                        unsigned int format,
2925                                        struct snd_pcm_substream *substream)
2926 {
2927         struct hdmi_spec *spec = codec->spec;
2928         return snd_hda_multi_out_dig_prepare(codec, &spec->multiout,
2929                                              stream_tag, format, substream);
2930 }
2931
2932 static const struct hda_pcm_stream simple_pcm_playback = {
2933         .substreams = 1,
2934         .channels_min = 2,
2935         .channels_max = 2,
2936         .ops = {
2937                 .open = simple_playback_pcm_open,
2938                 .close = simple_playback_pcm_close,
2939                 .prepare = simple_playback_pcm_prepare
2940         },
2941 };
2942
2943 static const struct hda_codec_ops simple_hdmi_patch_ops = {
2944         .build_controls = simple_playback_build_controls,
2945         .build_pcms = simple_playback_build_pcms,
2946         .init = simple_playback_init,
2947         .free = simple_playback_free,
2948         .unsol_event = simple_hdmi_unsol_event,
2949 };
2950
2951 static int patch_simple_hdmi(struct hda_codec *codec,
2952                              hda_nid_t cvt_nid, hda_nid_t pin_nid)
2953 {
2954         struct hdmi_spec *spec;
2955         struct hdmi_spec_per_cvt *per_cvt;
2956         struct hdmi_spec_per_pin *per_pin;
2957
2958         spec = kzalloc(sizeof(*spec), GFP_KERNEL);
2959         if (!spec)
2960                 return -ENOMEM;
2961
2962         codec->spec = spec;
2963         hdmi_array_init(spec, 1);
2964
2965         spec->multiout.num_dacs = 0;  /* no analog */
2966         spec->multiout.max_channels = 2;
2967         spec->multiout.dig_out_nid = cvt_nid;
2968         spec->num_cvts = 1;
2969         spec->num_pins = 1;
2970         per_pin = snd_array_new(&spec->pins);
2971         per_cvt = snd_array_new(&spec->cvts);
2972         if (!per_pin || !per_cvt) {
2973                 simple_playback_free(codec);
2974                 return -ENOMEM;
2975         }
2976         per_cvt->cvt_nid = cvt_nid;
2977         per_pin->pin_nid = pin_nid;
2978         spec->pcm_playback = simple_pcm_playback;
2979
2980         codec->patch_ops = simple_hdmi_patch_ops;
2981
2982         return 0;
2983 }
2984
2985 static void nvhdmi_8ch_7x_set_info_frame_parameters(struct hda_codec *codec,
2986                                                     int channels)
2987 {
2988         unsigned int chanmask;
2989         int chan = channels ? (channels - 1) : 1;
2990
2991         switch (channels) {
2992         default:
2993         case 0:
2994         case 2:
2995                 chanmask = 0x00;
2996                 break;
2997         case 4:
2998                 chanmask = 0x08;
2999                 break;
3000         case 6:
3001                 chanmask = 0x0b;
3002                 break;
3003         case 8:
3004                 chanmask = 0x13;
3005                 break;
3006         }
3007
3008         /* Set the audio infoframe channel allocation and checksum fields.  The
3009          * channel count is computed implicitly by the hardware. */
3010         snd_hda_codec_write(codec, 0x1, 0,
3011                         Nv_VERB_SET_Channel_Allocation, chanmask);
3012
3013         snd_hda_codec_write(codec, 0x1, 0,
3014                         Nv_VERB_SET_Info_Frame_Checksum,
3015                         (0x71 - chan - chanmask));
3016 }
3017
3018 static int nvhdmi_8ch_7x_pcm_close(struct hda_pcm_stream *hinfo,
3019                                    struct hda_codec *codec,
3020                                    struct snd_pcm_substream *substream)
3021 {
3022         struct hdmi_spec *spec = codec->spec;
3023         int i;
3024
3025         snd_hda_codec_write(codec, nvhdmi_master_con_nid_7x,
3026                         0, AC_VERB_SET_CHANNEL_STREAMID, 0);
3027         for (i = 0; i < 4; i++) {
3028                 /* set the stream id */
3029                 snd_hda_codec_write(codec, nvhdmi_con_nids_7x[i], 0,
3030                                 AC_VERB_SET_CHANNEL_STREAMID, 0);
3031                 /* set the stream format */
3032                 snd_hda_codec_write(codec, nvhdmi_con_nids_7x[i], 0,
3033                                 AC_VERB_SET_STREAM_FORMAT, 0);
3034         }
3035
3036         /* The audio hardware sends a channel count of 0x7 (8ch) when all the
3037          * streams are disabled. */
3038         nvhdmi_8ch_7x_set_info_frame_parameters(codec, 8);
3039
3040         return snd_hda_multi_out_dig_close(codec, &spec->multiout);
3041 }
3042
3043 static int nvhdmi_8ch_7x_pcm_prepare(struct hda_pcm_stream *hinfo,
3044                                      struct hda_codec *codec,
3045                                      unsigned int stream_tag,
3046                                      unsigned int format,
3047                                      struct snd_pcm_substream *substream)
3048 {
3049         int chs;
3050         unsigned int dataDCC2, channel_id;
3051         int i;
3052         struct hdmi_spec *spec = codec->spec;
3053         struct hda_spdif_out *spdif;
3054         struct hdmi_spec_per_cvt *per_cvt;
3055
3056         mutex_lock(&codec->spdif_mutex);
3057         per_cvt = get_cvt(spec, 0);
3058         spdif = snd_hda_spdif_out_of_nid(codec, per_cvt->cvt_nid);
3059
3060         chs = substream->runtime->channels;
3061
3062         dataDCC2 = 0x2;
3063
3064         /* turn off SPDIF once; otherwise the IEC958 bits won't be updated */
3065         if (codec->spdif_status_reset && (spdif->ctls & AC_DIG1_ENABLE))
3066                 snd_hda_codec_write(codec,
3067                                 nvhdmi_master_con_nid_7x,
3068                                 0,
3069                                 AC_VERB_SET_DIGI_CONVERT_1,
3070                                 spdif->ctls & ~AC_DIG1_ENABLE & 0xff);
3071
3072         /* set the stream id */
3073         snd_hda_codec_write(codec, nvhdmi_master_con_nid_7x, 0,
3074                         AC_VERB_SET_CHANNEL_STREAMID, (stream_tag << 4) | 0x0);
3075
3076         /* set the stream format */
3077         snd_hda_codec_write(codec, nvhdmi_master_con_nid_7x, 0,
3078                         AC_VERB_SET_STREAM_FORMAT, format);
3079
3080         /* turn on again (if needed) */
3081         /* enable and set the channel status audio/data flag */
3082         if (codec->spdif_status_reset && (spdif->ctls & AC_DIG1_ENABLE)) {
3083                 snd_hda_codec_write(codec,
3084                                 nvhdmi_master_con_nid_7x,
3085                                 0,
3086                                 AC_VERB_SET_DIGI_CONVERT_1,
3087                                 spdif->ctls & 0xff);
3088                 snd_hda_codec_write(codec,
3089                                 nvhdmi_master_con_nid_7x,
3090                                 0,
3091                                 AC_VERB_SET_DIGI_CONVERT_2, dataDCC2);
3092         }
3093
3094         for (i = 0; i < 4; i++) {
3095                 if (chs == 2)
3096                         channel_id = 0;
3097                 else
3098                         channel_id = i * 2;
3099
3100                 /* turn off SPDIF once;
3101                  *otherwise the IEC958 bits won't be updated
3102                  */
3103                 if (codec->spdif_status_reset &&
3104                 (spdif->ctls & AC_DIG1_ENABLE))
3105                         snd_hda_codec_write(codec,
3106                                 nvhdmi_con_nids_7x[i],
3107                                 0,
3108                                 AC_VERB_SET_DIGI_CONVERT_1,
3109                                 spdif->ctls & ~AC_DIG1_ENABLE & 0xff);
3110                 /* set the stream id */
3111                 snd_hda_codec_write(codec,
3112                                 nvhdmi_con_nids_7x[i],
3113                                 0,
3114                                 AC_VERB_SET_CHANNEL_STREAMID,
3115                                 (stream_tag << 4) | channel_id);
3116                 /* set the stream format */
3117                 snd_hda_codec_write(codec,
3118                                 nvhdmi_con_nids_7x[i],
3119                                 0,
3120                                 AC_VERB_SET_STREAM_FORMAT,
3121                                 format);
3122                 /* turn on again (if needed) */
3123                 /* enable and set the channel status audio/data flag */
3124                 if (codec->spdif_status_reset &&
3125                 (spdif->ctls & AC_DIG1_ENABLE)) {
3126                         snd_hda_codec_write(codec,
3127                                         nvhdmi_con_nids_7x[i],
3128                                         0,
3129                                         AC_VERB_SET_DIGI_CONVERT_1,
3130                                         spdif->ctls & 0xff);
3131                         snd_hda_codec_write(codec,
3132                                         nvhdmi_con_nids_7x[i],
3133                                         0,
3134                                         AC_VERB_SET_DIGI_CONVERT_2, dataDCC2);
3135                 }
3136         }
3137
3138         nvhdmi_8ch_7x_set_info_frame_parameters(codec, chs);
3139
3140         mutex_unlock(&codec->spdif_mutex);
3141         return 0;
3142 }
3143
3144 static const struct hda_pcm_stream nvhdmi_pcm_playback_8ch_7x = {
3145         .substreams = 1,
3146         .channels_min = 2,
3147         .channels_max = 8,
3148         .nid = nvhdmi_master_con_nid_7x,
3149         .rates = SUPPORTED_RATES,
3150         .maxbps = SUPPORTED_MAXBPS,
3151         .formats = SUPPORTED_FORMATS,
3152         .ops = {
3153                 .open = simple_playback_pcm_open,
3154                 .close = nvhdmi_8ch_7x_pcm_close,
3155                 .prepare = nvhdmi_8ch_7x_pcm_prepare
3156         },
3157 };
3158
3159 static int patch_nvhdmi_2ch(struct hda_codec *codec)
3160 {
3161         struct hdmi_spec *spec;
3162         int err = patch_simple_hdmi(codec, nvhdmi_master_con_nid_7x,
3163                                     nvhdmi_master_pin_nid_7x);
3164         if (err < 0)
3165                 return err;
3166
3167         codec->patch_ops.init = nvhdmi_7x_init_2ch;
3168         /* override the PCM rates, etc, as the codec doesn't give full list */
3169         spec = codec->spec;
3170         spec->pcm_playback.rates = SUPPORTED_RATES;
3171         spec->pcm_playback.maxbps = SUPPORTED_MAXBPS;
3172         spec->pcm_playback.formats = SUPPORTED_FORMATS;
3173         return 0;
3174 }
3175
3176 static int nvhdmi_7x_8ch_build_pcms(struct hda_codec *codec)
3177 {
3178         struct hdmi_spec *spec = codec->spec;
3179         int err = simple_playback_build_pcms(codec);
3180         if (!err) {
3181                 struct hda_pcm *info = get_pcm_rec(spec, 0);
3182                 info->own_chmap = true;
3183         }
3184         return err;
3185 }
3186
3187 static int nvhdmi_7x_8ch_build_controls(struct hda_codec *codec)
3188 {
3189         struct hdmi_spec *spec = codec->spec;
3190         struct hda_pcm *info;
3191         struct snd_pcm_chmap *chmap;
3192         int err;
3193
3194         err = simple_playback_build_controls(codec);
3195         if (err < 0)
3196                 return err;
3197
3198         /* add channel maps */
3199         info = get_pcm_rec(spec, 0);
3200         err = snd_pcm_add_chmap_ctls(info->pcm,
3201                                      SNDRV_PCM_STREAM_PLAYBACK,
3202                                      snd_pcm_alt_chmaps, 8, 0, &chmap);
3203         if (err < 0)
3204                 return err;
3205         switch (codec->preset->vendor_id) {
3206         case 0x10de0002:
3207         case 0x10de0003:
3208         case 0x10de0005:
3209         case 0x10de0006:
3210                 chmap->channel_mask = (1U << 2) | (1U << 8);
3211                 break;
3212         case 0x10de0007:
3213                 chmap->channel_mask = (1U << 2) | (1U << 6) | (1U << 8);
3214         }
3215         return 0;
3216 }
3217
3218 static int patch_nvhdmi_8ch_7x(struct hda_codec *codec)
3219 {
3220         struct hdmi_spec *spec;
3221         int err = patch_nvhdmi_2ch(codec);
3222         if (err < 0)
3223                 return err;
3224         spec = codec->spec;
3225         spec->multiout.max_channels = 8;
3226         spec->pcm_playback = nvhdmi_pcm_playback_8ch_7x;
3227         codec->patch_ops.init = nvhdmi_7x_init_8ch;
3228         codec->patch_ops.build_pcms = nvhdmi_7x_8ch_build_pcms;
3229         codec->patch_ops.build_controls = nvhdmi_7x_8ch_build_controls;
3230
3231         /* Initialize the audio infoframe channel mask and checksum to something
3232          * valid */
3233         nvhdmi_8ch_7x_set_info_frame_parameters(codec, 8);
3234
3235         return 0;
3236 }
3237
3238 /*
3239  * NVIDIA codecs ignore ASP mapping for 2ch - confirmed on:
3240  * - 0x10de0015
3241  * - 0x10de0040
3242  */
3243 static int nvhdmi_chmap_cea_alloc_validate_get_type(struct hdac_chmap *chmap,
3244                 struct hdac_cea_channel_speaker_allocation *cap, int channels)
3245 {
3246         if (cap->ca_index == 0x00 && channels == 2)
3247                 return SNDRV_CTL_TLVT_CHMAP_FIXED;
3248
3249         /* If the speaker allocation matches the channel count, it is OK. */
3250         if (cap->channels != channels)
3251                 return -1;
3252
3253         /* all channels are remappable freely */
3254         return SNDRV_CTL_TLVT_CHMAP_VAR;
3255 }
3256
3257 static int nvhdmi_chmap_validate(struct hdac_chmap *chmap,
3258                 int ca, int chs, unsigned char *map)
3259 {
3260         if (ca == 0x00 && (map[0] != SNDRV_CHMAP_FL || map[1] != SNDRV_CHMAP_FR))
3261                 return -EINVAL;
3262
3263         return 0;
3264 }
3265
3266 static int patch_nvhdmi(struct hda_codec *codec)
3267 {
3268         struct hdmi_spec *spec;
3269         int err;
3270
3271         err = patch_generic_hdmi(codec);
3272         if (err)
3273                 return err;
3274
3275         spec = codec->spec;
3276         spec->dyn_pin_out = true;
3277
3278         spec->chmap.ops.chmap_cea_alloc_validate_get_type =
3279                 nvhdmi_chmap_cea_alloc_validate_get_type;
3280         spec->chmap.ops.chmap_validate = nvhdmi_chmap_validate;
3281
3282         return 0;
3283 }
3284
3285 /*
3286  * The HDA codec on NVIDIA Tegra contains two scratch registers that are
3287  * accessed using vendor-defined verbs. These registers can be used for
3288  * interoperability between the HDA and HDMI drivers.
3289  */
3290
3291 /* Audio Function Group node */
3292 #define NVIDIA_AFG_NID 0x01
3293
3294 /*
3295  * The SCRATCH0 register is used to notify the HDMI codec of changes in audio
3296  * format. On Tegra, bit 31 is used as a trigger that causes an interrupt to
3297  * be raised in the HDMI codec. The remainder of the bits is arbitrary. This
3298  * implementation stores the HDA format (see AC_FMT_*) in bits [15:0] and an
3299  * additional bit (at position 30) to signal the validity of the format.
3300  *
3301  * | 31      | 30    | 29  16 | 15   0 |
3302  * +---------+-------+--------+--------+
3303  * | TRIGGER | VALID | UNUSED | FORMAT |
3304  * +-----------------------------------|
3305  *
3306  * Note that for the trigger bit to take effect it needs to change value
3307  * (i.e. it needs to be toggled).
3308  */
3309 #define NVIDIA_GET_SCRATCH0             0xfa6
3310 #define NVIDIA_SET_SCRATCH0_BYTE0       0xfa7
3311 #define NVIDIA_SET_SCRATCH0_BYTE1       0xfa8
3312 #define NVIDIA_SET_SCRATCH0_BYTE2       0xfa9
3313 #define NVIDIA_SET_SCRATCH0_BYTE3       0xfaa
3314 #define NVIDIA_SCRATCH_TRIGGER (1 << 7)
3315 #define NVIDIA_SCRATCH_VALID   (1 << 6)
3316
3317 #define NVIDIA_GET_SCRATCH1             0xfab
3318 #define NVIDIA_SET_SCRATCH1_BYTE0       0xfac
3319 #define NVIDIA_SET_SCRATCH1_BYTE1       0xfad
3320 #define NVIDIA_SET_SCRATCH1_BYTE2       0xfae
3321 #define NVIDIA_SET_SCRATCH1_BYTE3       0xfaf
3322
3323 /*
3324  * The format parameter is the HDA audio format (see AC_FMT_*). If set to 0,
3325  * the format is invalidated so that the HDMI codec can be disabled.
3326  */
3327 static void tegra_hdmi_set_format(struct hda_codec *codec, unsigned int format)
3328 {
3329         unsigned int value;
3330
3331         /* bits [31:30] contain the trigger and valid bits */
3332         value = snd_hda_codec_read(codec, NVIDIA_AFG_NID, 0,
3333                                    NVIDIA_GET_SCRATCH0, 0);
3334         value = (value >> 24) & 0xff;
3335
3336         /* bits [15:0] are used to store the HDA format */
3337         snd_hda_codec_write(codec, NVIDIA_AFG_NID, 0,
3338                             NVIDIA_SET_SCRATCH0_BYTE0,
3339                             (format >> 0) & 0xff);
3340         snd_hda_codec_write(codec, NVIDIA_AFG_NID, 0,
3341                             NVIDIA_SET_SCRATCH0_BYTE1,
3342                             (format >> 8) & 0xff);
3343
3344         /* bits [16:24] are unused */
3345         snd_hda_codec_write(codec, NVIDIA_AFG_NID, 0,
3346                             NVIDIA_SET_SCRATCH0_BYTE2, 0);
3347
3348         /*
3349          * Bit 30 signals that the data is valid and hence that HDMI audio can
3350          * be enabled.
3351          */
3352         if (format == 0)
3353                 value &= ~NVIDIA_SCRATCH_VALID;
3354         else
3355                 value |= NVIDIA_SCRATCH_VALID;
3356
3357         /*
3358          * Whenever the trigger bit is toggled, an interrupt is raised in the
3359          * HDMI codec. The HDMI driver will use that as trigger to update its
3360          * configuration.
3361          */
3362         value ^= NVIDIA_SCRATCH_TRIGGER;
3363
3364         snd_hda_codec_write(codec, NVIDIA_AFG_NID, 0,
3365                             NVIDIA_SET_SCRATCH0_BYTE3, value);
3366 }
3367
3368 static int tegra_hdmi_pcm_prepare(struct hda_pcm_stream *hinfo,
3369                                   struct hda_codec *codec,
3370                                   unsigned int stream_tag,
3371                                   unsigned int format,
3372                                   struct snd_pcm_substream *substream)
3373 {
3374         int err;
3375
3376         err = generic_hdmi_playback_pcm_prepare(hinfo, codec, stream_tag,
3377                                                 format, substream);
3378         if (err < 0)
3379                 return err;
3380
3381         /* notify the HDMI codec of the format change */
3382         tegra_hdmi_set_format(codec, format);
3383
3384         return 0;
3385 }
3386
3387 static int tegra_hdmi_pcm_cleanup(struct hda_pcm_stream *hinfo,
3388                                   struct hda_codec *codec,
3389                                   struct snd_pcm_substream *substream)
3390 {
3391         /* invalidate the format in the HDMI codec */
3392         tegra_hdmi_set_format(codec, 0);
3393
3394         return generic_hdmi_playback_pcm_cleanup(hinfo, codec, substream);
3395 }
3396
3397 static struct hda_pcm *hda_find_pcm_by_type(struct hda_codec *codec, int type)
3398 {
3399         struct hdmi_spec *spec = codec->spec;
3400         unsigned int i;
3401
3402         for (i = 0; i < spec->num_pins; i++) {
3403                 struct hda_pcm *pcm = get_pcm_rec(spec, i);
3404
3405                 if (pcm->pcm_type == type)
3406                         return pcm;
3407         }
3408
3409         return NULL;
3410 }
3411
3412 static int tegra_hdmi_build_pcms(struct hda_codec *codec)
3413 {
3414         struct hda_pcm_stream *stream;
3415         struct hda_pcm *pcm;
3416         int err;
3417
3418         err = generic_hdmi_build_pcms(codec);
3419         if (err < 0)
3420                 return err;
3421
3422         pcm = hda_find_pcm_by_type(codec, HDA_PCM_TYPE_HDMI);
3423         if (!pcm)
3424                 return -ENODEV;
3425
3426         /*
3427          * Override ->prepare() and ->cleanup() operations to notify the HDMI
3428          * codec about format changes.
3429          */
3430         stream = &pcm->stream[SNDRV_PCM_STREAM_PLAYBACK];
3431         stream->ops.prepare = tegra_hdmi_pcm_prepare;
3432         stream->ops.cleanup = tegra_hdmi_pcm_cleanup;
3433
3434         return 0;
3435 }
3436
3437 static int patch_tegra_hdmi(struct hda_codec *codec)
3438 {
3439         int err;
3440
3441         err = patch_generic_hdmi(codec);
3442         if (err)
3443                 return err;
3444
3445         codec->patch_ops.build_pcms = tegra_hdmi_build_pcms;
3446
3447         return 0;
3448 }
3449
3450 /*
3451  * ATI/AMD-specific implementations
3452  */
3453
3454 #define is_amdhdmi_rev3_or_later(codec) \
3455         ((codec)->core.vendor_id == 0x1002aa01 && \
3456          ((codec)->core.revision_id & 0xff00) >= 0x0300)
3457 #define has_amd_full_remap_support(codec) is_amdhdmi_rev3_or_later(codec)
3458
3459 /* ATI/AMD specific HDA pin verbs, see the AMD HDA Verbs specification */
3460 #define ATI_VERB_SET_CHANNEL_ALLOCATION 0x771
3461 #define ATI_VERB_SET_DOWNMIX_INFO       0x772
3462 #define ATI_VERB_SET_MULTICHANNEL_01    0x777
3463 #define ATI_VERB_SET_MULTICHANNEL_23    0x778
3464 #define ATI_VERB_SET_MULTICHANNEL_45    0x779
3465 #define ATI_VERB_SET_MULTICHANNEL_67    0x77a
3466 #define ATI_VERB_SET_HBR_CONTROL        0x77c
3467 #define ATI_VERB_SET_MULTICHANNEL_1     0x785
3468 #define ATI_VERB_SET_MULTICHANNEL_3     0x786
3469 #define ATI_VERB_SET_MULTICHANNEL_5     0x787
3470 #define ATI_VERB_SET_MULTICHANNEL_7     0x788
3471 #define ATI_VERB_SET_MULTICHANNEL_MODE  0x789
3472 #define ATI_VERB_GET_CHANNEL_ALLOCATION 0xf71
3473 #define ATI_VERB_GET_DOWNMIX_INFO       0xf72
3474 #define ATI_VERB_GET_MULTICHANNEL_01    0xf77
3475 #define ATI_VERB_GET_MULTICHANNEL_23    0xf78
3476 #define ATI_VERB_GET_MULTICHANNEL_45    0xf79
3477 #define ATI_VERB_GET_MULTICHANNEL_67    0xf7a
3478 #define ATI_VERB_GET_HBR_CONTROL        0xf7c
3479 #define ATI_VERB_GET_MULTICHANNEL_1     0xf85
3480 #define ATI_VERB_GET_MULTICHANNEL_3     0xf86
3481 #define ATI_VERB_GET_MULTICHANNEL_5     0xf87
3482 #define ATI_VERB_GET_MULTICHANNEL_7     0xf88
3483 #define ATI_VERB_GET_MULTICHANNEL_MODE  0xf89
3484
3485 /* AMD specific HDA cvt verbs */
3486 #define ATI_VERB_SET_RAMP_RATE          0x770
3487 #define ATI_VERB_GET_RAMP_RATE          0xf70
3488
3489 #define ATI_OUT_ENABLE 0x1
3490
3491 #define ATI_MULTICHANNEL_MODE_PAIRED    0
3492 #define ATI_MULTICHANNEL_MODE_SINGLE    1
3493
3494 #define ATI_HBR_CAPABLE 0x01
3495 #define ATI_HBR_ENABLE 0x10
3496
3497 static int atihdmi_pin_get_eld(struct hda_codec *codec, hda_nid_t nid,
3498                            unsigned char *buf, int *eld_size)
3499 {
3500         /* call hda_eld.c ATI/AMD-specific function */
3501         return snd_hdmi_get_eld_ati(codec, nid, buf, eld_size,
3502                                     is_amdhdmi_rev3_or_later(codec));
3503 }
3504
3505 static void atihdmi_pin_setup_infoframe(struct hda_codec *codec, hda_nid_t pin_nid, int ca,
3506                                         int active_channels, int conn_type)
3507 {
3508         snd_hda_codec_write(codec, pin_nid, 0, ATI_VERB_SET_CHANNEL_ALLOCATION, ca);
3509 }
3510
3511 static int atihdmi_paired_swap_fc_lfe(int pos)
3512 {
3513         /*
3514          * ATI/AMD have automatic FC/LFE swap built-in
3515          * when in pairwise mapping mode.
3516          */
3517
3518         switch (pos) {
3519                 /* see channel_allocations[].speakers[] */
3520                 case 2: return 3;
3521                 case 3: return 2;
3522                 default: break;
3523         }
3524
3525         return pos;
3526 }
3527
3528 static int atihdmi_paired_chmap_validate(struct hdac_chmap *chmap,
3529                         int ca, int chs, unsigned char *map)
3530 {
3531         struct hdac_cea_channel_speaker_allocation *cap;
3532         int i, j;
3533
3534         /* check that only channel pairs need to be remapped on old pre-rev3 ATI/AMD */
3535
3536         cap = snd_hdac_get_ch_alloc_from_ca(ca);
3537         for (i = 0; i < chs; ++i) {
3538                 int mask = snd_hdac_chmap_to_spk_mask(map[i]);
3539                 bool ok = false;
3540                 bool companion_ok = false;
3541
3542                 if (!mask)
3543                         continue;
3544
3545                 for (j = 0 + i % 2; j < 8; j += 2) {
3546                         int chan_idx = 7 - atihdmi_paired_swap_fc_lfe(j);
3547                         if (cap->speakers[chan_idx] == mask) {
3548                                 /* channel is in a supported position */
3549                                 ok = true;
3550
3551                                 if (i % 2 == 0 && i + 1 < chs) {
3552                                         /* even channel, check the odd companion */
3553                                         int comp_chan_idx = 7 - atihdmi_paired_swap_fc_lfe(j + 1);
3554                                         int comp_mask_req = snd_hdac_chmap_to_spk_mask(map[i+1]);
3555                                         int comp_mask_act = cap->speakers[comp_chan_idx];
3556
3557                                         if (comp_mask_req == comp_mask_act)
3558                                                 companion_ok = true;
3559                                         else
3560                                                 return -EINVAL;
3561                                 }
3562                                 break;
3563                         }
3564                 }
3565
3566                 if (!ok)
3567                         return -EINVAL;
3568
3569                 if (companion_ok)
3570                         i++; /* companion channel already checked */
3571         }
3572
3573         return 0;
3574 }
3575
3576 static int atihdmi_pin_set_slot_channel(struct hdac_device *hdac,
3577                 hda_nid_t pin_nid, int hdmi_slot, int stream_channel)
3578 {
3579         struct hda_codec *codec = container_of(hdac, struct hda_codec, core);
3580         int verb;
3581         int ati_channel_setup = 0;
3582
3583         if (hdmi_slot > 7)
3584                 return -EINVAL;
3585
3586         if (!has_amd_full_remap_support(codec)) {
3587                 hdmi_slot = atihdmi_paired_swap_fc_lfe(hdmi_slot);
3588
3589                 /* In case this is an odd slot but without stream channel, do not
3590                  * disable the slot since the corresponding even slot could have a
3591                  * channel. In case neither have a channel, the slot pair will be
3592                  * disabled when this function is called for the even slot. */
3593                 if (hdmi_slot % 2 != 0 && stream_channel == 0xf)
3594                         return 0;
3595
3596                 hdmi_slot -= hdmi_slot % 2;
3597
3598                 if (stream_channel != 0xf)
3599                         stream_channel -= stream_channel % 2;
3600         }
3601
3602         verb = ATI_VERB_SET_MULTICHANNEL_01 + hdmi_slot/2 + (hdmi_slot % 2) * 0x00e;
3603
3604         /* ati_channel_setup format: [7..4] = stream_channel_id, [1] = mute, [0] = enable */
3605
3606         if (stream_channel != 0xf)
3607                 ati_channel_setup = (stream_channel << 4) | ATI_OUT_ENABLE;
3608
3609         return snd_hda_codec_write(codec, pin_nid, 0, verb, ati_channel_setup);
3610 }
3611
3612 static int atihdmi_pin_get_slot_channel(struct hdac_device *hdac,
3613                                 hda_nid_t pin_nid, int asp_slot)
3614 {
3615         struct hda_codec *codec = container_of(hdac, struct hda_codec, core);
3616         bool was_odd = false;
3617         int ati_asp_slot = asp_slot;
3618         int verb;
3619         int ati_channel_setup;
3620
3621         if (asp_slot > 7)
3622                 return -EINVAL;
3623
3624         if (!has_amd_full_remap_support(codec)) {
3625                 ati_asp_slot = atihdmi_paired_swap_fc_lfe(asp_slot);
3626                 if (ati_asp_slot % 2 != 0) {
3627                         ati_asp_slot -= 1;
3628                         was_odd = true;
3629                 }
3630         }
3631
3632         verb = ATI_VERB_GET_MULTICHANNEL_01 + ati_asp_slot/2 + (ati_asp_slot % 2) * 0x00e;
3633
3634         ati_channel_setup = snd_hda_codec_read(codec, pin_nid, 0, verb, 0);
3635
3636         if (!(ati_channel_setup & ATI_OUT_ENABLE))
3637                 return 0xf;
3638
3639         return ((ati_channel_setup & 0xf0) >> 4) + !!was_odd;
3640 }
3641
3642 static int atihdmi_paired_chmap_cea_alloc_validate_get_type(
3643                 struct hdac_chmap *chmap,
3644                 struct hdac_cea_channel_speaker_allocation *cap,
3645                 int channels)
3646 {
3647         int c;
3648
3649         /*
3650          * Pre-rev3 ATI/AMD codecs operate in a paired channel mode, so
3651          * we need to take that into account (a single channel may take 2
3652          * channel slots if we need to carry a silent channel next to it).
3653          * On Rev3+ AMD codecs this function is not used.
3654          */
3655         int chanpairs = 0;
3656
3657         /* We only produce even-numbered channel count TLVs */
3658         if ((channels % 2) != 0)
3659                 return -1;
3660
3661         for (c = 0; c < 7; c += 2) {
3662                 if (cap->speakers[c] || cap->speakers[c+1])
3663                         chanpairs++;
3664         }
3665
3666         if (chanpairs * 2 != channels)
3667                 return -1;
3668
3669         return SNDRV_CTL_TLVT_CHMAP_PAIRED;
3670 }
3671
3672 static void atihdmi_paired_cea_alloc_to_tlv_chmap(struct hdac_chmap *hchmap,
3673                 struct hdac_cea_channel_speaker_allocation *cap,
3674                 unsigned int *chmap, int channels)
3675 {
3676         /* produce paired maps for pre-rev3 ATI/AMD codecs */
3677         int count = 0;
3678         int c;
3679
3680         for (c = 7; c >= 0; c--) {
3681                 int chan = 7 - atihdmi_paired_swap_fc_lfe(7 - c);
3682                 int spk = cap->speakers[chan];
3683                 if (!spk) {
3684                         /* add N/A channel if the companion channel is occupied */
3685                         if (cap->speakers[chan + (chan % 2 ? -1 : 1)])
3686                                 chmap[count++] = SNDRV_CHMAP_NA;
3687
3688                         continue;
3689                 }
3690
3691                 chmap[count++] = snd_hdac_spk_to_chmap(spk);
3692         }
3693
3694         WARN_ON(count != channels);
3695 }
3696
3697 static int atihdmi_pin_hbr_setup(struct hda_codec *codec, hda_nid_t pin_nid,
3698                                  bool hbr)
3699 {
3700         int hbr_ctl, hbr_ctl_new;
3701
3702         hbr_ctl = snd_hda_codec_read(codec, pin_nid, 0, ATI_VERB_GET_HBR_CONTROL, 0);
3703         if (hbr_ctl >= 0 && (hbr_ctl & ATI_HBR_CAPABLE)) {
3704                 if (hbr)
3705                         hbr_ctl_new = hbr_ctl | ATI_HBR_ENABLE;
3706                 else
3707                         hbr_ctl_new = hbr_ctl & ~ATI_HBR_ENABLE;
3708
3709                 codec_dbg(codec,
3710                           "atihdmi_pin_hbr_setup: NID=0x%x, %shbr-ctl=0x%x\n",
3711                                 pin_nid,
3712                                 hbr_ctl == hbr_ctl_new ? "" : "new-",
3713                                 hbr_ctl_new);
3714
3715                 if (hbr_ctl != hbr_ctl_new)
3716                         snd_hda_codec_write(codec, pin_nid, 0,
3717                                                 ATI_VERB_SET_HBR_CONTROL,
3718                                                 hbr_ctl_new);
3719
3720         } else if (hbr)
3721                 return -EINVAL;
3722
3723         return 0;
3724 }
3725
3726 static int atihdmi_setup_stream(struct hda_codec *codec, hda_nid_t cvt_nid,
3727                                 hda_nid_t pin_nid, u32 stream_tag, int format)
3728 {
3729
3730         if (is_amdhdmi_rev3_or_later(codec)) {
3731                 int ramp_rate = 180; /* default as per AMD spec */
3732                 /* disable ramp-up/down for non-pcm as per AMD spec */
3733                 if (format & AC_FMT_TYPE_NON_PCM)
3734                         ramp_rate = 0;
3735
3736                 snd_hda_codec_write(codec, cvt_nid, 0, ATI_VERB_SET_RAMP_RATE, ramp_rate);
3737         }
3738
3739         return hdmi_setup_stream(codec, cvt_nid, pin_nid, stream_tag, format);
3740 }
3741
3742
3743 static int atihdmi_init(struct hda_codec *codec)
3744 {
3745         struct hdmi_spec *spec = codec->spec;
3746         int pin_idx, err;
3747
3748         err = generic_hdmi_init(codec);
3749
3750         if (err)
3751                 return err;
3752
3753         for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
3754                 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
3755
3756                 /* make sure downmix information in infoframe is zero */
3757                 snd_hda_codec_write(codec, per_pin->pin_nid, 0, ATI_VERB_SET_DOWNMIX_INFO, 0);
3758
3759                 /* enable channel-wise remap mode if supported */
3760                 if (has_amd_full_remap_support(codec))
3761                         snd_hda_codec_write(codec, per_pin->pin_nid, 0,
3762                                             ATI_VERB_SET_MULTICHANNEL_MODE,
3763                                             ATI_MULTICHANNEL_MODE_SINGLE);
3764         }
3765
3766         return 0;
3767 }
3768
3769 static int patch_atihdmi(struct hda_codec *codec)
3770 {
3771         struct hdmi_spec *spec;
3772         struct hdmi_spec_per_cvt *per_cvt;
3773         int err, cvt_idx;
3774
3775         err = patch_generic_hdmi(codec);
3776
3777         if (err)
3778                 return err;
3779
3780         codec->patch_ops.init = atihdmi_init;
3781
3782         spec = codec->spec;
3783
3784         spec->ops.pin_get_eld = atihdmi_pin_get_eld;
3785         spec->ops.pin_setup_infoframe = atihdmi_pin_setup_infoframe;
3786         spec->ops.pin_hbr_setup = atihdmi_pin_hbr_setup;
3787         spec->ops.setup_stream = atihdmi_setup_stream;
3788
3789         spec->chmap.ops.pin_get_slot_channel = atihdmi_pin_get_slot_channel;
3790         spec->chmap.ops.pin_set_slot_channel = atihdmi_pin_set_slot_channel;
3791
3792         if (!has_amd_full_remap_support(codec)) {
3793                 /* override to ATI/AMD-specific versions with pairwise mapping */
3794                 spec->chmap.ops.chmap_cea_alloc_validate_get_type =
3795                         atihdmi_paired_chmap_cea_alloc_validate_get_type;
3796                 spec->chmap.ops.cea_alloc_to_tlv_chmap =
3797                                 atihdmi_paired_cea_alloc_to_tlv_chmap;
3798                 spec->chmap.ops.chmap_validate = atihdmi_paired_chmap_validate;
3799         }
3800
3801         /* ATI/AMD converters do not advertise all of their capabilities */
3802         for (cvt_idx = 0; cvt_idx < spec->num_cvts; cvt_idx++) {
3803                 per_cvt = get_cvt(spec, cvt_idx);
3804                 per_cvt->channels_max = max(per_cvt->channels_max, 8u);
3805                 per_cvt->rates |= SUPPORTED_RATES;
3806                 per_cvt->formats |= SUPPORTED_FORMATS;
3807                 per_cvt->maxbps = max(per_cvt->maxbps, 24u);
3808         }
3809
3810         spec->chmap.channels_max = max(spec->chmap.channels_max, 8u);
3811
3812         /* AMD GPUs have neither EPSS nor CLKSTOP bits, hence preventing
3813          * the link-down as is.  Tell the core to allow it.
3814          */
3815         codec->link_down_at_suspend = 1;
3816
3817         return 0;
3818 }
3819
3820 /* VIA HDMI Implementation */
3821 #define VIAHDMI_CVT_NID 0x02    /* audio converter1 */
3822 #define VIAHDMI_PIN_NID 0x03    /* HDMI output pin1 */
3823
3824 static int patch_via_hdmi(struct hda_codec *codec)
3825 {
3826         return patch_simple_hdmi(codec, VIAHDMI_CVT_NID, VIAHDMI_PIN_NID);
3827 }
3828
3829 /*
3830  * patch entries
3831  */
3832 static const struct hda_device_id snd_hda_id_hdmi[] = {
3833 HDA_CODEC_ENTRY(0x1002793c, "RS600 HDMI",       patch_atihdmi),
3834 HDA_CODEC_ENTRY(0x10027919, "RS600 HDMI",       patch_atihdmi),
3835 HDA_CODEC_ENTRY(0x1002791a, "RS690/780 HDMI",   patch_atihdmi),
3836 HDA_CODEC_ENTRY(0x1002aa01, "R6xx HDMI",        patch_atihdmi),
3837 HDA_CODEC_ENTRY(0x10951390, "SiI1390 HDMI",     patch_generic_hdmi),
3838 HDA_CODEC_ENTRY(0x10951392, "SiI1392 HDMI",     patch_generic_hdmi),
3839 HDA_CODEC_ENTRY(0x17e80047, "Chrontel HDMI",    patch_generic_hdmi),
3840 HDA_CODEC_ENTRY(0x10de0001, "MCP73 HDMI",       patch_nvhdmi_2ch),
3841 HDA_CODEC_ENTRY(0x10de0002, "MCP77/78 HDMI",    patch_nvhdmi_8ch_7x),
3842 HDA_CODEC_ENTRY(0x10de0003, "MCP77/78 HDMI",    patch_nvhdmi_8ch_7x),
3843 HDA_CODEC_ENTRY(0x10de0004, "GPU 04 HDMI",      patch_nvhdmi_8ch_7x),
3844 HDA_CODEC_ENTRY(0x10de0005, "MCP77/78 HDMI",    patch_nvhdmi_8ch_7x),
3845 HDA_CODEC_ENTRY(0x10de0006, "MCP77/78 HDMI",    patch_nvhdmi_8ch_7x),
3846 HDA_CODEC_ENTRY(0x10de0007, "MCP79/7A HDMI",    patch_nvhdmi_8ch_7x),
3847 HDA_CODEC_ENTRY(0x10de0008, "GPU 08 HDMI/DP",   patch_nvhdmi),
3848 HDA_CODEC_ENTRY(0x10de0009, "GPU 09 HDMI/DP",   patch_nvhdmi),
3849 HDA_CODEC_ENTRY(0x10de000a, "GPU 0a HDMI/DP",   patch_nvhdmi),
3850 HDA_CODEC_ENTRY(0x10de000b, "GPU 0b HDMI/DP",   patch_nvhdmi),
3851 HDA_CODEC_ENTRY(0x10de000c, "MCP89 HDMI",       patch_nvhdmi),
3852 HDA_CODEC_ENTRY(0x10de000d, "GPU 0d HDMI/DP",   patch_nvhdmi),
3853 HDA_CODEC_ENTRY(0x10de0010, "GPU 10 HDMI/DP",   patch_nvhdmi),
3854 HDA_CODEC_ENTRY(0x10de0011, "GPU 11 HDMI/DP",   patch_nvhdmi),
3855 HDA_CODEC_ENTRY(0x10de0012, "GPU 12 HDMI/DP",   patch_nvhdmi),
3856 HDA_CODEC_ENTRY(0x10de0013, "GPU 13 HDMI/DP",   patch_nvhdmi),
3857 HDA_CODEC_ENTRY(0x10de0014, "GPU 14 HDMI/DP",   patch_nvhdmi),
3858 HDA_CODEC_ENTRY(0x10de0015, "GPU 15 HDMI/DP",   patch_nvhdmi),
3859 HDA_CODEC_ENTRY(0x10de0016, "GPU 16 HDMI/DP",   patch_nvhdmi),
3860 /* 17 is known to be absent */
3861 HDA_CODEC_ENTRY(0x10de0018, "GPU 18 HDMI/DP",   patch_nvhdmi),
3862 HDA_CODEC_ENTRY(0x10de0019, "GPU 19 HDMI/DP",   patch_nvhdmi),
3863 HDA_CODEC_ENTRY(0x10de001a, "GPU 1a HDMI/DP",   patch_nvhdmi),
3864 HDA_CODEC_ENTRY(0x10de001b, "GPU 1b HDMI/DP",   patch_nvhdmi),
3865 HDA_CODEC_ENTRY(0x10de001c, "GPU 1c HDMI/DP",   patch_nvhdmi),
3866 HDA_CODEC_ENTRY(0x10de0020, "Tegra30 HDMI",     patch_tegra_hdmi),
3867 HDA_CODEC_ENTRY(0x10de0022, "Tegra114 HDMI",    patch_tegra_hdmi),
3868 HDA_CODEC_ENTRY(0x10de0028, "Tegra124 HDMI",    patch_tegra_hdmi),
3869 HDA_CODEC_ENTRY(0x10de0029, "Tegra210 HDMI/DP", patch_tegra_hdmi),
3870 HDA_CODEC_ENTRY(0x10de002d, "Tegra186 HDMI/DP0", patch_tegra_hdmi),
3871 HDA_CODEC_ENTRY(0x10de002e, "Tegra186 HDMI/DP1", patch_tegra_hdmi),
3872 HDA_CODEC_ENTRY(0x10de002f, "Tegra194 HDMI/DP2", patch_tegra_hdmi),
3873 HDA_CODEC_ENTRY(0x10de0030, "Tegra194 HDMI/DP3", patch_tegra_hdmi),
3874 HDA_CODEC_ENTRY(0x10de0040, "GPU 40 HDMI/DP",   patch_nvhdmi),
3875 HDA_CODEC_ENTRY(0x10de0041, "GPU 41 HDMI/DP",   patch_nvhdmi),
3876 HDA_CODEC_ENTRY(0x10de0042, "GPU 42 HDMI/DP",   patch_nvhdmi),
3877 HDA_CODEC_ENTRY(0x10de0043, "GPU 43 HDMI/DP",   patch_nvhdmi),
3878 HDA_CODEC_ENTRY(0x10de0044, "GPU 44 HDMI/DP",   patch_nvhdmi),
3879 HDA_CODEC_ENTRY(0x10de0045, "GPU 45 HDMI/DP",   patch_nvhdmi),
3880 HDA_CODEC_ENTRY(0x10de0050, "GPU 50 HDMI/DP",   patch_nvhdmi),
3881 HDA_CODEC_ENTRY(0x10de0051, "GPU 51 HDMI/DP",   patch_nvhdmi),
3882 HDA_CODEC_ENTRY(0x10de0052, "GPU 52 HDMI/DP",   patch_nvhdmi),
3883 HDA_CODEC_ENTRY(0x10de0060, "GPU 60 HDMI/DP",   patch_nvhdmi),
3884 HDA_CODEC_ENTRY(0x10de0061, "GPU 61 HDMI/DP",   patch_nvhdmi),
3885 HDA_CODEC_ENTRY(0x10de0062, "GPU 62 HDMI/DP",   patch_nvhdmi),
3886 HDA_CODEC_ENTRY(0x10de0067, "MCP67 HDMI",       patch_nvhdmi_2ch),
3887 HDA_CODEC_ENTRY(0x10de0070, "GPU 70 HDMI/DP",   patch_nvhdmi),
3888 HDA_CODEC_ENTRY(0x10de0071, "GPU 71 HDMI/DP",   patch_nvhdmi),
3889 HDA_CODEC_ENTRY(0x10de0072, "GPU 72 HDMI/DP",   patch_nvhdmi),
3890 HDA_CODEC_ENTRY(0x10de0073, "GPU 73 HDMI/DP",   patch_nvhdmi),
3891 HDA_CODEC_ENTRY(0x10de0074, "GPU 74 HDMI/DP",   patch_nvhdmi),
3892 HDA_CODEC_ENTRY(0x10de0076, "GPU 76 HDMI/DP",   patch_nvhdmi),
3893 HDA_CODEC_ENTRY(0x10de007b, "GPU 7b HDMI/DP",   patch_nvhdmi),
3894 HDA_CODEC_ENTRY(0x10de007c, "GPU 7c HDMI/DP",   patch_nvhdmi),
3895 HDA_CODEC_ENTRY(0x10de007d, "GPU 7d HDMI/DP",   patch_nvhdmi),
3896 HDA_CODEC_ENTRY(0x10de007e, "GPU 7e HDMI/DP",   patch_nvhdmi),
3897 HDA_CODEC_ENTRY(0x10de0080, "GPU 80 HDMI/DP",   patch_nvhdmi),
3898 HDA_CODEC_ENTRY(0x10de0081, "GPU 81 HDMI/DP",   patch_nvhdmi),
3899 HDA_CODEC_ENTRY(0x10de0082, "GPU 82 HDMI/DP",   patch_nvhdmi),
3900 HDA_CODEC_ENTRY(0x10de0083, "GPU 83 HDMI/DP",   patch_nvhdmi),
3901 HDA_CODEC_ENTRY(0x10de0084, "GPU 84 HDMI/DP",   patch_nvhdmi),
3902 HDA_CODEC_ENTRY(0x10de0090, "GPU 90 HDMI/DP",   patch_nvhdmi),
3903 HDA_CODEC_ENTRY(0x10de0091, "GPU 91 HDMI/DP",   patch_nvhdmi),
3904 HDA_CODEC_ENTRY(0x10de0092, "GPU 92 HDMI/DP",   patch_nvhdmi),
3905 HDA_CODEC_ENTRY(0x10de0093, "GPU 93 HDMI/DP",   patch_nvhdmi),
3906 HDA_CODEC_ENTRY(0x10de0094, "GPU 94 HDMI/DP",   patch_nvhdmi),
3907 HDA_CODEC_ENTRY(0x10de0095, "GPU 95 HDMI/DP",   patch_nvhdmi),
3908 HDA_CODEC_ENTRY(0x10de0097, "GPU 97 HDMI/DP",   patch_nvhdmi),
3909 HDA_CODEC_ENTRY(0x10de0098, "GPU 98 HDMI/DP",   patch_nvhdmi),
3910 HDA_CODEC_ENTRY(0x10de0099, "GPU 99 HDMI/DP",   patch_nvhdmi),
3911 HDA_CODEC_ENTRY(0x10de8001, "MCP73 HDMI",       patch_nvhdmi_2ch),
3912 HDA_CODEC_ENTRY(0x10de8067, "MCP67/68 HDMI",    patch_nvhdmi_2ch),
3913 HDA_CODEC_ENTRY(0x11069f80, "VX900 HDMI/DP",    patch_via_hdmi),
3914 HDA_CODEC_ENTRY(0x11069f81, "VX900 HDMI/DP",    patch_via_hdmi),
3915 HDA_CODEC_ENTRY(0x11069f84, "VX11 HDMI/DP",     patch_generic_hdmi),
3916 HDA_CODEC_ENTRY(0x11069f85, "VX11 HDMI/DP",     patch_generic_hdmi),
3917 HDA_CODEC_ENTRY(0x80860054, "IbexPeak HDMI",    patch_i915_cpt_hdmi),
3918 HDA_CODEC_ENTRY(0x80862800, "Geminilake HDMI",  patch_i915_glk_hdmi),
3919 HDA_CODEC_ENTRY(0x80862801, "Bearlake HDMI",    patch_generic_hdmi),
3920 HDA_CODEC_ENTRY(0x80862802, "Cantiga HDMI",     patch_generic_hdmi),
3921 HDA_CODEC_ENTRY(0x80862803, "Eaglelake HDMI",   patch_generic_hdmi),
3922 HDA_CODEC_ENTRY(0x80862804, "IbexPeak HDMI",    patch_i915_cpt_hdmi),
3923 HDA_CODEC_ENTRY(0x80862805, "CougarPoint HDMI", patch_i915_cpt_hdmi),
3924 HDA_CODEC_ENTRY(0x80862806, "PantherPoint HDMI", patch_i915_cpt_hdmi),
3925 HDA_CODEC_ENTRY(0x80862807, "Haswell HDMI",     patch_i915_hsw_hdmi),
3926 HDA_CODEC_ENTRY(0x80862808, "Broadwell HDMI",   patch_i915_hsw_hdmi),
3927 HDA_CODEC_ENTRY(0x80862809, "Skylake HDMI",     patch_i915_hsw_hdmi),
3928 HDA_CODEC_ENTRY(0x8086280a, "Broxton HDMI",     patch_i915_hsw_hdmi),
3929 HDA_CODEC_ENTRY(0x8086280b, "Kabylake HDMI",    patch_i915_hsw_hdmi),
3930 HDA_CODEC_ENTRY(0x8086280c, "Cannonlake HDMI",  patch_i915_glk_hdmi),
3931 HDA_CODEC_ENTRY(0x8086280d, "Geminilake HDMI",  patch_i915_glk_hdmi),
3932 HDA_CODEC_ENTRY(0x8086280f, "Icelake HDMI",     patch_i915_icl_hdmi),
3933 HDA_CODEC_ENTRY(0x80862880, "CedarTrail HDMI",  patch_generic_hdmi),
3934 HDA_CODEC_ENTRY(0x80862882, "Valleyview2 HDMI", patch_i915_byt_hdmi),
3935 HDA_CODEC_ENTRY(0x80862883, "Braswell HDMI",    patch_i915_byt_hdmi),
3936 HDA_CODEC_ENTRY(0x808629fb, "Crestline HDMI",   patch_generic_hdmi),
3937 /* special ID for generic HDMI */
3938 HDA_CODEC_ENTRY(HDA_CODEC_ID_GENERIC_HDMI, "Generic HDMI", patch_generic_hdmi),
3939 {} /* terminator */
3940 };
3941 MODULE_DEVICE_TABLE(hdaudio, snd_hda_id_hdmi);
3942
3943 MODULE_LICENSE("GPL");
3944 MODULE_DESCRIPTION("HDMI HD-audio codec");
3945 MODULE_ALIAS("snd-hda-codec-intelhdmi");
3946 MODULE_ALIAS("snd-hda-codec-nvhdmi");
3947 MODULE_ALIAS("snd-hda-codec-atihdmi");
3948
3949 static struct hda_codec_driver hdmi_driver = {
3950         .id = snd_hda_id_hdmi,
3951 };
3952
3953 module_hda_codec_driver(hdmi_driver);