sound/pci/hda/hda_eld.c

   1 /*
   2  * Generic routines and proc interface for ELD(EDID Like Data) information
   3  *
   4  * Copyright(c) 2008 Intel Corporation.
   5  * Copyright (c) 2013 Anssi Hannula <anssi.hannula@iki.fi>
   6  *
   7  * Authors:
   8  *              Wu Fengguang <wfg@linux.intel.com>
   9  *
  10  *  This driver is free software; you can redistribute it and/or modify
  11  *  it under the terms of the GNU General Public License as published by
  12  *  the Free Software Foundation; either version 2 of the License, or
  13  *  (at your option) any later version.
  14  *
  15  *  This driver is distributed in the hope that it will be useful,
  16  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  *  GNU General Public License for more details.
  19  *
  20  *  You should have received a copy of the GNU General Public License
  21  *  along with this program; if not, write to the Free Software
  22  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
  23  */
  24
  25 #include <linux/init.h>
  26 #include <linux/slab.h>
  27 #include <sound/core.h>
  28 #include <asm/unaligned.h>
  29 #include "hda_codec.h"
  30 #include "hda_local.h"
  31
  32 enum eld_versions {
  33         ELD_VER_CEA_861D        = 2,
  34         ELD_VER_PARTIAL         = 31,
  35 };
  36
  37 enum cea_edid_versions {
  38         CEA_EDID_VER_NONE       = 0,
  39         CEA_EDID_VER_CEA861     = 1,
  40         CEA_EDID_VER_CEA861A    = 2,
  41         CEA_EDID_VER_CEA861BCD  = 3,
  42         CEA_EDID_VER_RESERVED   = 4,
  43 };
  44
  45 static char *cea_speaker_allocation_names[] = {
  46         /*  0 */ "FL/FR",
  47         /*  1 */ "LFE",
  48         /*  2 */ "FC",
  49         /*  3 */ "RL/RR",
  50         /*  4 */ "RC",
  51         /*  5 */ "FLC/FRC",
  52         /*  6 */ "RLC/RRC",
  53         /*  7 */ "FLW/FRW",
  54         /*  8 */ "FLH/FRH",
  55         /*  9 */ "TC",
  56         /* 10 */ "FCH",
  57 };
  58
  59 static char *eld_connection_type_names[4] = {
  60         "HDMI",
  61         "DisplayPort",
  62         "2-reserved",
  63         "3-reserved"
  64 };
  65
  66 enum cea_audio_coding_types {
  67         AUDIO_CODING_TYPE_REF_STREAM_HEADER     =  0,
  68         AUDIO_CODING_TYPE_LPCM                  =  1,
  69         AUDIO_CODING_TYPE_AC3                   =  2,
  70         AUDIO_CODING_TYPE_MPEG1                 =  3,
  71         AUDIO_CODING_TYPE_MP3                   =  4,
  72         AUDIO_CODING_TYPE_MPEG2                 =  5,
  73         AUDIO_CODING_TYPE_AACLC                 =  6,
  74         AUDIO_CODING_TYPE_DTS                   =  7,
  75         AUDIO_CODING_TYPE_ATRAC                 =  8,
  76         AUDIO_CODING_TYPE_SACD                  =  9,
  77         AUDIO_CODING_TYPE_EAC3                  = 10,
  78         AUDIO_CODING_TYPE_DTS_HD                = 11,
  79         AUDIO_CODING_TYPE_MLP                   = 12,
  80         AUDIO_CODING_TYPE_DST                   = 13,
  81         AUDIO_CODING_TYPE_WMAPRO                = 14,
  82         AUDIO_CODING_TYPE_REF_CXT               = 15,
  83         /* also include valid xtypes below */
  84         AUDIO_CODING_TYPE_HE_AAC                = 15,
  85         AUDIO_CODING_TYPE_HE_AAC2               = 16,
  86         AUDIO_CODING_TYPE_MPEG_SURROUND         = 17,
  87 };
  88
  89 enum cea_audio_coding_xtypes {
  90         AUDIO_CODING_XTYPE_HE_REF_CT            = 0,
  91         AUDIO_CODING_XTYPE_HE_AAC               = 1,
  92         AUDIO_CODING_XTYPE_HE_AAC2              = 2,
  93         AUDIO_CODING_XTYPE_MPEG_SURROUND        = 3,
  94         AUDIO_CODING_XTYPE_FIRST_RESERVED       = 4,
  95 };
  96
  97 static char *cea_audio_coding_type_names[] = {
  98         /*  0 */ "undefined",
  99         /*  1 */ "LPCM",
 100         /*  2 */ "AC-3",
 101         /*  3 */ "MPEG1",
 102         /*  4 */ "MP3",
 103         /*  5 */ "MPEG2",
 104         /*  6 */ "AAC-LC",
 105         /*  7 */ "DTS",
 106         /*  8 */ "ATRAC",
 107         /*  9 */ "DSD (One Bit Audio)",
 108         /* 10 */ "E-AC-3/DD+ (Dolby Digital Plus)",
 109         /* 11 */ "DTS-HD",
 110         /* 12 */ "MLP (Dolby TrueHD)",
 111         /* 13 */ "DST",
 112         /* 14 */ "WMAPro",
 113         /* 15 */ "HE-AAC",
 114         /* 16 */ "HE-AACv2",
 115         /* 17 */ "MPEG Surround",
 116 };
 117
 118 /*
 119  * The following two lists are shared between
 120  *      - HDMI audio InfoFrame (source to sink)
 121  *      - CEA E-EDID Extension (sink to source)
 122  */
 123
 124 /*
 125  * SS1:SS0 index => sample size
 126  */
 127 static int cea_sample_sizes[4] = {
 128         0,                      /* 0: Refer to Stream Header */
 129         AC_SUPPCM_BITS_16,      /* 1: 16 bits */
 130         AC_SUPPCM_BITS_20,      /* 2: 20 bits */
 131         AC_SUPPCM_BITS_24,      /* 3: 24 bits */
 132 };
 133
 134 /*
 135  * SF2:SF1:SF0 index => sampling frequency
 136  */
 137 static int cea_sampling_frequencies[8] = {
 138         0,                      /* 0: Refer to Stream Header */
 139         SNDRV_PCM_RATE_32000,   /* 1:  32000Hz */
 140         SNDRV_PCM_RATE_44100,   /* 2:  44100Hz */
 141         SNDRV_PCM_RATE_48000,   /* 3:  48000Hz */
 142         SNDRV_PCM_RATE_88200,   /* 4:  88200Hz */
 143         SNDRV_PCM_RATE_96000,   /* 5:  96000Hz */
 144         SNDRV_PCM_RATE_176400,  /* 6: 176400Hz */
 145         SNDRV_PCM_RATE_192000,  /* 7: 192000Hz */
 146 };
 147
 148 static unsigned int hdmi_get_eld_data(struct hda_codec *codec, hda_nid_t nid,
 149                                         int byte_index)
 150 {
 151         unsigned int val;
 152
 153         val = snd_hda_codec_read(codec, nid, 0,
 154                                         AC_VERB_GET_HDMI_ELDD, byte_index);
 155 #ifdef BE_PARANOID
 156         printk(KERN_INFO "HDMI: ELD data byte %d: 0x%x\n", byte_index, val);
 157 #endif
 158         return val;
 159 }
 160
 161 #define GRAB_BITS(buf, byte, lowbit, bits)              \
 162 ({                                                      \
 163         BUILD_BUG_ON(lowbit > 7);                       \
 164         BUILD_BUG_ON(bits > 8);                         \
 165         BUILD_BUG_ON(bits <= 0);                        \
 166                                                         \
 167         (buf[byte] >> (lowbit)) & ((1 << (bits)) - 1);  \
 168 })
 169
 170 static void hdmi_update_short_audio_desc(struct cea_sad *a,
 171                                          const unsigned char *buf)
 172 {
 173         int i;
 174         int val;
 175
 176         val = GRAB_BITS(buf, 1, 0, 7);
 177         a->rates = 0;
 178         for (i = 0; i < 7; i++)
 179                 if (val & (1 << i))
 180                         a->rates |= cea_sampling_frequencies[i + 1];
 181
 182         a->channels = GRAB_BITS(buf, 0, 0, 3);
 183         a->channels++;
 184
 185         a->sample_bits = 0;
 186         a->max_bitrate = 0;
 187
 188         a->format = GRAB_BITS(buf, 0, 3, 4);
 189         switch (a->format) {
 190         case AUDIO_CODING_TYPE_REF_STREAM_HEADER:
 191                 snd_printd(KERN_INFO
 192                                 "HDMI: audio coding type 0 not expected\n");
 193                 break;
 194
 195         case AUDIO_CODING_TYPE_LPCM:
 196                 val = GRAB_BITS(buf, 2, 0, 3);
 197                 for (i = 0; i < 3; i++)
 198                         if (val & (1 << i))
 199                                 a->sample_bits |= cea_sample_sizes[i + 1];
 200                 break;
 201
 202         case AUDIO_CODING_TYPE_AC3:
 203         case AUDIO_CODING_TYPE_MPEG1:
 204         case AUDIO_CODING_TYPE_MP3:
 205         case AUDIO_CODING_TYPE_MPEG2:
 206         case AUDIO_CODING_TYPE_AACLC:
 207         case AUDIO_CODING_TYPE_DTS:
 208         case AUDIO_CODING_TYPE_ATRAC:
 209                 a->max_bitrate = GRAB_BITS(buf, 2, 0, 8);
 210                 a->max_bitrate *= 8000;
 211                 break;
 212
 213         case AUDIO_CODING_TYPE_SACD:
 214                 break;
 215
 216         case AUDIO_CODING_TYPE_EAC3:
 217                 break;
 218
 219         case AUDIO_CODING_TYPE_DTS_HD:
 220                 break;
 221
 222         case AUDIO_CODING_TYPE_MLP:
 223                 break;
 224
 225         case AUDIO_CODING_TYPE_DST:
 226                 break;
 227
 228         case AUDIO_CODING_TYPE_WMAPRO:
 229                 a->profile = GRAB_BITS(buf, 2, 0, 3);
 230                 break;
 231
 232         case AUDIO_CODING_TYPE_REF_CXT:
 233                 a->format = GRAB_BITS(buf, 2, 3, 5);
 234                 if (a->format == AUDIO_CODING_XTYPE_HE_REF_CT ||
 235                     a->format >= AUDIO_CODING_XTYPE_FIRST_RESERVED) {
 236                         snd_printd(KERN_INFO
 237                                 "HDMI: audio coding xtype %d not expected\n",
 238                                 a->format);
 239                         a->format = 0;
 240                 } else
 241                         a->format += AUDIO_CODING_TYPE_HE_AAC -
 242                                      AUDIO_CODING_XTYPE_HE_AAC;
 243                 break;
 244         }
 245 }
 246
 247 /*
 248  * Be careful, ELD buf could be totally rubbish!
 249  */
 250 int snd_hdmi_parse_eld(struct parsed_hdmi_eld *e,
 251                           const unsigned char *buf, int size)
 252 {
 253         int mnl;
 254         int i;
 255
 256         e->eld_ver = GRAB_BITS(buf, 0, 3, 5);
 257         if (e->eld_ver != ELD_VER_CEA_861D &&
 258             e->eld_ver != ELD_VER_PARTIAL) {
 259                 snd_printd(KERN_INFO "HDMI: Unknown ELD version %d\n",
 260                                                                 e->eld_ver);
 261                 goto out_fail;
 262         }
 263
 264         e->baseline_len = GRAB_BITS(buf, 2, 0, 8);
 265         mnl             = GRAB_BITS(buf, 4, 0, 5);
 266         e->cea_edid_ver = GRAB_BITS(buf, 4, 5, 3);
 267
 268         e->support_hdcp = GRAB_BITS(buf, 5, 0, 1);
 269         e->support_ai   = GRAB_BITS(buf, 5, 1, 1);
 270         e->conn_type    = GRAB_BITS(buf, 5, 2, 2);
 271         e->sad_count    = GRAB_BITS(buf, 5, 4, 4);
 272
 273         e->aud_synch_delay = GRAB_BITS(buf, 6, 0, 8) * 2;
 274         e->spk_alloc    = GRAB_BITS(buf, 7, 0, 7);
 275
 276         e->port_id        = get_unaligned_le64(buf + 8);
 277
 278         /* not specified, but the spec's tendency is little endian */
 279         e->manufacture_id = get_unaligned_le16(buf + 16);
 280         e->product_id     = get_unaligned_le16(buf + 18);
 281
 282         if (mnl > ELD_MAX_MNL) {
 283                 snd_printd(KERN_INFO "HDMI: MNL is reserved value %d\n", mnl);
 284                 goto out_fail;
 285         } else if (ELD_FIXED_BYTES + mnl > size) {
 286                 snd_printd(KERN_INFO "HDMI: out of range MNL %d\n", mnl);
 287                 goto out_fail;
 288         } else
 289                 strlcpy(e->monitor_name, buf + ELD_FIXED_BYTES, mnl + 1);
 290
 291         for (i = 0; i < e->sad_count; i++) {
 292                 if (ELD_FIXED_BYTES + mnl + 3 * (i + 1) > size) {
 293                         snd_printd(KERN_INFO "HDMI: out of range SAD %d\n", i);
 294                         goto out_fail;
 295                 }
 296                 hdmi_update_short_audio_desc(e->sad + i,
 297                                         buf + ELD_FIXED_BYTES + mnl + 3 * i);
 298         }
 299
 300         /*
 301          * HDMI sink's ELD info cannot always be retrieved for now, e.g.
 302          * in console or for audio devices. Assume the highest speakers
 303          * configuration, to _not_ prohibit multi-channel audio playback.
 304          */
 305         if (!e->spk_alloc)
 306                 e->spk_alloc = 0xffff;
 307
 308         return 0;
 309
 310 out_fail:
 311         return -EINVAL;
 312 }
 313
 314 int snd_hdmi_get_eld_size(struct hda_codec *codec, hda_nid_t nid)
 315 {
 316         return snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_HDMI_DIP_SIZE,
 317                                                  AC_DIPSIZE_ELD_BUF);
 318 }
 319
 320 int snd_hdmi_get_eld(struct hda_codec *codec, hda_nid_t nid,
 321                      unsigned char *buf, int *eld_size)
 322 {
 323         int i;
 324         int ret = 0;
 325         int size;
 326
 327         /*
 328          * ELD size is initialized to zero in caller function. If no errors and
 329          * ELD is valid, actual eld_size is assigned.
 330          */
 331
 332         size = snd_hdmi_get_eld_size(codec, nid);
 333         if (size == 0) {
 334                 /* wfg: workaround for ASUS P5E-VM HDMI board */
 335                 snd_printd(KERN_INFO "HDMI: ELD buf size is 0, force 128\n");
 336                 size = 128;
 337         }
 338         if (size < ELD_FIXED_BYTES || size > ELD_MAX_SIZE) {
 339                 snd_printd(KERN_INFO "HDMI: invalid ELD buf size %d\n", size);
 340                 return -ERANGE;
 341         }
 342
 343         /* set ELD buffer */
 344         for (i = 0; i < size; i++) {
 345                 unsigned int val = hdmi_get_eld_data(codec, nid, i);
 346                 /*
 347                  * Graphics driver might be writing to ELD buffer right now.
 348                  * Just abort. The caller will repoll after a while.
 349                  */
 350                 if (!(val & AC_ELDD_ELD_VALID)) {
 351                         snd_printd(KERN_INFO
 352                                   "HDMI: invalid ELD data byte %d\n", i);
 353                         ret = -EINVAL;
 354                         goto error;
 355                 }
 356                 val &= AC_ELDD_ELD_DATA;
 357                 /*
 358                  * The first byte cannot be zero. This can happen on some DVI
 359                  * connections. Some Intel chips may also need some 250ms delay
 360                  * to return non-zero ELD data, even when the graphics driver
 361                  * correctly writes ELD content before setting ELD_valid bit.
 362                  */
 363                 if (!val && !i) {
 364                         snd_printdd(KERN_INFO "HDMI: 0 ELD data\n");
 365                         ret = -EINVAL;
 366                         goto error;
 367                 }
 368                 buf[i] = val;
 369         }
 370
 371         *eld_size = size;
 372 error:
 373         return ret;
 374 }
 375
 376 /**
 377  * SNDRV_PCM_RATE_* and AC_PAR_PCM values don't match, print correct rates with
 378  * hdmi-specific routine.
 379  */
 380 static void hdmi_print_pcm_rates(int pcm, char *buf, int buflen)
 381 {
 382         static unsigned int alsa_rates[] = {
 383                 5512, 8000, 11025, 16000, 22050, 32000, 44100, 48000, 64000,
 384                 88200, 96000, 176400, 192000, 384000
 385         };
 386         int i, j;
 387
 388         for (i = 0, j = 0; i < ARRAY_SIZE(alsa_rates); i++)
 389                 if (pcm & (1 << i))
 390                         j += snprintf(buf + j, buflen - j,  " %d",
 391                                 alsa_rates[i]);
 392
 393         buf[j] = '\0'; /* necessary when j == 0 */
 394 }
 395
 396 #define SND_PRINT_RATES_ADVISED_BUFSIZE 80
 397
 398 static void hdmi_show_short_audio_desc(struct cea_sad *a)
 399 {
 400         char buf[SND_PRINT_RATES_ADVISED_BUFSIZE];
 401         char buf2[8 + SND_PRINT_BITS_ADVISED_BUFSIZE] = ", bits =";
 402
 403         if (!a->format)
 404                 return;
 405
 406         hdmi_print_pcm_rates(a->rates, buf, sizeof(buf));
 407
 408         if (a->format == AUDIO_CODING_TYPE_LPCM)
 409                 snd_print_pcm_bits(a->sample_bits, buf2 + 8, sizeof(buf2) - 8);
 410         else if (a->max_bitrate)
 411                 snprintf(buf2, sizeof(buf2),
 412                                 ", max bitrate = %d", a->max_bitrate);
 413         else
 414                 buf2[0] = '\0';
 415
 416         _snd_printd(SND_PR_VERBOSE, "HDMI: supports coding type %s:"
 417                         " channels = %d, rates =%s%s\n",
 418                         cea_audio_coding_type_names[a->format],
 419                         a->channels,
 420                         buf,
 421                         buf2);
 422 }
 423
 424 void snd_print_channel_allocation(int spk_alloc, char *buf, int buflen)
 425 {
 426         int i, j;
 427
 428         for (i = 0, j = 0; i < ARRAY_SIZE(cea_speaker_allocation_names); i++) {
 429                 if (spk_alloc & (1 << i))
 430                         j += snprintf(buf + j, buflen - j,  " %s",
 431                                         cea_speaker_allocation_names[i]);
 432         }
 433         buf[j] = '\0';  /* necessary when j == 0 */
 434 }
 435
 436 void snd_hdmi_show_eld(struct parsed_hdmi_eld *e)
 437 {
 438         int i;
 439
 440         _snd_printd(SND_PR_VERBOSE, "HDMI: detected monitor %s at connection type %s\n",
 441                         e->monitor_name,
 442                         eld_connection_type_names[e->conn_type]);
 443
 444         if (e->spk_alloc) {
 445                 char buf[SND_PRINT_CHANNEL_ALLOCATION_ADVISED_BUFSIZE];
 446                 snd_print_channel_allocation(e->spk_alloc, buf, sizeof(buf));
 447                 _snd_printd(SND_PR_VERBOSE, "HDMI: available speakers:%s\n", buf);
 448         }
 449
 450         for (i = 0; i < e->sad_count; i++)
 451                 hdmi_show_short_audio_desc(e->sad + i);
 452 }
 453
 454 #ifdef CONFIG_PROC_FS
 455
 456 static void hdmi_print_sad_info(int i, struct cea_sad *a,
 457                                 struct snd_info_buffer *buffer)
 458 {
 459         char buf[SND_PRINT_RATES_ADVISED_BUFSIZE];
 460
 461         snd_iprintf(buffer, "sad%d_coding_type\t[0x%x] %s\n",
 462                         i, a->format, cea_audio_coding_type_names[a->format]);
 463         snd_iprintf(buffer, "sad%d_channels\t\t%d\n", i, a->channels);
 464
 465         hdmi_print_pcm_rates(a->rates, buf, sizeof(buf));
 466         snd_iprintf(buffer, "sad%d_rates\t\t[0x%x]%s\n", i, a->rates, buf);
 467
 468         if (a->format == AUDIO_CODING_TYPE_LPCM) {
 469                 snd_print_pcm_bits(a->sample_bits, buf, sizeof(buf));
 470                 snd_iprintf(buffer, "sad%d_bits\t\t[0x%x]%s\n",
 471                                                         i, a->sample_bits, buf);
 472         }
 473
 474         if (a->max_bitrate)
 475                 snd_iprintf(buffer, "sad%d_max_bitrate\t%d\n",
 476                                                         i, a->max_bitrate);
 477
 478         if (a->profile)
 479                 snd_iprintf(buffer, "sad%d_profile\t\t%d\n", i, a->profile);
 480 }
 481
 482 void snd_hdmi_print_eld_info(struct hdmi_eld *eld,
 483                              struct snd_info_buffer *buffer)
 484 {
 485         struct parsed_hdmi_eld *e = &eld->info;
 486         char buf[SND_PRINT_CHANNEL_ALLOCATION_ADVISED_BUFSIZE];
 487         int i;
 488         static char *eld_version_names[32] = {
 489                 "reserved",
 490                 "reserved",
 491                 "CEA-861D or below",
 492                 [3 ... 30] = "reserved",
 493                 [31] = "partial"
 494         };
 495         static char *cea_edid_version_names[8] = {
 496                 "no CEA EDID Timing Extension block present",
 497                 "CEA-861",
 498                 "CEA-861-A",
 499                 "CEA-861-B, C or D",
 500                 [4 ... 7] = "reserved"
 501         };
 502
 503         snd_iprintf(buffer, "monitor_present\t\t%d\n", eld->monitor_present);
 504         snd_iprintf(buffer, "eld_valid\t\t%d\n", eld->eld_valid);
 505         if (!eld->eld_valid)
 506                 return;
 507         snd_iprintf(buffer, "monitor_name\t\t%s\n", e->monitor_name);
 508         snd_iprintf(buffer, "connection_type\t\t%s\n",
 509                                 eld_connection_type_names[e->conn_type]);
 510         snd_iprintf(buffer, "eld_version\t\t[0x%x] %s\n", e->eld_ver,
 511                                         eld_version_names[e->eld_ver]);
 512         snd_iprintf(buffer, "edid_version\t\t[0x%x] %s\n", e->cea_edid_ver,
 513                                 cea_edid_version_names[e->cea_edid_ver]);
 514         snd_iprintf(buffer, "manufacture_id\t\t0x%x\n", e->manufacture_id);
 515         snd_iprintf(buffer, "product_id\t\t0x%x\n", e->product_id);
 516         snd_iprintf(buffer, "port_id\t\t\t0x%llx\n", (long long)e->port_id);
 517         snd_iprintf(buffer, "support_hdcp\t\t%d\n", e->support_hdcp);
 518         snd_iprintf(buffer, "support_ai\t\t%d\n", e->support_ai);
 519         snd_iprintf(buffer, "audio_sync_delay\t%d\n", e->aud_synch_delay);
 520
 521         snd_print_channel_allocation(e->spk_alloc, buf, sizeof(buf));
 522         snd_iprintf(buffer, "speakers\t\t[0x%x]%s\n", e->spk_alloc, buf);
 523
 524         snd_iprintf(buffer, "sad_count\t\t%d\n", e->sad_count);
 525
 526         for (i = 0; i < e->sad_count; i++)
 527                 hdmi_print_sad_info(i, e->sad + i, buffer);
 528 }
 529
 530 void snd_hdmi_write_eld_info(struct hdmi_eld *eld,
 531                              struct snd_info_buffer *buffer)
 532 {
 533         struct parsed_hdmi_eld *e = &eld->info;
 534         char line[64];
 535         char name[64];
 536         char *sname;
 537         long long val;
 538         unsigned int n;
 539
 540         while (!snd_info_get_line(buffer, line, sizeof(line))) {
 541                 if (sscanf(line, "%s %llx", name, &val) != 2)
 542                         continue;
 543                 /*
 544                  * We don't allow modification to these fields:
 545                  *      monitor_name manufacture_id product_id
 546                  *      eld_version edid_version
 547                  */
 548                 if (!strcmp(name, "monitor_present"))
 549                         eld->monitor_present = val;
 550                 else if (!strcmp(name, "eld_valid"))
 551                         eld->eld_valid = val;
 552                 else if (!strcmp(name, "connection_type"))
 553                         e->conn_type = val;
 554                 else if (!strcmp(name, "port_id"))
 555                         e->port_id = val;
 556                 else if (!strcmp(name, "support_hdcp"))
 557                         e->support_hdcp = val;
 558                 else if (!strcmp(name, "support_ai"))
 559                         e->support_ai = val;
 560                 else if (!strcmp(name, "audio_sync_delay"))
 561                         e->aud_synch_delay = val;
 562                 else if (!strcmp(name, "speakers"))
 563                         e->spk_alloc = val;
 564                 else if (!strcmp(name, "sad_count"))
 565                         e->sad_count = val;
 566                 else if (!strncmp(name, "sad", 3)) {
 567                         sname = name + 4;
 568                         n = name[3] - '0';
 569                         if (name[4] >= '0' && name[4] <= '9') {
 570                                 sname++;
 571                                 n = 10 * n + name[4] - '0';
 572                         }
 573                         if (n >= ELD_MAX_SAD)
 574                                 continue;
 575                         if (!strcmp(sname, "_coding_type"))
 576                                 e->sad[n].format = val;
 577                         else if (!strcmp(sname, "_channels"))
 578                                 e->sad[n].channels = val;
 579                         else if (!strcmp(sname, "_rates"))
 580                                 e->sad[n].rates = val;
 581                         else if (!strcmp(sname, "_bits"))
 582                                 e->sad[n].sample_bits = val;
 583                         else if (!strcmp(sname, "_max_bitrate"))
 584                                 e->sad[n].max_bitrate = val;
 585                         else if (!strcmp(sname, "_profile"))
 586                                 e->sad[n].profile = val;
 587                         if (n >= e->sad_count)
 588                                 e->sad_count = n + 1;
 589                 }
 590         }
 591 }
 592 #endif /* CONFIG_PROC_FS */
 593
 594 /* update PCM info based on ELD */
 595 void snd_hdmi_eld_update_pcm_info(struct parsed_hdmi_eld *e,
 596                               struct hda_pcm_stream *hinfo)
 597 {
 598         u32 rates;
 599         u64 formats;
 600         unsigned int maxbps;
 601         unsigned int channels_max;
 602         int i;
 603
 604         /* assume basic audio support (the basic audio flag is not in ELD;
 605          * however, all audio capable sinks are required to support basic
 606          * audio) */
 607         rates = SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
 608                 SNDRV_PCM_RATE_48000;
 609         formats = SNDRV_PCM_FMTBIT_S16_LE;
 610         maxbps = 16;
 611         channels_max = 2;
 612         for (i = 0; i < e->sad_count; i++) {
 613                 struct cea_sad *a = &e->sad[i];
 614                 rates |= a->rates;
 615                 if (a->channels > channels_max)
 616                         channels_max = a->channels;
 617                 if (a->format == AUDIO_CODING_TYPE_LPCM) {
 618                         if (a->sample_bits & AC_SUPPCM_BITS_20) {
 619                                 formats |= SNDRV_PCM_FMTBIT_S32_LE;
 620                                 if (maxbps < 20)
 621                                         maxbps = 20;
 622                         }
 623                         if (a->sample_bits & AC_SUPPCM_BITS_24) {
 624                                 formats |= SNDRV_PCM_FMTBIT_S32_LE;
 625                                 if (maxbps < 24)
 626                                         maxbps = 24;
 627                         }
 628                 }
 629         }
 630
 631         /* restrict the parameters by the values the codec provides */
 632         hinfo->rates &= rates;
 633         hinfo->formats &= formats;
 634         hinfo->maxbps = min(hinfo->maxbps, maxbps);
 635         hinfo->channels_max = min(hinfo->channels_max, channels_max);
 636 }
 637
 638
 639 /* ATI/AMD specific stuff (ELD emulation) */
 640
 641 #define ATI_VERB_SET_AUDIO_DESCRIPTOR   0x776
 642 #define ATI_VERB_SET_SINK_INFO_INDEX    0x780
 643 #define ATI_VERB_GET_SPEAKER_ALLOCATION 0xf70
 644 #define ATI_VERB_GET_AUDIO_DESCRIPTOR   0xf76
 645 #define ATI_VERB_GET_AUDIO_VIDEO_DELAY  0xf7b
 646 #define ATI_VERB_GET_SINK_INFO_INDEX    0xf80
 647 #define ATI_VERB_GET_SINK_INFO_DATA     0xf81
 648
 649 #define ATI_SPKALLOC_SPKALLOC           0x007f
 650 #define ATI_SPKALLOC_TYPE_HDMI          0x0100
 651 #define ATI_SPKALLOC_TYPE_DISPLAYPORT   0x0200
 652
 653 /* first three bytes are just standard SAD */
 654 #define ATI_AUDIODESC_CHANNELS          0x00000007
 655 #define ATI_AUDIODESC_RATES             0x0000ff00
 656 #define ATI_AUDIODESC_LPCM_STEREO_RATES 0xff000000
 657
 658 /* in standard HDMI VSDB format */
 659 #define ATI_DELAY_VIDEO_LATENCY         0x000000ff
 660 #define ATI_DELAY_AUDIO_LATENCY         0x0000ff00
 661
 662 enum ati_sink_info_idx {
 663         ATI_INFO_IDX_MANUFACTURER_ID    = 0,
 664         ATI_INFO_IDX_PRODUCT_ID         = 1,
 665         ATI_INFO_IDX_SINK_DESC_LEN      = 2,
 666         ATI_INFO_IDX_PORT_ID_LOW        = 3,
 667         ATI_INFO_IDX_PORT_ID_HIGH       = 4,
 668         ATI_INFO_IDX_SINK_DESC_FIRST    = 5,
 669         ATI_INFO_IDX_SINK_DESC_LAST     = 22, /* max len 18 bytes */
 670 };
 671
 672 int snd_hdmi_get_eld_ati(struct hda_codec *codec, hda_nid_t nid,
 673                          unsigned char *buf, int *eld_size, bool rev3_or_later)
 674 {
 675         int spkalloc, ati_sad, aud_synch;
 676         int sink_desc_len = 0;
 677         int pos, i;
 678
 679         /* ATI/AMD does not have ELD, emulate it */
 680
 681         spkalloc = snd_hda_codec_read(codec, nid, 0, ATI_VERB_GET_SPEAKER_ALLOCATION, 0);
 682
 683         if (!spkalloc) {
 684                 snd_printd(KERN_INFO "HDMI ATI/AMD: no speaker allocation for ELD\n");
 685                 return -EINVAL;
 686         }
 687
 688         memset(buf, 0, ELD_FIXED_BYTES + ELD_MAX_MNL + ELD_MAX_SAD * 3);
 689
 690         /* version */
 691         buf[0] = ELD_VER_CEA_861D << 3;
 692
 693         /* speaker allocation from EDID */
 694         buf[7] = spkalloc & ATI_SPKALLOC_SPKALLOC;
 695
 696         /* is DisplayPort? */
 697         if (spkalloc & ATI_SPKALLOC_TYPE_DISPLAYPORT)
 698                 buf[5] |= 0x04;
 699
 700         pos = ELD_FIXED_BYTES;
 701
 702         if (rev3_or_later) {
 703                 int sink_info;
 704
 705                 snd_hda_codec_write(codec, nid, 0, ATI_VERB_SET_SINK_INFO_INDEX, ATI_INFO_IDX_PORT_ID_LOW);
 706                 sink_info = snd_hda_codec_read(codec, nid, 0, ATI_VERB_GET_SINK_INFO_DATA, 0);
 707                 put_unaligned_le32(sink_info, buf + 8);
 708
 709                 snd_hda_codec_write(codec, nid, 0, ATI_VERB_SET_SINK_INFO_INDEX, ATI_INFO_IDX_PORT_ID_HIGH);
 710                 sink_info = snd_hda_codec_read(codec, nid, 0, ATI_VERB_GET_SINK_INFO_DATA, 0);
 711                 put_unaligned_le32(sink_info, buf + 12);
 712
 713                 snd_hda_codec_write(codec, nid, 0, ATI_VERB_SET_SINK_INFO_INDEX, ATI_INFO_IDX_MANUFACTURER_ID);
 714                 sink_info = snd_hda_codec_read(codec, nid, 0, ATI_VERB_GET_SINK_INFO_DATA, 0);
 715                 put_unaligned_le16(sink_info, buf + 16);
 716
 717                 snd_hda_codec_write(codec, nid, 0, ATI_VERB_SET_SINK_INFO_INDEX, ATI_INFO_IDX_PRODUCT_ID);
 718                 sink_info = snd_hda_codec_read(codec, nid, 0, ATI_VERB_GET_SINK_INFO_DATA, 0);
 719                 put_unaligned_le16(sink_info, buf + 18);
 720
 721                 snd_hda_codec_write(codec, nid, 0, ATI_VERB_SET_SINK_INFO_INDEX, ATI_INFO_IDX_SINK_DESC_LEN);
 722                 sink_desc_len = snd_hda_codec_read(codec, nid, 0, ATI_VERB_GET_SINK_INFO_DATA, 0);
 723
 724                 if (sink_desc_len > ELD_MAX_MNL) {
 725                         snd_printd(KERN_INFO "HDMI ATI/AMD: Truncating HDMI sink description with length %d\n",
 726                                    sink_desc_len);
 727                         sink_desc_len = ELD_MAX_MNL;
 728                 }
 729
 730                 buf[4] |= sink_desc_len;
 731
 732                 for (i = 0; i < sink_desc_len; i++) {
 733                         snd_hda_codec_write(codec, nid, 0, ATI_VERB_SET_SINK_INFO_INDEX, ATI_INFO_IDX_SINK_DESC_FIRST + i);
 734                         buf[pos++] = snd_hda_codec_read(codec, nid, 0, ATI_VERB_GET_SINK_INFO_DATA, 0);
 735                 }
 736         }
 737
 738         for (i = AUDIO_CODING_TYPE_LPCM; i <= AUDIO_CODING_TYPE_WMAPRO; i++) {
 739                 if (i == AUDIO_CODING_TYPE_SACD || i == AUDIO_CODING_TYPE_DST)
 740                         continue; /* not handled by ATI/AMD */
 741
 742                 snd_hda_codec_write(codec, nid, 0, ATI_VERB_SET_AUDIO_DESCRIPTOR, i << 3);
 743                 ati_sad = snd_hda_codec_read(codec, nid, 0, ATI_VERB_GET_AUDIO_DESCRIPTOR, 0);
 744
 745                 if (ati_sad & ATI_AUDIODESC_RATES) {
 746                         /* format is supported, copy SAD as-is */
 747                         buf[pos++] = (ati_sad & 0x0000ff) >> 0;
 748                         buf[pos++] = (ati_sad & 0x00ff00) >> 8;
 749                         buf[pos++] = (ati_sad & 0xff0000) >> 16;
 750                 }
 751
 752                 if (i == AUDIO_CODING_TYPE_LPCM
 753                     && (ati_sad & ATI_AUDIODESC_LPCM_STEREO_RATES)
 754                     && (ati_sad & ATI_AUDIODESC_LPCM_STEREO_RATES) >> 16 != (ati_sad & ATI_AUDIODESC_RATES)) {
 755                         /* for PCM there is a separate stereo rate mask */
 756                         buf[pos++] = ((ati_sad & 0x000000ff) & ~ATI_AUDIODESC_CHANNELS) | 0x1;
 757                         /* rates from the extra byte */
 758                         buf[pos++] = (ati_sad & 0xff000000) >> 24;
 759                         buf[pos++] = (ati_sad & 0x00ff0000) >> 16;
 760                 }
 761         }
 762
 763         if (pos == ELD_FIXED_BYTES + sink_desc_len) {
 764                 snd_printd(KERN_INFO "HDMI ATI/AMD: no audio descriptors for ELD\n");
 765                 return -EINVAL;
 766         }
 767
 768         aud_synch = snd_hda_codec_read(codec, nid, 0, ATI_VERB_GET_AUDIO_VIDEO_DELAY, 0);
 769         if ((aud_synch & ATI_DELAY_VIDEO_LATENCY) && (aud_synch & ATI_DELAY_AUDIO_LATENCY)) {
 770                 int video_latency = (aud_synch & ATI_DELAY_VIDEO_LATENCY) - 1;
 771                 int audio_latency = ((aud_synch & ATI_DELAY_AUDIO_LATENCY) >> 8) - 1;
 772
 773                 if (video_latency > audio_latency)
 774                         buf[6] = min(video_latency - audio_latency, 0xfa);
 775         }
 776
 777         /* Baseline length */
 778         buf[2] = pos - 4;
 779
 780         /* SAD count */
 781         buf[5] |= ((pos - ELD_FIXED_BYTES - sink_desc_len) / 3) << 4;
 782
 783         *eld_size = pos;
 784
 785         return 0;
 786 }