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