sound/pci/hda/hda_eld.c

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