1
2
3
4
5
6
7
8
9
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
20enum eld_versions {
21 ELD_VER_CEA_861D = 2,
22 ELD_VER_PARTIAL = 31,
23};
24
25enum 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
33static const char * const eld_connection_type_names[4] = {
34 "HDMI",
35 "DisplayPort",
36 "2-reserved",
37 "3-reserved"
38};
39
40enum 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
58 AUDIO_CODING_TYPE_HE_AAC = 15,
59 AUDIO_CODING_TYPE_HE_AAC2 = 16,
60 AUDIO_CODING_TYPE_MPEG_SURROUND = 17,
61};
62
63enum 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
71static const char * const cea_audio_coding_type_names[] = {
72 "undefined",
73 "LPCM",
74 "AC-3",
75 "MPEG1",
76 "MP3",
77 "MPEG2",
78 "AAC-LC",
79 "DTS",
80 "ATRAC",
81 "DSD (One Bit Audio)",
82 "E-AC-3/DD+ (Dolby Digital Plus)",
83 "DTS-HD",
84 "MLP (Dolby TrueHD)",
85 "DST",
86 "WMAPro",
87 "HE-AAC",
88 "HE-AACv2",
89 "MPEG Surround",
90};
91
92
93
94
95
96
97
98
99
100
101static int cea_sample_sizes[4] = {
102 0,
103 AC_SUPPCM_BITS_16,
104 AC_SUPPCM_BITS_20,
105 AC_SUPPCM_BITS_24,
106};
107
108
109
110
111static int cea_sampling_frequencies[8] = {
112 0,
113 SNDRV_PCM_RATE_32000,
114 SNDRV_PCM_RATE_44100,
115 SNDRV_PCM_RATE_48000,
116 SNDRV_PCM_RATE_88200,
117 SNDRV_PCM_RATE_96000,
118 SNDRV_PCM_RATE_176400,
119 SNDRV_PCM_RATE_192000,
120};
121
122static 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
144static 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
223
224int 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
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
276
277
278
279 if (!e->spk_alloc)
280 e->spk_alloc = 0xffff;
281
282 return 0;
283
284out_fail:
285 return -EINVAL;
286}
287
288int 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
294int 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
303
304
305
306 size = snd_hdmi_get_eld_size(codec, nid);
307 if (size == 0) {
308
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
318 for (i = 0; i < size; i++) {
319 unsigned int val = hdmi_get_eld_data(codec, nid, i);
320
321
322
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
332
333
334
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;
345error:
346 return ret;
347}
348
349
350
351
352
353static void hdmi_print_pcm_rates(int pcm, char *buf, int buflen)
354{
355 static 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 += snprintf(buf + j, buflen - j, " %d",
364 alsa_rates[i]);
365
366 buf[j] = '\0';
367}
368
369#define SND_PRINT_RATES_ADVISED_BUFSIZE 80
370
371static 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
396void 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
416static 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
442void 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
490void 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
505
506
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
553
554
555void 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
565
566
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
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
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
614#define ATI_AUDIODESC_CHANNELS 0x00000007
615#define ATI_AUDIODESC_RATES 0x0000ff00
616#define ATI_AUDIODESC_LPCM_STEREO_RATES 0xff000000
617
618
619#define ATI_DELAY_VIDEO_LATENCY 0x000000ff
620#define ATI_DELAY_AUDIO_LATENCY 0x0000ff00
621
622enum 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,
630};
631
632int 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
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
651 buf[0] = ELD_VER_CEA_861D << 3;
652
653
654 buf[7] = spkalloc & ATI_SPKALLOC_SPKALLOC;
655
656
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;
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
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
719 buf[pos++] = ((ati_sad & 0x000000ff) & ~ATI_AUDIODESC_CHANNELS) | 0x1;
720
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
733
734
735
736
737
738
739
740
741
742
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
753 }
754
755
756 buf[5] |= ((pos - ELD_FIXED_BYTES - sink_desc_len) / 3) << 4;
757
758
759 pos = round_up(pos, 4);
760
761
762 buf[2] = (pos - 4) / 4;
763
764 *eld_size = pos;
765
766 return 0;
767}
768