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  *
  10  *  Authors:
  11  *                      Wu Fengguang <wfg@linux.intel.com>
  12  *
  13  *  Maintained by:
  14  *                      Wu Fengguang <wfg@linux.intel.com>
  15  *
  16  *  This program is free software; you can redistribute it and/or modify it
  17  *  under the terms of the GNU General Public License as published by the Free
  18  *  Software Foundation; either version 2 of the License, or (at your option)
  19  *  any later version.
  20  *
  21  *  This program is distributed in the hope that it will be useful, but
  22  *  WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
  23  *  or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
  24  *  for more details.
  25  *
  26  *  You should have received a copy of the GNU General Public License
  27  *  along with this program; if not, write to the Free Software Foundation,
  28  *  Inc., 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
  29  */
  30
  31 #include <linux/init.h>
  32 #include <linux/delay.h>
  33 #include <linux/slab.h>
  34 #include <linux/module.h>
  35 #include <sound/core.h>
  36 #include <sound/jack.h>
  37 #include "hda_codec.h"
  38 #include "hda_local.h"
  39 #include "hda_jack.h"
  40
  41 static bool static_hdmi_pcm;
  42 module_param(static_hdmi_pcm, bool, 0644);
  43 MODULE_PARM_DESC(static_hdmi_pcm, "Don't restrict PCM parameters per ELD info");
  44
  45 /*
  46  * The HDMI/DisplayPort configuration can be highly dynamic. A graphics device
  47  * could support N independent pipes, each of them can be connected to one or
  48  * more ports (DVI, HDMI or DisplayPort).
  49  *
  50  * The HDA correspondence of pipes/ports are converter/pin nodes.
  51  */
  52 #define MAX_HDMI_CVTS   4
  53 #define MAX_HDMI_PINS   4
  54
  55 struct hdmi_spec_per_cvt {
  56         hda_nid_t cvt_nid;
  57         int assigned;
  58         unsigned int channels_min;
  59         unsigned int channels_max;
  60         u32 rates;
  61         u64 formats;
  62         unsigned int maxbps;
  63 };
  64
  65 struct hdmi_spec_per_pin {
  66         hda_nid_t pin_nid;
  67         int num_mux_nids;
  68         hda_nid_t mux_nids[HDA_MAX_CONNECTIONS];
  69
  70         struct hda_codec *codec;
  71         struct hdmi_eld sink_eld;
  72         struct delayed_work work;
  73 };
  74
  75 struct hdmi_spec {
  76         int num_cvts;
  77         struct hdmi_spec_per_cvt cvts[MAX_HDMI_CVTS];
  78
  79         int num_pins;
  80         struct hdmi_spec_per_pin pins[MAX_HDMI_PINS];
  81         struct hda_pcm pcm_rec[MAX_HDMI_PINS];
  82
  83         /*
  84          * Non-generic ATI/NVIDIA specific
  85          */
  86         struct hda_multi_out multiout;
  87         const struct hda_pcm_stream *pcm_playback;
  88 };
  89
  90
  91 struct hdmi_audio_infoframe {
  92         u8 type; /* 0x84 */
  93         u8 ver;  /* 0x01 */
  94         u8 len;  /* 0x0a */
  95
  96         u8 checksum;
  97
  98         u8 CC02_CT47;   /* CC in bits 0:2, CT in 4:7 */
  99         u8 SS01_SF24;
 100         u8 CXT04;
 101         u8 CA;
 102         u8 LFEPBL01_LSV36_DM_INH7;
 103 };
 104
 105 struct dp_audio_infoframe {
 106         u8 type; /* 0x84 */
 107         u8 len;  /* 0x1b */
 108         u8 ver;  /* 0x11 << 2 */
 109
 110         u8 CC02_CT47;   /* match with HDMI infoframe from this on */
 111         u8 SS01_SF24;
 112         u8 CXT04;
 113         u8 CA;
 114         u8 LFEPBL01_LSV36_DM_INH7;
 115 };
 116
 117 union audio_infoframe {
 118         struct hdmi_audio_infoframe hdmi;
 119         struct dp_audio_infoframe dp;
 120         u8 bytes[0];
 121 };
 122
 123 /*
 124  * CEA speaker placement:
 125  *
 126  *        FLH       FCH        FRH
 127  *  FLW    FL  FLC   FC   FRC   FR   FRW
 128  *
 129  *                                  LFE
 130  *                     TC
 131  *
 132  *          RL  RLC   RC   RRC   RR
 133  *
 134  * The Left/Right Surround channel _notions_ LS/RS in SMPTE 320M corresponds to
 135  * CEA RL/RR; The SMPTE channel _assignment_ C/LFE is swapped to CEA LFE/FC.
 136  */
 137 enum cea_speaker_placement {
 138         FL  = (1 <<  0),        /* Front Left           */
 139         FC  = (1 <<  1),        /* Front Center         */
 140         FR  = (1 <<  2),        /* Front Right          */
 141         FLC = (1 <<  3),        /* Front Left Center    */
 142         FRC = (1 <<  4),        /* Front Right Center   */
 143         RL  = (1 <<  5),        /* Rear Left            */
 144         RC  = (1 <<  6),        /* Rear Center          */
 145         RR  = (1 <<  7),        /* Rear Right           */
 146         RLC = (1 <<  8),        /* Rear Left Center     */
 147         RRC = (1 <<  9),        /* Rear Right Center    */
 148         LFE = (1 << 10),        /* Low Frequency Effect */
 149         FLW = (1 << 11),        /* Front Left Wide      */
 150         FRW = (1 << 12),        /* Front Right Wide     */
 151         FLH = (1 << 13),        /* Front Left High      */
 152         FCH = (1 << 14),        /* Front Center High    */
 153         FRH = (1 << 15),        /* Front Right High     */
 154         TC  = (1 << 16),        /* Top Center           */
 155 };
 156
 157 /*
 158  * ELD SA bits in the CEA Speaker Allocation data block
 159  */
 160 static int eld_speaker_allocation_bits[] = {
 161         [0] = FL | FR,
 162         [1] = LFE,
 163         [2] = FC,
 164         [3] = RL | RR,
 165         [4] = RC,
 166         [5] = FLC | FRC,
 167         [6] = RLC | RRC,
 168         /* the following are not defined in ELD yet */
 169         [7] = FLW | FRW,
 170         [8] = FLH | FRH,
 171         [9] = TC,
 172         [10] = FCH,
 173 };
 174
 175 struct cea_channel_speaker_allocation {
 176         int ca_index;
 177         int speakers[8];
 178
 179         /* derived values, just for convenience */
 180         int channels;
 181         int spk_mask;
 182 };
 183
 184 /*
 185  * ALSA sequence is:
 186  *
 187  *       surround40   surround41   surround50   surround51   surround71
 188  * ch0   front left   =            =            =            =
 189  * ch1   front right  =            =            =            =
 190  * ch2   rear left    =            =            =            =
 191  * ch3   rear right   =            =            =            =
 192  * ch4                LFE          center       center       center
 193  * ch5                                          LFE          LFE
 194  * ch6                                                       side left
 195  * ch7                                                       side right
 196  *
 197  * surround71 = {FL, FR, RLC, RRC, FC, LFE, RL, RR}
 198  */
 199 static int hdmi_channel_mapping[0x32][8] = {
 200         /* stereo */
 201         [0x00] = { 0x00, 0x11, 0xf2, 0xf3, 0xf4, 0xf5, 0xf6, 0xf7 },
 202         /* 2.1 */
 203         [0x01] = { 0x00, 0x11, 0x22, 0xf3, 0xf4, 0xf5, 0xf6, 0xf7 },
 204         /* Dolby Surround */
 205         [0x02] = { 0x00, 0x11, 0x23, 0xf2, 0xf4, 0xf5, 0xf6, 0xf7 },
 206         /* surround40 */
 207         [0x08] = { 0x00, 0x11, 0x24, 0x35, 0xf3, 0xf2, 0xf6, 0xf7 },
 208         /* 4ch */
 209         [0x03] = { 0x00, 0x11, 0x23, 0x32, 0x44, 0xf5, 0xf6, 0xf7 },
 210         /* surround41 */
 211         [0x09] = { 0x00, 0x11, 0x24, 0x35, 0x42, 0xf3, 0xf6, 0xf7 },
 212         /* surround50 */
 213         [0x0a] = { 0x00, 0x11, 0x24, 0x35, 0x43, 0xf2, 0xf6, 0xf7 },
 214         /* surround51 */
 215         [0x0b] = { 0x00, 0x11, 0x24, 0x35, 0x43, 0x52, 0xf6, 0xf7 },
 216         /* 7.1 */
 217         [0x13] = { 0x00, 0x11, 0x26, 0x37, 0x43, 0x52, 0x64, 0x75 },
 218 };
 219
 220 /*
 221  * This is an ordered list!
 222  *
 223  * The preceding ones have better chances to be selected by
 224  * hdmi_channel_allocation().
 225  */
 226 static struct cea_channel_speaker_allocation channel_allocations[] = {
 227 /*                        channel:   7     6    5    4    3     2    1    0  */
 228 { .ca_index = 0x00,  .speakers = {   0,    0,   0,   0,   0,    0,  FR,  FL } },
 229                                  /* 2.1 */
 230 { .ca_index = 0x01,  .speakers = {   0,    0,   0,   0,   0,  LFE,  FR,  FL } },
 231                                  /* Dolby Surround */
 232 { .ca_index = 0x02,  .speakers = {   0,    0,   0,   0,  FC,    0,  FR,  FL } },
 233                                  /* surround40 */
 234 { .ca_index = 0x08,  .speakers = {   0,    0,  RR,  RL,   0,    0,  FR,  FL } },
 235                                  /* surround41 */
 236 { .ca_index = 0x09,  .speakers = {   0,    0,  RR,  RL,   0,  LFE,  FR,  FL } },
 237                                  /* surround50 */
 238 { .ca_index = 0x0a,  .speakers = {   0,    0,  RR,  RL,  FC,    0,  FR,  FL } },
 239                                  /* surround51 */
 240 { .ca_index = 0x0b,  .speakers = {   0,    0,  RR,  RL,  FC,  LFE,  FR,  FL } },
 241                                  /* 6.1 */
 242 { .ca_index = 0x0f,  .speakers = {   0,   RC,  RR,  RL,  FC,  LFE,  FR,  FL } },
 243                                  /* surround71 */
 244 { .ca_index = 0x13,  .speakers = { RRC,  RLC,  RR,  RL,  FC,  LFE,  FR,  FL } },
 245
 246 { .ca_index = 0x03,  .speakers = {   0,    0,   0,   0,  FC,  LFE,  FR,  FL } },
 247 { .ca_index = 0x04,  .speakers = {   0,    0,   0,  RC,   0,    0,  FR,  FL } },
 248 { .ca_index = 0x05,  .speakers = {   0,    0,   0,  RC,   0,  LFE,  FR,  FL } },
 249 { .ca_index = 0x06,  .speakers = {   0,    0,   0,  RC,  FC,    0,  FR,  FL } },
 250 { .ca_index = 0x07,  .speakers = {   0,    0,   0,  RC,  FC,  LFE,  FR,  FL } },
 251 { .ca_index = 0x0c,  .speakers = {   0,   RC,  RR,  RL,   0,    0,  FR,  FL } },
 252 { .ca_index = 0x0d,  .speakers = {   0,   RC,  RR,  RL,   0,  LFE,  FR,  FL } },
 253 { .ca_index = 0x0e,  .speakers = {   0,   RC,  RR,  RL,  FC,    0,  FR,  FL } },
 254 { .ca_index = 0x10,  .speakers = { RRC,  RLC,  RR,  RL,   0,    0,  FR,  FL } },
 255 { .ca_index = 0x11,  .speakers = { RRC,  RLC,  RR,  RL,   0,  LFE,  FR,  FL } },
 256 { .ca_index = 0x12,  .speakers = { RRC,  RLC,  RR,  RL,  FC,    0,  FR,  FL } },
 257 { .ca_index = 0x14,  .speakers = { FRC,  FLC,   0,   0,   0,    0,  FR,  FL } },
 258 { .ca_index = 0x15,  .speakers = { FRC,  FLC,   0,   0,   0,  LFE,  FR,  FL } },
 259 { .ca_index = 0x16,  .speakers = { FRC,  FLC,   0,   0,  FC,    0,  FR,  FL } },
 260 { .ca_index = 0x17,  .speakers = { FRC,  FLC,   0,   0,  FC,  LFE,  FR,  FL } },
 261 { .ca_index = 0x18,  .speakers = { FRC,  FLC,   0,  RC,   0,    0,  FR,  FL } },
 262 { .ca_index = 0x19,  .speakers = { FRC,  FLC,   0,  RC,   0,  LFE,  FR,  FL } },
 263 { .ca_index = 0x1a,  .speakers = { FRC,  FLC,   0,  RC,  FC,    0,  FR,  FL } },
 264 { .ca_index = 0x1b,  .speakers = { FRC,  FLC,   0,  RC,  FC,  LFE,  FR,  FL } },
 265 { .ca_index = 0x1c,  .speakers = { FRC,  FLC,  RR,  RL,   0,    0,  FR,  FL } },
 266 { .ca_index = 0x1d,  .speakers = { FRC,  FLC,  RR,  RL,   0,  LFE,  FR,  FL } },
 267 { .ca_index = 0x1e,  .speakers = { FRC,  FLC,  RR,  RL,  FC,    0,  FR,  FL } },
 268 { .ca_index = 0x1f,  .speakers = { FRC,  FLC,  RR,  RL,  FC,  LFE,  FR,  FL } },
 269 { .ca_index = 0x20,  .speakers = {   0,  FCH,  RR,  RL,  FC,    0,  FR,  FL } },
 270 { .ca_index = 0x21,  .speakers = {   0,  FCH,  RR,  RL,  FC,  LFE,  FR,  FL } },
 271 { .ca_index = 0x22,  .speakers = {  TC,    0,  RR,  RL,  FC,    0,  FR,  FL } },
 272 { .ca_index = 0x23,  .speakers = {  TC,    0,  RR,  RL,  FC,  LFE,  FR,  FL } },
 273 { .ca_index = 0x24,  .speakers = { FRH,  FLH,  RR,  RL,   0,    0,  FR,  FL } },
 274 { .ca_index = 0x25,  .speakers = { FRH,  FLH,  RR,  RL,   0,  LFE,  FR,  FL } },
 275 { .ca_index = 0x26,  .speakers = { FRW,  FLW,  RR,  RL,   0,    0,  FR,  FL } },
 276 { .ca_index = 0x27,  .speakers = { FRW,  FLW,  RR,  RL,   0,  LFE,  FR,  FL } },
 277 { .ca_index = 0x28,  .speakers = {  TC,   RC,  RR,  RL,  FC,    0,  FR,  FL } },
 278 { .ca_index = 0x29,  .speakers = {  TC,   RC,  RR,  RL,  FC,  LFE,  FR,  FL } },
 279 { .ca_index = 0x2a,  .speakers = { FCH,   RC,  RR,  RL,  FC,    0,  FR,  FL } },
 280 { .ca_index = 0x2b,  .speakers = { FCH,   RC,  RR,  RL,  FC,  LFE,  FR,  FL } },
 281 { .ca_index = 0x2c,  .speakers = {  TC,  FCH,  RR,  RL,  FC,    0,  FR,  FL } },
 282 { .ca_index = 0x2d,  .speakers = {  TC,  FCH,  RR,  RL,  FC,  LFE,  FR,  FL } },
 283 { .ca_index = 0x2e,  .speakers = { FRH,  FLH,  RR,  RL,  FC,    0,  FR,  FL } },
 284 { .ca_index = 0x2f,  .speakers = { FRH,  FLH,  RR,  RL,  FC,  LFE,  FR,  FL } },
 285 { .ca_index = 0x30,  .speakers = { FRW,  FLW,  RR,  RL,  FC,    0,  FR,  FL } },
 286 { .ca_index = 0x31,  .speakers = { FRW,  FLW,  RR,  RL,  FC,  LFE,  FR,  FL } },
 287 };
 288
 289
 290 /*
 291  * HDMI routines
 292  */
 293
 294 static int pin_nid_to_pin_index(struct hdmi_spec *spec, hda_nid_t pin_nid)
 295 {
 296         int pin_idx;
 297
 298         for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++)
 299                 if (spec->pins[pin_idx].pin_nid == pin_nid)
 300                         return pin_idx;
 301
 302         snd_printk(KERN_WARNING "HDMI: pin nid %d not registered\n", pin_nid);
 303         return -EINVAL;
 304 }
 305
 306 static int hinfo_to_pin_index(struct hdmi_spec *spec,
 307                               struct hda_pcm_stream *hinfo)
 308 {
 309         int pin_idx;
 310
 311         for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++)
 312                 if (&spec->pcm_rec[pin_idx].stream[0] == hinfo)
 313                         return pin_idx;
 314
 315         snd_printk(KERN_WARNING "HDMI: hinfo %p not registered\n", hinfo);
 316         return -EINVAL;
 317 }
 318
 319 static int cvt_nid_to_cvt_index(struct hdmi_spec *spec, hda_nid_t cvt_nid)
 320 {
 321         int cvt_idx;
 322
 323         for (cvt_idx = 0; cvt_idx < spec->num_cvts; cvt_idx++)
 324                 if (spec->cvts[cvt_idx].cvt_nid == cvt_nid)
 325                         return cvt_idx;
 326
 327         snd_printk(KERN_WARNING "HDMI: cvt nid %d not registered\n", cvt_nid);
 328         return -EINVAL;
 329 }
 330
 331 static int hdmi_eld_ctl_info(struct snd_kcontrol *kcontrol,
 332                         struct snd_ctl_elem_info *uinfo)
 333 {
 334         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
 335         struct hdmi_spec *spec;
 336         int pin_idx;
 337
 338         spec = codec->spec;
 339         uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES;
 340
 341         pin_idx = kcontrol->private_value;
 342         uinfo->count = spec->pins[pin_idx].sink_eld.eld_size;
 343
 344         return 0;
 345 }
 346
 347 static int hdmi_eld_ctl_get(struct snd_kcontrol *kcontrol,
 348                         struct snd_ctl_elem_value *ucontrol)
 349 {
 350         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
 351         struct hdmi_spec *spec;
 352         int pin_idx;
 353
 354         spec = codec->spec;
 355         pin_idx = kcontrol->private_value;
 356
 357         memcpy(ucontrol->value.bytes.data,
 358                 spec->pins[pin_idx].sink_eld.eld_buffer, ELD_MAX_SIZE);
 359
 360         return 0;
 361 }
 362
 363 static struct snd_kcontrol_new eld_bytes_ctl = {
 364         .access = SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_VOLATILE,
 365         .iface = SNDRV_CTL_ELEM_IFACE_PCM,
 366         .name = "ELD",
 367         .info = hdmi_eld_ctl_info,
 368         .get = hdmi_eld_ctl_get,
 369 };
 370
 371 static int hdmi_create_eld_ctl(struct hda_codec *codec, int pin_idx,
 372                         int device)
 373 {
 374         struct snd_kcontrol *kctl;
 375         struct hdmi_spec *spec = codec->spec;
 376         int err;
 377
 378         kctl = snd_ctl_new1(&eld_bytes_ctl, codec);
 379         if (!kctl)
 380                 return -ENOMEM;
 381         kctl->private_value = pin_idx;
 382         kctl->id.device = device;
 383
 384         err = snd_hda_ctl_add(codec, spec->pins[pin_idx].pin_nid, kctl);
 385         if (err < 0)
 386                 return err;
 387
 388         return 0;
 389 }
 390
 391 #ifdef BE_PARANOID
 392 static void hdmi_get_dip_index(struct hda_codec *codec, hda_nid_t pin_nid,
 393                                 int *packet_index, int *byte_index)
 394 {
 395         int val;
 396
 397         val = snd_hda_codec_read(codec, pin_nid, 0,
 398                                  AC_VERB_GET_HDMI_DIP_INDEX, 0);
 399
 400         *packet_index = val >> 5;
 401         *byte_index = val & 0x1f;
 402 }
 403 #endif
 404
 405 static void hdmi_set_dip_index(struct hda_codec *codec, hda_nid_t pin_nid,
 406                                 int packet_index, int byte_index)
 407 {
 408         int val;
 409
 410         val = (packet_index << 5) | (byte_index & 0x1f);
 411
 412         snd_hda_codec_write(codec, pin_nid, 0, AC_VERB_SET_HDMI_DIP_INDEX, val);
 413 }
 414
 415 static void hdmi_write_dip_byte(struct hda_codec *codec, hda_nid_t pin_nid,
 416                                 unsigned char val)
 417 {
 418         snd_hda_codec_write(codec, pin_nid, 0, AC_VERB_SET_HDMI_DIP_DATA, val);
 419 }
 420
 421 static void hdmi_init_pin(struct hda_codec *codec, hda_nid_t pin_nid)
 422 {
 423         /* Unmute */
 424         if (get_wcaps(codec, pin_nid) & AC_WCAP_OUT_AMP)
 425                 snd_hda_codec_write(codec, pin_nid, 0,
 426                                 AC_VERB_SET_AMP_GAIN_MUTE, AMP_OUT_UNMUTE);
 427         /* Disable pin out until stream is active*/
 428         snd_hda_codec_write(codec, pin_nid, 0,
 429                             AC_VERB_SET_PIN_WIDGET_CONTROL, 0);
 430 }
 431
 432 static int hdmi_get_channel_count(struct hda_codec *codec, hda_nid_t cvt_nid)
 433 {
 434         return 1 + snd_hda_codec_read(codec, cvt_nid, 0,
 435                                         AC_VERB_GET_CVT_CHAN_COUNT, 0);
 436 }
 437
 438 static void hdmi_set_channel_count(struct hda_codec *codec,
 439                                    hda_nid_t cvt_nid, int chs)
 440 {
 441         if (chs != hdmi_get_channel_count(codec, cvt_nid))
 442                 snd_hda_codec_write(codec, cvt_nid, 0,
 443                                     AC_VERB_SET_CVT_CHAN_COUNT, chs - 1);
 444 }
 445
 446
 447 /*
 448  * Channel mapping routines
 449  */
 450
 451 /*
 452  * Compute derived values in channel_allocations[].
 453  */
 454 static void init_channel_allocations(void)
 455 {
 456         int i, j;
 457         struct cea_channel_speaker_allocation *p;
 458
 459         for (i = 0; i < ARRAY_SIZE(channel_allocations); i++) {
 460                 p = channel_allocations + i;
 461                 p->channels = 0;
 462                 p->spk_mask = 0;
 463                 for (j = 0; j < ARRAY_SIZE(p->speakers); j++)
 464                         if (p->speakers[j]) {
 465                                 p->channels++;
 466                                 p->spk_mask |= p->speakers[j];
 467                         }
 468         }
 469 }
 470
 471 /*
 472  * The transformation takes two steps:
 473  *
 474  *      eld->spk_alloc => (eld_speaker_allocation_bits[]) => spk_mask
 475  *            spk_mask => (channel_allocations[])         => ai->CA
 476  *
 477  * TODO: it could select the wrong CA from multiple candidates.
 478 */
 479 static int hdmi_channel_allocation(struct hdmi_eld *eld, int channels)
 480 {
 481         int i;
 482         int ca = 0;
 483         int spk_mask = 0;
 484         char buf[SND_PRINT_CHANNEL_ALLOCATION_ADVISED_BUFSIZE];
 485
 486         /*
 487          * CA defaults to 0 for basic stereo audio
 488          */
 489         if (channels <= 2)
 490                 return 0;
 491
 492         /*
 493          * expand ELD's speaker allocation mask
 494          *
 495          * ELD tells the speaker mask in a compact(paired) form,
 496          * expand ELD's notions to match the ones used by Audio InfoFrame.
 497          */
 498         for (i = 0; i < ARRAY_SIZE(eld_speaker_allocation_bits); i++) {
 499                 if (eld->spk_alloc & (1 << i))
 500                         spk_mask |= eld_speaker_allocation_bits[i];
 501         }
 502
 503         /* search for the first working match in the CA table */
 504         for (i = 0; i < ARRAY_SIZE(channel_allocations); i++) {
 505                 if (channels == channel_allocations[i].channels &&
 506                     (spk_mask & channel_allocations[i].spk_mask) ==
 507                                 channel_allocations[i].spk_mask) {
 508                         ca = channel_allocations[i].ca_index;
 509                         break;
 510                 }
 511         }
 512
 513         snd_print_channel_allocation(eld->spk_alloc, buf, sizeof(buf));
 514         snd_printdd("HDMI: select CA 0x%x for %d-channel allocation: %s\n",
 515                     ca, channels, buf);
 516
 517         return ca;
 518 }
 519
 520 static void hdmi_debug_channel_mapping(struct hda_codec *codec,
 521                                        hda_nid_t pin_nid)
 522 {
 523 #ifdef CONFIG_SND_DEBUG_VERBOSE
 524         int i;
 525         int slot;
 526
 527         for (i = 0; i < 8; i++) {
 528                 slot = snd_hda_codec_read(codec, pin_nid, 0,
 529                                                 AC_VERB_GET_HDMI_CHAN_SLOT, i);
 530                 printk(KERN_DEBUG "HDMI: ASP channel %d => slot %d\n",
 531                                                 slot >> 4, slot & 0xf);
 532         }
 533 #endif
 534 }
 535
 536
 537 static void hdmi_setup_channel_mapping(struct hda_codec *codec,
 538                                        hda_nid_t pin_nid,
 539                                        int ca)
 540 {
 541         int i;
 542         int err;
 543
 544         if (hdmi_channel_mapping[ca][1] == 0) {
 545                 for (i = 0; i < channel_allocations[ca].channels; i++)
 546                         hdmi_channel_mapping[ca][i] = i | (i << 4);
 547                 for (; i < 8; i++)
 548                         hdmi_channel_mapping[ca][i] = 0xf | (i << 4);
 549         }
 550
 551         for (i = 0; i < 8; i++) {
 552                 err = snd_hda_codec_write(codec, pin_nid, 0,
 553                                           AC_VERB_SET_HDMI_CHAN_SLOT,
 554                                           hdmi_channel_mapping[ca][i]);
 555                 if (err) {
 556                         snd_printdd(KERN_NOTICE
 557                                     "HDMI: channel mapping failed\n");
 558                         break;
 559                 }
 560         }
 561
 562         hdmi_debug_channel_mapping(codec, pin_nid);
 563 }
 564
 565
 566 /*
 567  * Audio InfoFrame routines
 568  */
 569
 570 /*
 571  * Enable Audio InfoFrame Transmission
 572  */
 573 static void hdmi_start_infoframe_trans(struct hda_codec *codec,
 574                                        hda_nid_t pin_nid)
 575 {
 576         hdmi_set_dip_index(codec, pin_nid, 0x0, 0x0);
 577         snd_hda_codec_write(codec, pin_nid, 0, AC_VERB_SET_HDMI_DIP_XMIT,
 578                                                 AC_DIPXMIT_BEST);
 579 }
 580
 581 /*
 582  * Disable Audio InfoFrame Transmission
 583  */
 584 static void hdmi_stop_infoframe_trans(struct hda_codec *codec,
 585                                       hda_nid_t pin_nid)
 586 {
 587         hdmi_set_dip_index(codec, pin_nid, 0x0, 0x0);
 588         snd_hda_codec_write(codec, pin_nid, 0, AC_VERB_SET_HDMI_DIP_XMIT,
 589                                                 AC_DIPXMIT_DISABLE);
 590 }
 591
 592 static void hdmi_debug_dip_size(struct hda_codec *codec, hda_nid_t pin_nid)
 593 {
 594 #ifdef CONFIG_SND_DEBUG_VERBOSE
 595         int i;
 596         int size;
 597
 598         size = snd_hdmi_get_eld_size(codec, pin_nid);
 599         printk(KERN_DEBUG "HDMI: ELD buf size is %d\n", size);
 600
 601         for (i = 0; i < 8; i++) {
 602                 size = snd_hda_codec_read(codec, pin_nid, 0,
 603                                                 AC_VERB_GET_HDMI_DIP_SIZE, i);
 604                 printk(KERN_DEBUG "HDMI: DIP GP[%d] buf size is %d\n", i, size);
 605         }
 606 #endif
 607 }
 608
 609 static void hdmi_clear_dip_buffers(struct hda_codec *codec, hda_nid_t pin_nid)
 610 {
 611 #ifdef BE_PARANOID
 612         int i, j;
 613         int size;
 614         int pi, bi;
 615         for (i = 0; i < 8; i++) {
 616                 size = snd_hda_codec_read(codec, pin_nid, 0,
 617                                                 AC_VERB_GET_HDMI_DIP_SIZE, i);
 618                 if (size == 0)
 619                         continue;
 620
 621                 hdmi_set_dip_index(codec, pin_nid, i, 0x0);
 622                 for (j = 1; j < 1000; j++) {
 623                         hdmi_write_dip_byte(codec, pin_nid, 0x0);
 624                         hdmi_get_dip_index(codec, pin_nid, &pi, &bi);
 625                         if (pi != i)
 626                                 snd_printd(KERN_INFO "dip index %d: %d != %d\n",
 627                                                 bi, pi, i);
 628                         if (bi == 0) /* byte index wrapped around */
 629                                 break;
 630                 }
 631                 snd_printd(KERN_INFO
 632                         "HDMI: DIP GP[%d] buf reported size=%d, written=%d\n",
 633                         i, size, j);
 634         }
 635 #endif
 636 }
 637
 638 static void hdmi_checksum_audio_infoframe(struct hdmi_audio_infoframe *hdmi_ai)
 639 {
 640         u8 *bytes = (u8 *)hdmi_ai;
 641         u8 sum = 0;
 642         int i;
 643
 644         hdmi_ai->checksum = 0;
 645
 646         for (i = 0; i < sizeof(*hdmi_ai); i++)
 647                 sum += bytes[i];
 648
 649         hdmi_ai->checksum = -sum;
 650 }
 651
 652 static void hdmi_fill_audio_infoframe(struct hda_codec *codec,
 653                                       hda_nid_t pin_nid,
 654                                       u8 *dip, int size)
 655 {
 656         int i;
 657
 658         hdmi_debug_dip_size(codec, pin_nid);
 659         hdmi_clear_dip_buffers(codec, pin_nid); /* be paranoid */
 660
 661         hdmi_set_dip_index(codec, pin_nid, 0x0, 0x0);
 662         for (i = 0; i < size; i++)
 663                 hdmi_write_dip_byte(codec, pin_nid, dip[i]);
 664 }
 665
 666 static bool hdmi_infoframe_uptodate(struct hda_codec *codec, hda_nid_t pin_nid,
 667                                     u8 *dip, int size)
 668 {
 669         u8 val;
 670         int i;
 671
 672         if (snd_hda_codec_read(codec, pin_nid, 0, AC_VERB_GET_HDMI_DIP_XMIT, 0)
 673                                                             != AC_DIPXMIT_BEST)
 674                 return false;
 675
 676         hdmi_set_dip_index(codec, pin_nid, 0x0, 0x0);
 677         for (i = 0; i < size; i++) {
 678                 val = snd_hda_codec_read(codec, pin_nid, 0,
 679                                          AC_VERB_GET_HDMI_DIP_DATA, 0);
 680                 if (val != dip[i])
 681                         return false;
 682         }
 683
 684         return true;
 685 }
 686
 687 static void hdmi_setup_audio_infoframe(struct hda_codec *codec, int pin_idx,
 688                                         struct snd_pcm_substream *substream)
 689 {
 690         struct hdmi_spec *spec = codec->spec;
 691         struct hdmi_spec_per_pin *per_pin = &spec->pins[pin_idx];
 692         hda_nid_t pin_nid = per_pin->pin_nid;
 693         int channels = substream->runtime->channels;
 694         struct hdmi_eld *eld;
 695         int ca;
 696         union audio_infoframe ai;
 697
 698         eld = &spec->pins[pin_idx].sink_eld;
 699         if (!eld->monitor_present)
 700                 return;
 701
 702         ca = hdmi_channel_allocation(eld, channels);
 703
 704         memset(&ai, 0, sizeof(ai));
 705         if (eld->conn_type == 0) { /* HDMI */
 706                 struct hdmi_audio_infoframe *hdmi_ai = &ai.hdmi;
 707
 708                 hdmi_ai->type           = 0x84;
 709                 hdmi_ai->ver            = 0x01;
 710                 hdmi_ai->len            = 0x0a;
 711                 hdmi_ai->CC02_CT47      = channels - 1;
 712                 hdmi_ai->CA             = ca;
 713                 hdmi_checksum_audio_infoframe(hdmi_ai);
 714         } else if (eld->conn_type == 1) { /* DisplayPort */
 715                 struct dp_audio_infoframe *dp_ai = &ai.dp;
 716
 717                 dp_ai->type             = 0x84;
 718                 dp_ai->len              = 0x1b;
 719                 dp_ai->ver              = 0x11 << 2;
 720                 dp_ai->CC02_CT47        = channels - 1;
 721                 dp_ai->CA               = ca;
 722         } else {
 723                 snd_printd("HDMI: unknown connection type at pin %d\n",
 724                             pin_nid);
 725                 return;
 726         }
 727
 728         /*
 729          * sizeof(ai) is used instead of sizeof(*hdmi_ai) or
 730          * sizeof(*dp_ai) to avoid partial match/update problems when
 731          * the user switches between HDMI/DP monitors.
 732          */
 733         if (!hdmi_infoframe_uptodate(codec, pin_nid, ai.bytes,
 734                                         sizeof(ai))) {
 735                 snd_printdd("hdmi_setup_audio_infoframe: "
 736                             "pin=%d channels=%d\n",
 737                             pin_nid,
 738                             channels);
 739                 hdmi_setup_channel_mapping(codec, pin_nid, ca);
 740                 hdmi_stop_infoframe_trans(codec, pin_nid);
 741                 hdmi_fill_audio_infoframe(codec, pin_nid,
 742                                             ai.bytes, sizeof(ai));
 743                 hdmi_start_infoframe_trans(codec, pin_nid);
 744         }
 745 }
 746
 747
 748 /*
 749  * Unsolicited events
 750  */
 751
 752 static void hdmi_present_sense(struct hdmi_spec_per_pin *per_pin, bool retry);
 753
 754 static void hdmi_intrinsic_event(struct hda_codec *codec, unsigned int res)
 755 {
 756         struct hdmi_spec *spec = codec->spec;
 757         int pin_nid = res >> AC_UNSOL_RES_TAG_SHIFT;
 758         int pd = !!(res & AC_UNSOL_RES_PD);
 759         int eldv = !!(res & AC_UNSOL_RES_ELDV);
 760         int pin_idx;
 761
 762         printk(KERN_INFO
 763                 "HDMI hot plug event: Codec=%d Pin=%d Presence_Detect=%d ELD_Valid=%d\n",
 764                 codec->addr, pin_nid, pd, eldv);
 765
 766         pin_idx = pin_nid_to_pin_index(spec, pin_nid);
 767         if (pin_idx < 0)
 768                 return;
 769
 770         snd_hda_jack_set_dirty(codec, pin_nid);
 771         hdmi_present_sense(&spec->pins[pin_idx], true);
 772         snd_hda_jack_report_sync(codec);
 773 }
 774
 775 static void hdmi_non_intrinsic_event(struct hda_codec *codec, unsigned int res)
 776 {
 777         int tag = res >> AC_UNSOL_RES_TAG_SHIFT;
 778         int subtag = (res & AC_UNSOL_RES_SUBTAG) >> AC_UNSOL_RES_SUBTAG_SHIFT;
 779         int cp_state = !!(res & AC_UNSOL_RES_CP_STATE);
 780         int cp_ready = !!(res & AC_UNSOL_RES_CP_READY);
 781
 782         printk(KERN_INFO
 783                 "HDMI CP event: CODEC=%d PIN=%d SUBTAG=0x%x CP_STATE=%d CP_READY=%d\n",
 784                 codec->addr,
 785                 tag,
 786                 subtag,
 787                 cp_state,
 788                 cp_ready);
 789
 790         /* TODO */
 791         if (cp_state)
 792                 ;
 793         if (cp_ready)
 794                 ;
 795 }
 796
 797
 798 static void hdmi_unsol_event(struct hda_codec *codec, unsigned int res)
 799 {
 800         struct hdmi_spec *spec = codec->spec;
 801         int tag = res >> AC_UNSOL_RES_TAG_SHIFT;
 802         int subtag = (res & AC_UNSOL_RES_SUBTAG) >> AC_UNSOL_RES_SUBTAG_SHIFT;
 803
 804         if (pin_nid_to_pin_index(spec, tag) < 0) {
 805                 snd_printd(KERN_INFO "Unexpected HDMI event tag 0x%x\n", tag);
 806                 return;
 807         }
 808
 809         if (subtag == 0)
 810                 hdmi_intrinsic_event(codec, res);
 811         else
 812                 hdmi_non_intrinsic_event(codec, res);
 813 }
 814
 815 /*
 816  * Callbacks
 817  */
 818
 819 /* HBR should be Non-PCM, 8 channels */
 820 #define is_hbr_format(format) \
 821         ((format & AC_FMT_TYPE_NON_PCM) && (format & AC_FMT_CHAN_MASK) == 7)
 822
 823 static int hdmi_setup_stream(struct hda_codec *codec, hda_nid_t cvt_nid,
 824                               hda_nid_t pin_nid, u32 stream_tag, int format)
 825 {
 826         int pinctl;
 827         int new_pinctl = 0;
 828
 829         if (snd_hda_query_pin_caps(codec, pin_nid) & AC_PINCAP_HBR) {
 830                 pinctl = snd_hda_codec_read(codec, pin_nid, 0,
 831                                             AC_VERB_GET_PIN_WIDGET_CONTROL, 0);
 832
 833                 new_pinctl = pinctl & ~AC_PINCTL_EPT;
 834                 if (is_hbr_format(format))
 835                         new_pinctl |= AC_PINCTL_EPT_HBR;
 836                 else
 837                         new_pinctl |= AC_PINCTL_EPT_NATIVE;
 838
 839                 snd_printdd("hdmi_setup_stream: "
 840                             "NID=0x%x, %spinctl=0x%x\n",
 841                             pin_nid,
 842                             pinctl == new_pinctl ? "" : "new-",
 843                             new_pinctl);
 844
 845                 if (pinctl != new_pinctl)
 846                         snd_hda_codec_write(codec, pin_nid, 0,
 847                                             AC_VERB_SET_PIN_WIDGET_CONTROL,
 848                                             new_pinctl);
 849
 850         }
 851         if (is_hbr_format(format) && !new_pinctl) {
 852                 snd_printdd("hdmi_setup_stream: HBR is not supported\n");
 853                 return -EINVAL;
 854         }
 855
 856         snd_hda_codec_setup_stream(codec, cvt_nid, stream_tag, 0, format);
 857         return 0;
 858 }
 859
 860 /*
 861  * HDA PCM callbacks
 862  */
 863 static int hdmi_pcm_open(struct hda_pcm_stream *hinfo,
 864                          struct hda_codec *codec,
 865                          struct snd_pcm_substream *substream)
 866 {
 867         struct hdmi_spec *spec = codec->spec;
 868         struct snd_pcm_runtime *runtime = substream->runtime;
 869         int pin_idx, cvt_idx, mux_idx = 0;
 870         struct hdmi_spec_per_pin *per_pin;
 871         struct hdmi_eld *eld;
 872         struct hdmi_spec_per_cvt *per_cvt = NULL;
 873         int pinctl;
 874
 875         /* Validate hinfo */
 876         pin_idx = hinfo_to_pin_index(spec, hinfo);
 877         if (snd_BUG_ON(pin_idx < 0))
 878                 return -EINVAL;
 879         per_pin = &spec->pins[pin_idx];
 880         eld = &per_pin->sink_eld;
 881
 882         /* Dynamically assign converter to stream */
 883         for (cvt_idx = 0; cvt_idx < spec->num_cvts; cvt_idx++) {
 884                 per_cvt = &spec->cvts[cvt_idx];
 885
 886                 /* Must not already be assigned */
 887                 if (per_cvt->assigned)
 888                         continue;
 889                 /* Must be in pin's mux's list of converters */
 890                 for (mux_idx = 0; mux_idx < per_pin->num_mux_nids; mux_idx++)
 891                         if (per_pin->mux_nids[mux_idx] == per_cvt->cvt_nid)
 892                                 break;
 893                 /* Not in mux list */
 894                 if (mux_idx == per_pin->num_mux_nids)
 895                         continue;
 896                 break;
 897         }
 898         /* No free converters */
 899         if (cvt_idx == spec->num_cvts)
 900                 return -ENODEV;
 901
 902         /* Claim converter */
 903         per_cvt->assigned = 1;
 904         hinfo->nid = per_cvt->cvt_nid;
 905
 906         snd_hda_codec_write(codec, per_pin->pin_nid, 0,
 907                             AC_VERB_SET_CONNECT_SEL,
 908                             mux_idx);
 909         pinctl = snd_hda_codec_read(codec, per_pin->pin_nid, 0,
 910                                     AC_VERB_GET_PIN_WIDGET_CONTROL, 0);
 911         snd_hda_codec_write(codec, per_pin->pin_nid, 0,
 912                             AC_VERB_SET_PIN_WIDGET_CONTROL,
 913                             pinctl | PIN_OUT);
 914         snd_hda_spdif_ctls_assign(codec, pin_idx, per_cvt->cvt_nid);
 915
 916         /* Initially set the converter's capabilities */
 917         hinfo->channels_min = per_cvt->channels_min;
 918         hinfo->channels_max = per_cvt->channels_max;
 919         hinfo->rates = per_cvt->rates;
 920         hinfo->formats = per_cvt->formats;
 921         hinfo->maxbps = per_cvt->maxbps;
 922
 923         /* Restrict capabilities by ELD if this isn't disabled */
 924         if (!static_hdmi_pcm && eld->eld_valid) {
 925                 snd_hdmi_eld_update_pcm_info(eld, hinfo);
 926                 if (hinfo->channels_min > hinfo->channels_max ||
 927                     !hinfo->rates || !hinfo->formats)
 928                         return -ENODEV;
 929         }
 930
 931         /* Store the updated parameters */
 932         runtime->hw.channels_min = hinfo->channels_min;
 933         runtime->hw.channels_max = hinfo->channels_max;
 934         runtime->hw.formats = hinfo->formats;
 935         runtime->hw.rates = hinfo->rates;
 936
 937         snd_pcm_hw_constraint_step(substream->runtime, 0,
 938                                    SNDRV_PCM_HW_PARAM_CHANNELS, 2);
 939         return 0;
 940 }
 941
 942 /*
 943  * HDA/HDMI auto parsing
 944  */
 945 static int hdmi_read_pin_conn(struct hda_codec *codec, int pin_idx)
 946 {
 947         struct hdmi_spec *spec = codec->spec;
 948         struct hdmi_spec_per_pin *per_pin = &spec->pins[pin_idx];
 949         hda_nid_t pin_nid = per_pin->pin_nid;
 950
 951         if (!(get_wcaps(codec, pin_nid) & AC_WCAP_CONN_LIST)) {
 952                 snd_printk(KERN_WARNING
 953                            "HDMI: pin %d wcaps %#x "
 954                            "does not support connection list\n",
 955                            pin_nid, get_wcaps(codec, pin_nid));
 956                 return -EINVAL;
 957         }
 958
 959         per_pin->num_mux_nids = snd_hda_get_connections(codec, pin_nid,
 960                                                         per_pin->mux_nids,
 961                                                         HDA_MAX_CONNECTIONS);
 962
 963         return 0;
 964 }
 965
 966 static void hdmi_present_sense(struct hdmi_spec_per_pin *per_pin, bool retry)
 967 {
 968         struct hda_codec *codec = per_pin->codec;
 969         struct hdmi_eld *eld = &per_pin->sink_eld;
 970         hda_nid_t pin_nid = per_pin->pin_nid;
 971         /*
 972          * Always execute a GetPinSense verb here, even when called from
 973          * hdmi_intrinsic_event; for some NVIDIA HW, the unsolicited
 974          * response's PD bit is not the real PD value, but indicates that
 975          * the real PD value changed. An older version of the HD-audio
 976          * specification worked this way. Hence, we just ignore the data in
 977          * the unsolicited response to avoid custom WARs.
 978          */
 979         int present = snd_hda_pin_sense(codec, pin_nid);
 980         bool eld_valid = false;
 981
 982         memset(eld, 0, offsetof(struct hdmi_eld, eld_buffer));
 983
 984         eld->monitor_present    = !!(present & AC_PINSENSE_PRESENCE);
 985         if (eld->monitor_present)
 986                 eld_valid       = !!(present & AC_PINSENSE_ELDV);
 987
 988         printk(KERN_INFO
 989                 "HDMI status: Codec=%d Pin=%d Presence_Detect=%d ELD_Valid=%d\n",
 990                 codec->addr, pin_nid, eld->monitor_present, eld_valid);
 991
 992         if (eld_valid) {
 993                 if (!snd_hdmi_get_eld(eld, codec, pin_nid))
 994                         snd_hdmi_show_eld(eld);
 995                 else if (retry) {
 996                         queue_delayed_work(codec->bus->workq,
 997                                            &per_pin->work,
 998                                            msecs_to_jiffies(300));
 999                 }
1000         }
1001
1002         snd_hda_input_jack_report(codec, pin_nid);
1003 }
1004
1005 static void hdmi_repoll_eld(struct work_struct *work)
1006 {
1007         struct hdmi_spec_per_pin *per_pin =
1008         container_of(to_delayed_work(work), struct hdmi_spec_per_pin, work);
1009
1010         hdmi_present_sense(per_pin, false);
1011 }
1012
1013 static int hdmi_add_pin(struct hda_codec *codec, hda_nid_t pin_nid)
1014 {
1015         struct hdmi_spec *spec = codec->spec;
1016         unsigned int caps, config;
1017         int pin_idx;
1018         struct hdmi_spec_per_pin *per_pin;
1019         int err;
1020
1021         caps = snd_hda_param_read(codec, pin_nid, AC_PAR_PIN_CAP);
1022         if (!(caps & (AC_PINCAP_HDMI | AC_PINCAP_DP)))
1023                 return 0;
1024
1025         config = snd_hda_codec_read(codec, pin_nid, 0,
1026                                 AC_VERB_GET_CONFIG_DEFAULT, 0);
1027         if (get_defcfg_connect(config) == AC_JACK_PORT_NONE)
1028                 return 0;
1029
1030         if (snd_BUG_ON(spec->num_pins >= MAX_HDMI_PINS))
1031                 return -E2BIG;
1032
1033         pin_idx = spec->num_pins;
1034         per_pin = &spec->pins[pin_idx];
1035
1036         per_pin->pin_nid = pin_nid;
1037
1038         err = hdmi_read_pin_conn(codec, pin_idx);
1039         if (err < 0)
1040                 return err;
1041
1042         spec->num_pins++;
1043
1044         return 0;
1045 }
1046
1047 static int hdmi_add_cvt(struct hda_codec *codec, hda_nid_t cvt_nid)
1048 {
1049         struct hdmi_spec *spec = codec->spec;
1050         int cvt_idx;
1051         struct hdmi_spec_per_cvt *per_cvt;
1052         unsigned int chans;
1053         int err;
1054
1055         if (snd_BUG_ON(spec->num_cvts >= MAX_HDMI_CVTS))
1056                 return -E2BIG;
1057
1058         chans = get_wcaps(codec, cvt_nid);
1059         chans = get_wcaps_channels(chans);
1060
1061         cvt_idx = spec->num_cvts;
1062         per_cvt = &spec->cvts[cvt_idx];
1063
1064         per_cvt->cvt_nid = cvt_nid;
1065         per_cvt->channels_min = 2;
1066         if (chans <= 16)
1067                 per_cvt->channels_max = chans;
1068
1069         err = snd_hda_query_supported_pcm(codec, cvt_nid,
1070                                           &per_cvt->rates,
1071                                           &per_cvt->formats,
1072                                           &per_cvt->maxbps);
1073         if (err < 0)
1074                 return err;
1075
1076         spec->num_cvts++;
1077
1078         return 0;
1079 }
1080
1081 static int hdmi_parse_codec(struct hda_codec *codec)
1082 {
1083         hda_nid_t nid;
1084         int i, nodes;
1085
1086         nodes = snd_hda_get_sub_nodes(codec, codec->afg, &nid);
1087         if (!nid || nodes < 0) {
1088                 snd_printk(KERN_WARNING "HDMI: failed to get afg sub nodes\n");
1089                 return -EINVAL;
1090         }
1091
1092         for (i = 0; i < nodes; i++, nid++) {
1093                 unsigned int caps;
1094                 unsigned int type;
1095
1096                 caps = snd_hda_param_read(codec, nid, AC_PAR_AUDIO_WIDGET_CAP);
1097                 type = get_wcaps_type(caps);
1098
1099                 if (!(caps & AC_WCAP_DIGITAL))
1100                         continue;
1101
1102                 switch (type) {
1103                 case AC_WID_AUD_OUT:
1104                         hdmi_add_cvt(codec, nid);
1105                         break;
1106                 case AC_WID_PIN:
1107                         hdmi_add_pin(codec, nid);
1108                         break;
1109                 }
1110         }
1111
1112         /*
1113          * G45/IbexPeak don't support EPSS: the unsolicited pin hot plug event
1114          * can be lost and presence sense verb will become inaccurate if the
1115          * HDA link is powered off at hot plug or hw initialization time.
1116          */
1117 #ifdef CONFIG_SND_HDA_POWER_SAVE
1118         if (!(snd_hda_param_read(codec, codec->afg, AC_PAR_POWER_STATE) &
1119               AC_PWRST_EPSS))
1120                 codec->bus->power_keep_link_on = 1;
1121 #endif
1122
1123         return 0;
1124 }
1125
1126 /*
1127  */
1128 static char *generic_hdmi_pcm_names[MAX_HDMI_PINS] = {
1129         "HDMI 0",
1130         "HDMI 1",
1131         "HDMI 2",
1132         "HDMI 3",
1133 };
1134
1135 /*
1136  * HDMI callbacks
1137  */
1138
1139 static int generic_hdmi_playback_pcm_prepare(struct hda_pcm_stream *hinfo,
1140                                            struct hda_codec *codec,
1141                                            unsigned int stream_tag,
1142                                            unsigned int format,
1143                                            struct snd_pcm_substream *substream)
1144 {
1145         hda_nid_t cvt_nid = hinfo->nid;
1146         struct hdmi_spec *spec = codec->spec;
1147         int pin_idx = hinfo_to_pin_index(spec, hinfo);
1148         hda_nid_t pin_nid = spec->pins[pin_idx].pin_nid;
1149
1150         hdmi_set_channel_count(codec, cvt_nid, substream->runtime->channels);
1151
1152         hdmi_setup_audio_infoframe(codec, pin_idx, substream);
1153
1154         return hdmi_setup_stream(codec, cvt_nid, pin_nid, stream_tag, format);
1155 }
1156
1157 static int generic_hdmi_playback_pcm_cleanup(struct hda_pcm_stream *hinfo,
1158                                              struct hda_codec *codec,
1159                                              struct snd_pcm_substream *substream)
1160 {
1161         struct hdmi_spec *spec = codec->spec;
1162         int cvt_idx, pin_idx;
1163         struct hdmi_spec_per_cvt *per_cvt;
1164         struct hdmi_spec_per_pin *per_pin;
1165         int pinctl;
1166
1167         snd_hda_codec_cleanup_stream(codec, hinfo->nid);
1168
1169         if (hinfo->nid) {
1170                 cvt_idx = cvt_nid_to_cvt_index(spec, hinfo->nid);
1171                 if (snd_BUG_ON(cvt_idx < 0))
1172                         return -EINVAL;
1173                 per_cvt = &spec->cvts[cvt_idx];
1174
1175                 snd_BUG_ON(!per_cvt->assigned);
1176                 per_cvt->assigned = 0;
1177                 hinfo->nid = 0;
1178
1179                 pin_idx = hinfo_to_pin_index(spec, hinfo);
1180                 if (snd_BUG_ON(pin_idx < 0))
1181                         return -EINVAL;
1182                 per_pin = &spec->pins[pin_idx];
1183
1184                 pinctl = snd_hda_codec_read(codec, per_pin->pin_nid, 0,
1185                                             AC_VERB_GET_PIN_WIDGET_CONTROL, 0);
1186                 snd_hda_codec_write(codec, per_pin->pin_nid, 0,
1187                                     AC_VERB_SET_PIN_WIDGET_CONTROL,
1188                                     pinctl & ~PIN_OUT);
1189                 snd_hda_spdif_ctls_unassign(codec, pin_idx);
1190         }
1191
1192         return 0;
1193 }
1194
1195 static const struct hda_pcm_ops generic_ops = {
1196         .open = hdmi_pcm_open,
1197         .prepare = generic_hdmi_playback_pcm_prepare,
1198         .cleanup = generic_hdmi_playback_pcm_cleanup,
1199 };
1200
1201 static int generic_hdmi_build_pcms(struct hda_codec *codec)
1202 {
1203         struct hdmi_spec *spec = codec->spec;
1204         int pin_idx;
1205
1206         for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
1207                 struct hda_pcm *info;
1208                 struct hda_pcm_stream *pstr;
1209
1210                 info = &spec->pcm_rec[pin_idx];
1211                 info->name = generic_hdmi_pcm_names[pin_idx];
1212                 info->pcm_type = HDA_PCM_TYPE_HDMI;
1213
1214                 pstr = &info->stream[SNDRV_PCM_STREAM_PLAYBACK];
1215                 pstr->substreams = 1;
1216                 pstr->ops = generic_ops;
1217                 /* other pstr fields are set in open */
1218         }
1219
1220         codec->num_pcms = spec->num_pins;
1221         codec->pcm_info = spec->pcm_rec;
1222
1223         return 0;
1224 }
1225
1226 static int generic_hdmi_build_jack(struct hda_codec *codec, int pin_idx)
1227 {
1228         int err;
1229         char hdmi_str[32];
1230         struct hdmi_spec *spec = codec->spec;
1231         struct hdmi_spec_per_pin *per_pin = &spec->pins[pin_idx];
1232         int pcmdev = spec->pcm_rec[pin_idx].device;
1233
1234         snprintf(hdmi_str, sizeof(hdmi_str), "HDMI/DP,pcm=%d", pcmdev);
1235
1236         err = snd_hda_input_jack_add(codec, per_pin->pin_nid,
1237                              SND_JACK_VIDEOOUT, pcmdev > 0 ? hdmi_str : NULL);
1238         if (err < 0)
1239                 return err;
1240
1241         hdmi_present_sense(per_pin, false);
1242         return 0;
1243 }
1244
1245 static int generic_hdmi_build_controls(struct hda_codec *codec)
1246 {
1247         struct hdmi_spec *spec = codec->spec;
1248         int err;
1249         int pin_idx;
1250
1251         for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
1252                 struct hdmi_spec_per_pin *per_pin = &spec->pins[pin_idx];
1253
1254                 err = generic_hdmi_build_jack(codec, pin_idx);
1255                 if (err < 0)
1256                         return err;
1257
1258                 err = snd_hda_create_spdif_out_ctls(codec,
1259                                                     per_pin->pin_nid,
1260                                                     per_pin->mux_nids[0]);
1261                 if (err < 0)
1262                         return err;
1263                 snd_hda_spdif_ctls_unassign(codec, pin_idx);
1264
1265                 /* add control for ELD Bytes */
1266                 err = hdmi_create_eld_ctl(codec,
1267                                         pin_idx,
1268                                         spec->pcm_rec[pin_idx].device);
1269
1270                 if (err < 0)
1271                         return err;
1272                 err = snd_hda_jack_add_kctl(codec, per_pin->pin_nid,
1273                                             "HDMI", pin_idx);
1274                 if (err < 0)
1275                         return err;
1276         }
1277
1278         return 0;
1279 }
1280
1281 static int generic_hdmi_init(struct hda_codec *codec)
1282 {
1283         struct hdmi_spec *spec = codec->spec;
1284         int pin_idx;
1285
1286         for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
1287                 struct hdmi_spec_per_pin *per_pin = &spec->pins[pin_idx];
1288                 hda_nid_t pin_nid = per_pin->pin_nid;
1289                 struct hdmi_eld *eld = &per_pin->sink_eld;
1290
1291                 hdmi_init_pin(codec, pin_nid);
1292                 snd_hda_jack_detect_enable(codec, pin_nid, pin_nid);
1293
1294                 per_pin->codec = codec;
1295                 INIT_DELAYED_WORK(&per_pin->work, hdmi_repoll_eld);
1296                 snd_hda_eld_proc_new(codec, eld, pin_idx);
1297         }
1298         snd_hda_jack_report_sync(codec);
1299         return 0;
1300 }
1301
1302 static void generic_hdmi_free(struct hda_codec *codec)
1303 {
1304         struct hdmi_spec *spec = codec->spec;
1305         int pin_idx;
1306
1307         for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
1308                 struct hdmi_spec_per_pin *per_pin = &spec->pins[pin_idx];
1309                 struct hdmi_eld *eld = &per_pin->sink_eld;
1310
1311                 cancel_delayed_work(&per_pin->work);
1312                 snd_hda_eld_proc_free(codec, eld);
1313         }
1314         snd_hda_input_jack_free(codec);
1315
1316         flush_workqueue(codec->bus->workq);
1317         kfree(spec);
1318 }
1319
1320 static const struct hda_codec_ops generic_hdmi_patch_ops = {
1321         .init                   = generic_hdmi_init,
1322         .free                   = generic_hdmi_free,
1323         .build_pcms             = generic_hdmi_build_pcms,
1324         .build_controls         = generic_hdmi_build_controls,
1325         .unsol_event            = hdmi_unsol_event,
1326 };
1327
1328 static int patch_generic_hdmi(struct hda_codec *codec)
1329 {
1330         struct hdmi_spec *spec;
1331
1332         spec = kzalloc(sizeof(*spec), GFP_KERNEL);
1333         if (spec == NULL)
1334                 return -ENOMEM;
1335
1336         codec->spec = spec;
1337         if (hdmi_parse_codec(codec) < 0) {
1338                 codec->spec = NULL;
1339                 kfree(spec);
1340                 return -EINVAL;
1341         }
1342         codec->patch_ops = generic_hdmi_patch_ops;
1343
1344         init_channel_allocations();
1345
1346         return 0;
1347 }
1348
1349 /*
1350  * Shared non-generic implementations
1351  */
1352
1353 static int simple_playback_build_pcms(struct hda_codec *codec)
1354 {
1355         struct hdmi_spec *spec = codec->spec;
1356         struct hda_pcm *info = spec->pcm_rec;
1357         int i;
1358
1359         codec->num_pcms = spec->num_cvts;
1360         codec->pcm_info = info;
1361
1362         for (i = 0; i < codec->num_pcms; i++, info++) {
1363                 unsigned int chans;
1364                 struct hda_pcm_stream *pstr;
1365
1366                 chans = get_wcaps(codec, spec->cvts[i].cvt_nid);
1367                 chans = get_wcaps_channels(chans);
1368
1369                 info->name = generic_hdmi_pcm_names[i];
1370                 info->pcm_type = HDA_PCM_TYPE_HDMI;
1371                 pstr = &info->stream[SNDRV_PCM_STREAM_PLAYBACK];
1372                 snd_BUG_ON(!spec->pcm_playback);
1373                 *pstr = *spec->pcm_playback;
1374                 pstr->nid = spec->cvts[i].cvt_nid;
1375                 if (pstr->channels_max <= 2 && chans && chans <= 16)
1376                         pstr->channels_max = chans;
1377         }
1378
1379         return 0;
1380 }
1381
1382 static int simple_playback_build_controls(struct hda_codec *codec)
1383 {
1384         struct hdmi_spec *spec = codec->spec;
1385         int err;
1386         int i;
1387
1388         for (i = 0; i < codec->num_pcms; i++) {
1389                 err = snd_hda_create_spdif_out_ctls(codec,
1390                                                     spec->cvts[i].cvt_nid,
1391                                                     spec->cvts[i].cvt_nid);
1392                 if (err < 0)
1393                         return err;
1394         }
1395
1396         return 0;
1397 }
1398
1399 static void simple_playback_free(struct hda_codec *codec)
1400 {
1401         struct hdmi_spec *spec = codec->spec;
1402
1403         kfree(spec);
1404 }
1405
1406 /*
1407  * Nvidia specific implementations
1408  */
1409
1410 #define Nv_VERB_SET_Channel_Allocation          0xF79
1411 #define Nv_VERB_SET_Info_Frame_Checksum         0xF7A
1412 #define Nv_VERB_SET_Audio_Protection_On         0xF98
1413 #define Nv_VERB_SET_Audio_Protection_Off        0xF99
1414
1415 #define nvhdmi_master_con_nid_7x        0x04
1416 #define nvhdmi_master_pin_nid_7x        0x05
1417
1418 static const hda_nid_t nvhdmi_con_nids_7x[4] = {
1419         /*front, rear, clfe, rear_surr */
1420         0x6, 0x8, 0xa, 0xc,
1421 };
1422
1423 static const struct hda_verb nvhdmi_basic_init_7x[] = {
1424         /* set audio protect on */
1425         { 0x1, Nv_VERB_SET_Audio_Protection_On, 0x1},
1426         /* enable digital output on pin widget */
1427         { 0x5, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 },
1428         { 0x7, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 },
1429         { 0x9, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 },
1430         { 0xb, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 },
1431         { 0xd, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 },
1432         {} /* terminator */
1433 };
1434
1435 #ifdef LIMITED_RATE_FMT_SUPPORT
1436 /* support only the safe format and rate */
1437 #define SUPPORTED_RATES         SNDRV_PCM_RATE_48000
1438 #define SUPPORTED_MAXBPS        16
1439 #define SUPPORTED_FORMATS       SNDRV_PCM_FMTBIT_S16_LE
1440 #else
1441 /* support all rates and formats */
1442 #define SUPPORTED_RATES \
1443         (SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |\
1444         SNDRV_PCM_RATE_88200 | SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |\
1445          SNDRV_PCM_RATE_192000)
1446 #define SUPPORTED_MAXBPS        24
1447 #define SUPPORTED_FORMATS \
1448         (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S32_LE)
1449 #endif
1450
1451 static int nvhdmi_7x_init(struct hda_codec *codec)
1452 {
1453         snd_hda_sequence_write(codec, nvhdmi_basic_init_7x);
1454         return 0;
1455 }
1456
1457 static unsigned int channels_2_6_8[] = {
1458         2, 6, 8
1459 };
1460
1461 static unsigned int channels_2_8[] = {
1462         2, 8
1463 };
1464
1465 static struct snd_pcm_hw_constraint_list hw_constraints_2_6_8_channels = {
1466         .count = ARRAY_SIZE(channels_2_6_8),
1467         .list = channels_2_6_8,
1468         .mask = 0,
1469 };
1470
1471 static struct snd_pcm_hw_constraint_list hw_constraints_2_8_channels = {
1472         .count = ARRAY_SIZE(channels_2_8),
1473         .list = channels_2_8,
1474         .mask = 0,
1475 };
1476
1477 static int simple_playback_pcm_open(struct hda_pcm_stream *hinfo,
1478                                     struct hda_codec *codec,
1479                                     struct snd_pcm_substream *substream)
1480 {
1481         struct hdmi_spec *spec = codec->spec;
1482         struct snd_pcm_hw_constraint_list *hw_constraints_channels = NULL;
1483
1484         switch (codec->preset->id) {
1485         case 0x10de0002:
1486         case 0x10de0003:
1487         case 0x10de0005:
1488         case 0x10de0006:
1489                 hw_constraints_channels = &hw_constraints_2_8_channels;
1490                 break;
1491         case 0x10de0007:
1492                 hw_constraints_channels = &hw_constraints_2_6_8_channels;
1493                 break;
1494         default:
1495                 break;
1496         }
1497
1498         if (hw_constraints_channels != NULL) {
1499                 snd_pcm_hw_constraint_list(substream->runtime, 0,
1500                                 SNDRV_PCM_HW_PARAM_CHANNELS,
1501                                 hw_constraints_channels);
1502         } else {
1503                 snd_pcm_hw_constraint_step(substream->runtime, 0,
1504                                            SNDRV_PCM_HW_PARAM_CHANNELS, 2);
1505         }
1506
1507         return snd_hda_multi_out_dig_open(codec, &spec->multiout);
1508 }
1509
1510 static int simple_playback_pcm_close(struct hda_pcm_stream *hinfo,
1511                                      struct hda_codec *codec,
1512                                      struct snd_pcm_substream *substream)
1513 {
1514         struct hdmi_spec *spec = codec->spec;
1515         return snd_hda_multi_out_dig_close(codec, &spec->multiout);
1516 }
1517
1518 static int simple_playback_pcm_prepare(struct hda_pcm_stream *hinfo,
1519                                        struct hda_codec *codec,
1520                                        unsigned int stream_tag,
1521                                        unsigned int format,
1522                                        struct snd_pcm_substream *substream)
1523 {
1524         struct hdmi_spec *spec = codec->spec;
1525         return snd_hda_multi_out_dig_prepare(codec, &spec->multiout,
1526                                              stream_tag, format, substream);
1527 }
1528
1529 static void nvhdmi_8ch_7x_set_info_frame_parameters(struct hda_codec *codec,
1530                                                     int channels)
1531 {
1532         unsigned int chanmask;
1533         int chan = channels ? (channels - 1) : 1;
1534
1535         switch (channels) {
1536         default:
1537         case 0:
1538         case 2:
1539                 chanmask = 0x00;
1540                 break;
1541         case 4:
1542                 chanmask = 0x08;
1543                 break;
1544         case 6:
1545                 chanmask = 0x0b;
1546                 break;
1547         case 8:
1548                 chanmask = 0x13;
1549                 break;
1550         }
1551
1552         /* Set the audio infoframe channel allocation and checksum fields.  The
1553          * channel count is computed implicitly by the hardware. */
1554         snd_hda_codec_write(codec, 0x1, 0,
1555                         Nv_VERB_SET_Channel_Allocation, chanmask);
1556
1557         snd_hda_codec_write(codec, 0x1, 0,
1558                         Nv_VERB_SET_Info_Frame_Checksum,
1559                         (0x71 - chan - chanmask));
1560 }
1561
1562 static int nvhdmi_8ch_7x_pcm_close(struct hda_pcm_stream *hinfo,
1563                                    struct hda_codec *codec,
1564                                    struct snd_pcm_substream *substream)
1565 {
1566         struct hdmi_spec *spec = codec->spec;
1567         int i;
1568
1569         snd_hda_codec_write(codec, nvhdmi_master_con_nid_7x,
1570                         0, AC_VERB_SET_CHANNEL_STREAMID, 0);
1571         for (i = 0; i < 4; i++) {
1572                 /* set the stream id */
1573                 snd_hda_codec_write(codec, nvhdmi_con_nids_7x[i], 0,
1574                                 AC_VERB_SET_CHANNEL_STREAMID, 0);
1575                 /* set the stream format */
1576                 snd_hda_codec_write(codec, nvhdmi_con_nids_7x[i], 0,
1577                                 AC_VERB_SET_STREAM_FORMAT, 0);
1578         }
1579
1580         /* The audio hardware sends a channel count of 0x7 (8ch) when all the
1581          * streams are disabled. */
1582         nvhdmi_8ch_7x_set_info_frame_parameters(codec, 8);
1583
1584         return snd_hda_multi_out_dig_close(codec, &spec->multiout);
1585 }
1586
1587 static int nvhdmi_8ch_7x_pcm_prepare(struct hda_pcm_stream *hinfo,
1588                                      struct hda_codec *codec,
1589                                      unsigned int stream_tag,
1590                                      unsigned int format,
1591                                      struct snd_pcm_substream *substream)
1592 {
1593         int chs;
1594         unsigned int dataDCC2, channel_id;
1595         int i;
1596         struct hdmi_spec *spec = codec->spec;
1597         struct hda_spdif_out *spdif =
1598                 snd_hda_spdif_out_of_nid(codec, spec->cvts[0].cvt_nid);
1599
1600         mutex_lock(&codec->spdif_mutex);
1601
1602         chs = substream->runtime->channels;
1603
1604         dataDCC2 = 0x2;
1605
1606         /* turn off SPDIF once; otherwise the IEC958 bits won't be updated */
1607         if (codec->spdif_status_reset && (spdif->ctls & AC_DIG1_ENABLE))
1608                 snd_hda_codec_write(codec,
1609                                 nvhdmi_master_con_nid_7x,
1610                                 0,
1611                                 AC_VERB_SET_DIGI_CONVERT_1,
1612                                 spdif->ctls & ~AC_DIG1_ENABLE & 0xff);
1613
1614         /* set the stream id */
1615         snd_hda_codec_write(codec, nvhdmi_master_con_nid_7x, 0,
1616                         AC_VERB_SET_CHANNEL_STREAMID, (stream_tag << 4) | 0x0);
1617
1618         /* set the stream format */
1619         snd_hda_codec_write(codec, nvhdmi_master_con_nid_7x, 0,
1620                         AC_VERB_SET_STREAM_FORMAT, format);
1621
1622         /* turn on again (if needed) */
1623         /* enable and set the channel status audio/data flag */
1624         if (codec->spdif_status_reset && (spdif->ctls & AC_DIG1_ENABLE)) {
1625                 snd_hda_codec_write(codec,
1626                                 nvhdmi_master_con_nid_7x,
1627                                 0,
1628                                 AC_VERB_SET_DIGI_CONVERT_1,
1629                                 spdif->ctls & 0xff);
1630                 snd_hda_codec_write(codec,
1631                                 nvhdmi_master_con_nid_7x,
1632                                 0,
1633                                 AC_VERB_SET_DIGI_CONVERT_2, dataDCC2);
1634         }
1635
1636         for (i = 0; i < 4; i++) {
1637                 if (chs == 2)
1638                         channel_id = 0;
1639                 else
1640                         channel_id = i * 2;
1641
1642                 /* turn off SPDIF once;
1643                  *otherwise the IEC958 bits won't be updated
1644                  */
1645                 if (codec->spdif_status_reset &&
1646                 (spdif->ctls & AC_DIG1_ENABLE))
1647                         snd_hda_codec_write(codec,
1648                                 nvhdmi_con_nids_7x[i],
1649                                 0,
1650                                 AC_VERB_SET_DIGI_CONVERT_1,
1651                                 spdif->ctls & ~AC_DIG1_ENABLE & 0xff);
1652                 /* set the stream id */
1653                 snd_hda_codec_write(codec,
1654                                 nvhdmi_con_nids_7x[i],
1655                                 0,
1656                                 AC_VERB_SET_CHANNEL_STREAMID,
1657                                 (stream_tag << 4) | channel_id);
1658                 /* set the stream format */
1659                 snd_hda_codec_write(codec,
1660                                 nvhdmi_con_nids_7x[i],
1661                                 0,
1662                                 AC_VERB_SET_STREAM_FORMAT,
1663                                 format);
1664                 /* turn on again (if needed) */
1665                 /* enable and set the channel status audio/data flag */
1666                 if (codec->spdif_status_reset &&
1667                 (spdif->ctls & AC_DIG1_ENABLE)) {
1668                         snd_hda_codec_write(codec,
1669                                         nvhdmi_con_nids_7x[i],
1670                                         0,
1671                                         AC_VERB_SET_DIGI_CONVERT_1,
1672                                         spdif->ctls & 0xff);
1673                         snd_hda_codec_write(codec,
1674                                         nvhdmi_con_nids_7x[i],
1675                                         0,
1676                                         AC_VERB_SET_DIGI_CONVERT_2, dataDCC2);
1677                 }
1678         }
1679
1680         nvhdmi_8ch_7x_set_info_frame_parameters(codec, chs);
1681
1682         mutex_unlock(&codec->spdif_mutex);
1683         return 0;
1684 }
1685
1686 static const struct hda_pcm_stream nvhdmi_pcm_playback_8ch_7x = {
1687         .substreams = 1,
1688         .channels_min = 2,
1689         .channels_max = 8,
1690         .nid = nvhdmi_master_con_nid_7x,
1691         .rates = SUPPORTED_RATES,
1692         .maxbps = SUPPORTED_MAXBPS,
1693         .formats = SUPPORTED_FORMATS,
1694         .ops = {
1695                 .open = simple_playback_pcm_open,
1696                 .close = nvhdmi_8ch_7x_pcm_close,
1697                 .prepare = nvhdmi_8ch_7x_pcm_prepare
1698         },
1699 };
1700
1701 static const struct hda_pcm_stream nvhdmi_pcm_playback_2ch = {
1702         .substreams = 1,
1703         .channels_min = 2,
1704         .channels_max = 2,
1705         .nid = nvhdmi_master_con_nid_7x,
1706         .rates = SUPPORTED_RATES,
1707         .maxbps = SUPPORTED_MAXBPS,
1708         .formats = SUPPORTED_FORMATS,
1709         .ops = {
1710                 .open = simple_playback_pcm_open,
1711                 .close = simple_playback_pcm_close,
1712                 .prepare = simple_playback_pcm_prepare
1713         },
1714 };
1715
1716 static const struct hda_codec_ops nvhdmi_patch_ops_8ch_7x = {
1717         .build_controls = simple_playback_build_controls,
1718         .build_pcms = simple_playback_build_pcms,
1719         .init = nvhdmi_7x_init,
1720         .free = simple_playback_free,
1721 };
1722
1723 static const struct hda_codec_ops nvhdmi_patch_ops_2ch = {
1724         .build_controls = simple_playback_build_controls,
1725         .build_pcms = simple_playback_build_pcms,
1726         .init = nvhdmi_7x_init,
1727         .free = simple_playback_free,
1728 };
1729
1730 static int patch_nvhdmi_2ch(struct hda_codec *codec)
1731 {
1732         struct hdmi_spec *spec;
1733
1734         spec = kzalloc(sizeof(*spec), GFP_KERNEL);
1735         if (spec == NULL)
1736                 return -ENOMEM;
1737
1738         codec->spec = spec;
1739
1740         spec->multiout.num_dacs = 0;  /* no analog */
1741         spec->multiout.max_channels = 2;
1742         spec->multiout.dig_out_nid = nvhdmi_master_con_nid_7x;
1743         spec->num_cvts = 1;
1744         spec->cvts[0].cvt_nid = nvhdmi_master_con_nid_7x;
1745         spec->pcm_playback = &nvhdmi_pcm_playback_2ch;
1746
1747         codec->patch_ops = nvhdmi_patch_ops_2ch;
1748
1749         return 0;
1750 }
1751
1752 static int patch_nvhdmi_8ch_7x(struct hda_codec *codec)
1753 {
1754         struct hdmi_spec *spec;
1755         int err = patch_nvhdmi_2ch(codec);
1756
1757         if (err < 0)
1758                 return err;
1759         spec = codec->spec;
1760         spec->multiout.max_channels = 8;
1761         spec->pcm_playback = &nvhdmi_pcm_playback_8ch_7x;
1762         codec->patch_ops = nvhdmi_patch_ops_8ch_7x;
1763
1764         /* Initialize the audio infoframe channel mask and checksum to something
1765          * valid */
1766         nvhdmi_8ch_7x_set_info_frame_parameters(codec, 8);
1767
1768         return 0;
1769 }
1770
1771 /*
1772  * ATI-specific implementations
1773  *
1774  * FIXME: we may omit the whole this and use the generic code once after
1775  * it's confirmed to work.
1776  */
1777
1778 #define ATIHDMI_CVT_NID         0x02    /* audio converter */
1779 #define ATIHDMI_PIN_NID         0x03    /* HDMI output pin */
1780
1781 static int atihdmi_playback_pcm_prepare(struct hda_pcm_stream *hinfo,
1782                                         struct hda_codec *codec,
1783                                         unsigned int stream_tag,
1784                                         unsigned int format,
1785                                         struct snd_pcm_substream *substream)
1786 {
1787         struct hdmi_spec *spec = codec->spec;
1788         int chans = substream->runtime->channels;
1789         int i, err;
1790
1791         err = simple_playback_pcm_prepare(hinfo, codec, stream_tag, format,
1792                                           substream);
1793         if (err < 0)
1794                 return err;
1795         snd_hda_codec_write(codec, spec->cvts[0].cvt_nid, 0,
1796                             AC_VERB_SET_CVT_CHAN_COUNT, chans - 1);
1797         /* FIXME: XXX */
1798         for (i = 0; i < chans; i++) {
1799                 snd_hda_codec_write(codec, spec->cvts[0].cvt_nid, 0,
1800                                     AC_VERB_SET_HDMI_CHAN_SLOT,
1801                                     (i << 4) | i);
1802         }
1803         return 0;
1804 }
1805
1806 static const struct hda_pcm_stream atihdmi_pcm_digital_playback = {
1807         .substreams = 1,
1808         .channels_min = 2,
1809         .channels_max = 2,
1810         .nid = ATIHDMI_CVT_NID,
1811         .ops = {
1812                 .open = simple_playback_pcm_open,
1813                 .close = simple_playback_pcm_close,
1814                 .prepare = atihdmi_playback_pcm_prepare
1815         },
1816 };
1817
1818 static const struct hda_verb atihdmi_basic_init[] = {
1819         /* enable digital output on pin widget */
1820         { 0x03, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT },
1821         {} /* terminator */
1822 };
1823
1824 static int atihdmi_init(struct hda_codec *codec)
1825 {
1826         struct hdmi_spec *spec = codec->spec;
1827
1828         snd_hda_sequence_write(codec, atihdmi_basic_init);
1829         /* SI codec requires to unmute the pin */
1830         if (get_wcaps(codec, spec->pins[0].pin_nid) & AC_WCAP_OUT_AMP)
1831                 snd_hda_codec_write(codec, spec->pins[0].pin_nid, 0,
1832                                     AC_VERB_SET_AMP_GAIN_MUTE,
1833                                     AMP_OUT_UNMUTE);
1834         return 0;
1835 }
1836
1837 static const struct hda_codec_ops atihdmi_patch_ops = {
1838         .build_controls = simple_playback_build_controls,
1839         .build_pcms = simple_playback_build_pcms,
1840         .init = atihdmi_init,
1841         .free = simple_playback_free,
1842 };
1843
1844
1845 static int patch_atihdmi(struct hda_codec *codec)
1846 {
1847         struct hdmi_spec *spec;
1848
1849         spec = kzalloc(sizeof(*spec), GFP_KERNEL);
1850         if (spec == NULL)
1851                 return -ENOMEM;
1852
1853         codec->spec = spec;
1854
1855         spec->multiout.num_dacs = 0;      /* no analog */
1856         spec->multiout.max_channels = 2;
1857         spec->multiout.dig_out_nid = ATIHDMI_CVT_NID;
1858         spec->num_cvts = 1;
1859         spec->cvts[0].cvt_nid = ATIHDMI_CVT_NID;
1860         spec->pins[0].pin_nid = ATIHDMI_PIN_NID;
1861         spec->pcm_playback = &atihdmi_pcm_digital_playback;
1862
1863         codec->patch_ops = atihdmi_patch_ops;
1864
1865         return 0;
1866 }
1867
1868
1869 /*
1870  * patch entries
1871  */
1872 static const struct hda_codec_preset snd_hda_preset_hdmi[] = {
1873 { .id = 0x1002793c, .name = "RS600 HDMI",       .patch = patch_atihdmi },
1874 { .id = 0x10027919, .name = "RS600 HDMI",       .patch = patch_atihdmi },
1875 { .id = 0x1002791a, .name = "RS690/780 HDMI",   .patch = patch_atihdmi },
1876 { .id = 0x1002aa01, .name = "R6xx HDMI",        .patch = patch_generic_hdmi },
1877 { .id = 0x10951390, .name = "SiI1390 HDMI",     .patch = patch_generic_hdmi },
1878 { .id = 0x10951392, .name = "SiI1392 HDMI",     .patch = patch_generic_hdmi },
1879 { .id = 0x17e80047, .name = "Chrontel HDMI",    .patch = patch_generic_hdmi },
1880 { .id = 0x10de0002, .name = "MCP77/78 HDMI",    .patch = patch_nvhdmi_8ch_7x },
1881 { .id = 0x10de0003, .name = "MCP77/78 HDMI",    .patch = patch_nvhdmi_8ch_7x },
1882 { .id = 0x10de0005, .name = "MCP77/78 HDMI",    .patch = patch_nvhdmi_8ch_7x },
1883 { .id = 0x10de0006, .name = "MCP77/78 HDMI",    .patch = patch_nvhdmi_8ch_7x },
1884 { .id = 0x10de0007, .name = "MCP79/7A HDMI",    .patch = patch_nvhdmi_8ch_7x },
1885 { .id = 0x10de000a, .name = "GPU 0a HDMI/DP",   .patch = patch_generic_hdmi },
1886 { .id = 0x10de000b, .name = "GPU 0b HDMI/DP",   .patch = patch_generic_hdmi },
1887 { .id = 0x10de000c, .name = "MCP89 HDMI",       .patch = patch_generic_hdmi },
1888 { .id = 0x10de000d, .name = "GPU 0d HDMI/DP",   .patch = patch_generic_hdmi },
1889 { .id = 0x10de0010, .name = "GPU 10 HDMI/DP",   .patch = patch_generic_hdmi },
1890 { .id = 0x10de0011, .name = "GPU 11 HDMI/DP",   .patch = patch_generic_hdmi },
1891 { .id = 0x10de0012, .name = "GPU 12 HDMI/DP",   .patch = patch_generic_hdmi },
1892 { .id = 0x10de0013, .name = "GPU 13 HDMI/DP",   .patch = patch_generic_hdmi },
1893 { .id = 0x10de0014, .name = "GPU 14 HDMI/DP",   .patch = patch_generic_hdmi },
1894 { .id = 0x10de0015, .name = "GPU 15 HDMI/DP",   .patch = patch_generic_hdmi },
1895 { .id = 0x10de0016, .name = "GPU 16 HDMI/DP",   .patch = patch_generic_hdmi },
1896 /* 17 is known to be absent */
1897 { .id = 0x10de0018, .name = "GPU 18 HDMI/DP",   .patch = patch_generic_hdmi },
1898 { .id = 0x10de0019, .name = "GPU 19 HDMI/DP",   .patch = patch_generic_hdmi },
1899 { .id = 0x10de001a, .name = "GPU 1a HDMI/DP",   .patch = patch_generic_hdmi },
1900 { .id = 0x10de001b, .name = "GPU 1b HDMI/DP",   .patch = patch_generic_hdmi },
1901 { .id = 0x10de001c, .name = "GPU 1c HDMI/DP",   .patch = patch_generic_hdmi },
1902 { .id = 0x10de0040, .name = "GPU 40 HDMI/DP",   .patch = patch_generic_hdmi },
1903 { .id = 0x10de0041, .name = "GPU 41 HDMI/DP",   .patch = patch_generic_hdmi },
1904 { .id = 0x10de0042, .name = "GPU 42 HDMI/DP",   .patch = patch_generic_hdmi },
1905 { .id = 0x10de0043, .name = "GPU 43 HDMI/DP",   .patch = patch_generic_hdmi },
1906 { .id = 0x10de0044, .name = "GPU 44 HDMI/DP",   .patch = patch_generic_hdmi },
1907 { .id = 0x10de0067, .name = "MCP67 HDMI",       .patch = patch_nvhdmi_2ch },
1908 { .id = 0x10de8001, .name = "MCP73 HDMI",       .patch = patch_nvhdmi_2ch },
1909 { .id = 0x80860054, .name = "IbexPeak HDMI",    .patch = patch_generic_hdmi },
1910 { .id = 0x80862801, .name = "Bearlake HDMI",    .patch = patch_generic_hdmi },
1911 { .id = 0x80862802, .name = "Cantiga HDMI",     .patch = patch_generic_hdmi },
1912 { .id = 0x80862803, .name = "Eaglelake HDMI",   .patch = patch_generic_hdmi },
1913 { .id = 0x80862804, .name = "IbexPeak HDMI",    .patch = patch_generic_hdmi },
1914 { .id = 0x80862805, .name = "CougarPoint HDMI", .patch = patch_generic_hdmi },
1915 { .id = 0x80862806, .name = "PantherPoint HDMI", .patch = patch_generic_hdmi },
1916 { .id = 0x808629fb, .name = "Crestline HDMI",   .patch = patch_generic_hdmi },
1917 {} /* terminator */
1918 };
1919
1920 MODULE_ALIAS("snd-hda-codec-id:1002793c");
1921 MODULE_ALIAS("snd-hda-codec-id:10027919");
1922 MODULE_ALIAS("snd-hda-codec-id:1002791a");
1923 MODULE_ALIAS("snd-hda-codec-id:1002aa01");
1924 MODULE_ALIAS("snd-hda-codec-id:10951390");
1925 MODULE_ALIAS("snd-hda-codec-id:10951392");
1926 MODULE_ALIAS("snd-hda-codec-id:10de0002");
1927 MODULE_ALIAS("snd-hda-codec-id:10de0003");
1928 MODULE_ALIAS("snd-hda-codec-id:10de0005");
1929 MODULE_ALIAS("snd-hda-codec-id:10de0006");
1930 MODULE_ALIAS("snd-hda-codec-id:10de0007");
1931 MODULE_ALIAS("snd-hda-codec-id:10de000a");
1932 MODULE_ALIAS("snd-hda-codec-id:10de000b");
1933 MODULE_ALIAS("snd-hda-codec-id:10de000c");
1934 MODULE_ALIAS("snd-hda-codec-id:10de000d");
1935 MODULE_ALIAS("snd-hda-codec-id:10de0010");
1936 MODULE_ALIAS("snd-hda-codec-id:10de0011");
1937 MODULE_ALIAS("snd-hda-codec-id:10de0012");
1938 MODULE_ALIAS("snd-hda-codec-id:10de0013");
1939 MODULE_ALIAS("snd-hda-codec-id:10de0014");
1940 MODULE_ALIAS("snd-hda-codec-id:10de0015");
1941 MODULE_ALIAS("snd-hda-codec-id:10de0016");
1942 MODULE_ALIAS("snd-hda-codec-id:10de0018");
1943 MODULE_ALIAS("snd-hda-codec-id:10de0019");
1944 MODULE_ALIAS("snd-hda-codec-id:10de001a");
1945 MODULE_ALIAS("snd-hda-codec-id:10de001b");
1946 MODULE_ALIAS("snd-hda-codec-id:10de001c");
1947 MODULE_ALIAS("snd-hda-codec-id:10de0040");
1948 MODULE_ALIAS("snd-hda-codec-id:10de0041");
1949 MODULE_ALIAS("snd-hda-codec-id:10de0042");
1950 MODULE_ALIAS("snd-hda-codec-id:10de0043");
1951 MODULE_ALIAS("snd-hda-codec-id:10de0044");
1952 MODULE_ALIAS("snd-hda-codec-id:10de0067");
1953 MODULE_ALIAS("snd-hda-codec-id:10de8001");
1954 MODULE_ALIAS("snd-hda-codec-id:17e80047");
1955 MODULE_ALIAS("snd-hda-codec-id:80860054");
1956 MODULE_ALIAS("snd-hda-codec-id:80862801");
1957 MODULE_ALIAS("snd-hda-codec-id:80862802");
1958 MODULE_ALIAS("snd-hda-codec-id:80862803");
1959 MODULE_ALIAS("snd-hda-codec-id:80862804");
1960 MODULE_ALIAS("snd-hda-codec-id:80862805");
1961 MODULE_ALIAS("snd-hda-codec-id:80862806");
1962 MODULE_ALIAS("snd-hda-codec-id:808629fb");
1963
1964 MODULE_LICENSE("GPL");
1965 MODULE_DESCRIPTION("HDMI HD-audio codec");
1966 MODULE_ALIAS("snd-hda-codec-intelhdmi");
1967 MODULE_ALIAS("snd-hda-codec-nvhdmi");
1968 MODULE_ALIAS("snd-hda-codec-atihdmi");
1969
1970 static struct hda_codec_preset_list intel_list = {
1971         .preset = snd_hda_preset_hdmi,
1972         .owner = THIS_MODULE,
1973 };
1974
1975 static int __init patch_hdmi_init(void)
1976 {
1977         return snd_hda_add_codec_preset(&intel_list);
1978 }
1979
1980 static void __exit patch_hdmi_exit(void)
1981 {
1982         snd_hda_delete_codec_preset(&intel_list);
1983 }
1984
1985 module_init(patch_hdmi_init)
1986 module_exit(patch_hdmi_exit)