?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Staging: unisys: Remove RETINT macro
[linux/fpc-iii.git] / sound / pci / hda / hda_eld.c
blob79ca80f6c77ada6d182a86b9880f3ce9125726f5
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 <= 0) {
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 <= 0)
746 continue;
747
748 if (ati_sad & ATI_AUDIODESC_RATES) {
749 /* format is supported, copy SAD as-is */
750 buf[pos++] = (ati_sad & 0x0000ff) >> 0;
751 buf[pos++] = (ati_sad & 0x00ff00) >> 8;
752 buf[pos++] = (ati_sad & 0xff0000) >> 16;
753 }
754
755 if (i == AUDIO_CODING_TYPE_LPCM
756 && (ati_sad & ATI_AUDIODESC_LPCM_STEREO_RATES)
757 && (ati_sad & ATI_AUDIODESC_LPCM_STEREO_RATES) >> 16 != (ati_sad & ATI_AUDIODESC_RATES)) {
758 /* for PCM there is a separate stereo rate mask */
759 buf[pos++] = ((ati_sad & 0x000000ff) & ~ATI_AUDIODESC_CHANNELS) | 0x1;
760 /* rates from the extra byte */
761 buf[pos++] = (ati_sad & 0xff000000) >> 24;
762 buf[pos++] = (ati_sad & 0x00ff0000) >> 16;
763 }
764 }
765
766 if (pos == ELD_FIXED_BYTES + sink_desc_len) {
767 snd_printd(KERN_INFO "HDMI ATI/AMD: no audio descriptors for ELD\n");
768 return -EINVAL;
769 }
770
771 /*
772 * HDMI VSDB latency format:
773 * separately for both audio and video:
774 * 0 field not valid or unknown latency
775 * [1..251] msecs = (x-1)*2 (max 500ms with x = 251 = 0xfb)
776 * 255 audio/video not supported
777 *
778 * HDA latency format:
779 * single value indicating video latency relative to audio:
780 * 0 unknown or 0ms
781 * [1..250] msecs = x*2 (max 500ms with x = 250 = 0xfa)
782 * [251..255] reserved
783 */
784 aud_synch = snd_hda_codec_read(codec, nid, 0, ATI_VERB_GET_AUDIO_VIDEO_DELAY, 0);
785 if ((aud_synch & ATI_DELAY_VIDEO_LATENCY) && (aud_synch & ATI_DELAY_AUDIO_LATENCY)) {
786 int video_latency_hdmi = (aud_synch & ATI_DELAY_VIDEO_LATENCY);
787 int audio_latency_hdmi = (aud_synch & ATI_DELAY_AUDIO_LATENCY) >> 8;
788
789 if (video_latency_hdmi <= 0xfb && audio_latency_hdmi <= 0xfb &&
790 video_latency_hdmi > audio_latency_hdmi)
791 buf[6] = video_latency_hdmi - audio_latency_hdmi;
792 /* else unknown/invalid or 0ms or video ahead of audio, so use zero */
793 }
794
795 /* SAD count */
796 buf[5] |= ((pos - ELD_FIXED_BYTES - sink_desc_len) / 3) << 4;
797
798 /* Baseline ELD block length is 4-byte aligned */
799 pos = round_up(pos, 4);
800
801 /* Baseline ELD length (4-byte header is not counted in) */
802 buf[2] = (pos - 4) / 4;
803
804 *eld_size = pos;
805
806 return 0;
807 }
Linux with added FPC-III support