1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24#include <linux/init.h>
25#include <linux/slab.h>
26#include <sound/core.h>
27#include <asm/unaligned.h>
28#include "hda_codec.h"
29#include "hda_local.h"
30
31enum eld_versions {
32 ELD_VER_CEA_861D = 2,
33 ELD_VER_PARTIAL = 31,
34};
35
36enum cea_edid_versions {
37 CEA_EDID_VER_NONE = 0,
38 CEA_EDID_VER_CEA861 = 1,
39 CEA_EDID_VER_CEA861A = 2,
40 CEA_EDID_VER_CEA861BCD = 3,
41 CEA_EDID_VER_RESERVED = 4,
42};
43
44static char *cea_speaker_allocation_names[] = {
45 "FL/FR",
46 "LFE",
47 "FC",
48 "RL/RR",
49 "RC",
50 "FLC/FRC",
51 "RLC/RRC",
52 "FLW/FRW",
53 "FLH/FRH",
54 "TC",
55 "FCH",
56};
57
58static char *eld_connection_type_names[4] = {
59 "HDMI",
60 "DisplayPort",
61 "2-reserved",
62 "3-reserved"
63};
64
65enum cea_audio_coding_types {
66 AUDIO_CODING_TYPE_REF_STREAM_HEADER = 0,
67 AUDIO_CODING_TYPE_LPCM = 1,
68 AUDIO_CODING_TYPE_AC3 = 2,
69 AUDIO_CODING_TYPE_MPEG1 = 3,
70 AUDIO_CODING_TYPE_MP3 = 4,
71 AUDIO_CODING_TYPE_MPEG2 = 5,
72 AUDIO_CODING_TYPE_AACLC = 6,
73 AUDIO_CODING_TYPE_DTS = 7,
74 AUDIO_CODING_TYPE_ATRAC = 8,
75 AUDIO_CODING_TYPE_SACD = 9,
76 AUDIO_CODING_TYPE_EAC3 = 10,
77 AUDIO_CODING_TYPE_DTS_HD = 11,
78 AUDIO_CODING_TYPE_MLP = 12,
79 AUDIO_CODING_TYPE_DST = 13,
80 AUDIO_CODING_TYPE_WMAPRO = 14,
81 AUDIO_CODING_TYPE_REF_CXT = 15,
82
83 AUDIO_CODING_TYPE_HE_AAC = 15,
84 AUDIO_CODING_TYPE_HE_AAC2 = 16,
85 AUDIO_CODING_TYPE_MPEG_SURROUND = 17,
86};
87
88enum cea_audio_coding_xtypes {
89 AUDIO_CODING_XTYPE_HE_REF_CT = 0,
90 AUDIO_CODING_XTYPE_HE_AAC = 1,
91 AUDIO_CODING_XTYPE_HE_AAC2 = 2,
92 AUDIO_CODING_XTYPE_MPEG_SURROUND = 3,
93 AUDIO_CODING_XTYPE_FIRST_RESERVED = 4,
94};
95
96static char *cea_audio_coding_type_names[] = {
97 "undefined",
98 "LPCM",
99 "AC-3",
100 "MPEG1",
101 "MP3",
102 "MPEG2",
103 "AAC-LC",
104 "DTS",
105 "ATRAC",
106 "DSD (One Bit Audio)",
107 "E-AC-3/DD+ (Dolby Digital Plus)",
108 "DTS-HD",
109 "MLP (Dolby TrueHD)",
110 "DST",
111 "WMAPro",
112 "HE-AAC",
113 "HE-AACv2",
114 "MPEG Surround",
115};
116
117
118
119
120
121
122
123
124
125
126static int cea_sample_sizes[4] = {
127 0,
128 AC_SUPPCM_BITS_16,
129 AC_SUPPCM_BITS_20,
130 AC_SUPPCM_BITS_24,
131};
132
133
134
135
136static int cea_sampling_frequencies[8] = {
137 0,
138 SNDRV_PCM_RATE_32000,
139 SNDRV_PCM_RATE_44100,
140 SNDRV_PCM_RATE_48000,
141 SNDRV_PCM_RATE_88200,
142 SNDRV_PCM_RATE_96000,
143 SNDRV_PCM_RATE_176400,
144 SNDRV_PCM_RATE_192000,
145};
146
147static unsigned char hdmi_get_eld_byte(struct hda_codec *codec, hda_nid_t nid,
148 int byte_index)
149{
150 unsigned int val;
151
152 val = snd_hda_codec_read(codec, nid, 0,
153 AC_VERB_GET_HDMI_ELDD, byte_index);
154
155#ifdef BE_PARANOID
156 printk(KERN_INFO "HDMI: ELD data byte %d: 0x%x\n", byte_index, val);
157#endif
158
159 if ((val & AC_ELDD_ELD_VALID) == 0) {
160 snd_printd(KERN_INFO "HDMI: invalid ELD data byte %d\n",
161 byte_index);
162 val = 0;
163 }
164
165 return val & AC_ELDD_ELD_DATA;
166}
167
168#define GRAB_BITS(buf, byte, lowbit, bits) \
169({ \
170 BUILD_BUG_ON(lowbit > 7); \
171 BUILD_BUG_ON(bits > 8); \
172 BUILD_BUG_ON(bits <= 0); \
173 \
174 (buf[byte] >> (lowbit)) & ((1 << (bits)) - 1); \
175})
176
177static void hdmi_update_short_audio_desc(struct cea_sad *a,
178 const unsigned char *buf)
179{
180 int i;
181 int val;
182
183 val = GRAB_BITS(buf, 1, 0, 7);
184 a->rates = 0;
185 for (i = 0; i < 7; i++)
186 if (val & (1 << i))
187 a->rates |= cea_sampling_frequencies[i + 1];
188
189 a->channels = GRAB_BITS(buf, 0, 0, 3);
190 a->channels++;
191
192 a->sample_bits = 0;
193 a->max_bitrate = 0;
194
195 a->format = GRAB_BITS(buf, 0, 3, 4);
196 switch (a->format) {
197 case AUDIO_CODING_TYPE_REF_STREAM_HEADER:
198 snd_printd(KERN_INFO
199 "HDMI: audio coding type 0 not expected\n");
200 break;
201
202 case AUDIO_CODING_TYPE_LPCM:
203 val = GRAB_BITS(buf, 2, 0, 3);
204 for (i = 0; i < 3; i++)
205 if (val & (1 << i))
206 a->sample_bits |= cea_sample_sizes[i + 1];
207 break;
208
209 case AUDIO_CODING_TYPE_AC3:
210 case AUDIO_CODING_TYPE_MPEG1:
211 case AUDIO_CODING_TYPE_MP3:
212 case AUDIO_CODING_TYPE_MPEG2:
213 case AUDIO_CODING_TYPE_AACLC:
214 case AUDIO_CODING_TYPE_DTS:
215 case AUDIO_CODING_TYPE_ATRAC:
216 a->max_bitrate = GRAB_BITS(buf, 2, 0, 8);
217 a->max_bitrate *= 8000;
218 break;
219
220 case AUDIO_CODING_TYPE_SACD:
221 break;
222
223 case AUDIO_CODING_TYPE_EAC3:
224 break;
225
226 case AUDIO_CODING_TYPE_DTS_HD:
227 break;
228
229 case AUDIO_CODING_TYPE_MLP:
230 break;
231
232 case AUDIO_CODING_TYPE_DST:
233 break;
234
235 case AUDIO_CODING_TYPE_WMAPRO:
236 a->profile = GRAB_BITS(buf, 2, 0, 3);
237 break;
238
239 case AUDIO_CODING_TYPE_REF_CXT:
240 a->format = GRAB_BITS(buf, 2, 3, 5);
241 if (a->format == AUDIO_CODING_XTYPE_HE_REF_CT ||
242 a->format >= AUDIO_CODING_XTYPE_FIRST_RESERVED) {
243 snd_printd(KERN_INFO
244 "HDMI: audio coding xtype %d not expected\n",
245 a->format);
246 a->format = 0;
247 } else
248 a->format += AUDIO_CODING_TYPE_HE_AAC -
249 AUDIO_CODING_XTYPE_HE_AAC;
250 break;
251 }
252}
253
254
255
256
257static int hdmi_update_eld(struct hdmi_eld *e,
258 const unsigned char *buf, int size)
259{
260 int mnl;
261 int i;
262
263 e->eld_ver = GRAB_BITS(buf, 0, 3, 5);
264 if (e->eld_ver != ELD_VER_CEA_861D &&
265 e->eld_ver != ELD_VER_PARTIAL) {
266 snd_printd(KERN_INFO "HDMI: Unknown ELD version %d\n",
267 e->eld_ver);
268 goto out_fail;
269 }
270
271 e->eld_size = size;
272 e->baseline_len = GRAB_BITS(buf, 2, 0, 8);
273 mnl = GRAB_BITS(buf, 4, 0, 5);
274 e->cea_edid_ver = GRAB_BITS(buf, 4, 5, 3);
275
276 e->support_hdcp = GRAB_BITS(buf, 5, 0, 1);
277 e->support_ai = GRAB_BITS(buf, 5, 1, 1);
278 e->conn_type = GRAB_BITS(buf, 5, 2, 2);
279 e->sad_count = GRAB_BITS(buf, 5, 4, 4);
280
281 e->aud_synch_delay = GRAB_BITS(buf, 6, 0, 8) * 2;
282 e->spk_alloc = GRAB_BITS(buf, 7, 0, 7);
283
284 e->port_id = get_unaligned_le64(buf + 8);
285
286
287 e->manufacture_id = get_unaligned_le16(buf + 16);
288 e->product_id = get_unaligned_le16(buf + 18);
289
290 if (mnl > ELD_MAX_MNL) {
291 snd_printd(KERN_INFO "HDMI: MNL is reserved value %d\n", mnl);
292 goto out_fail;
293 } else if (ELD_FIXED_BYTES + mnl > size) {
294 snd_printd(KERN_INFO "HDMI: out of range MNL %d\n", mnl);
295 goto out_fail;
296 } else
297 strlcpy(e->monitor_name, buf + ELD_FIXED_BYTES, mnl);
298
299 for (i = 0; i < e->sad_count; i++) {
300 if (ELD_FIXED_BYTES + mnl + 3 * (i + 1) > size) {
301 snd_printd(KERN_INFO "HDMI: out of range SAD %d\n", i);
302 goto out_fail;
303 }
304 hdmi_update_short_audio_desc(e->sad + i,
305 buf + ELD_FIXED_BYTES + mnl + 3 * i);
306 }
307
308 return 0;
309
310out_fail:
311 e->eld_ver = 0;
312 return -EINVAL;
313}
314
315static int hdmi_eld_valid(struct hda_codec *codec, hda_nid_t nid)
316{
317 int eldv;
318 int present;
319
320 present = snd_hda_pin_sense(codec, nid);
321 eldv = (present & AC_PINSENSE_ELDV);
322 present = (present & AC_PINSENSE_PRESENCE);
323
324#ifdef CONFIG_SND_DEBUG_VERBOSE
325 printk(KERN_INFO "HDMI: sink_present = %d, eld_valid = %d\n",
326 !!present, !!eldv);
327#endif
328
329 return eldv && present;
330}
331
332int snd_hdmi_get_eld_size(struct hda_codec *codec, hda_nid_t nid)
333{
334 return snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_HDMI_DIP_SIZE,
335 AC_DIPSIZE_ELD_BUF);
336}
337
338int snd_hdmi_get_eld(struct hdmi_eld *eld,
339 struct hda_codec *codec, hda_nid_t nid)
340{
341 int i;
342 int ret;
343 int size;
344 unsigned char *buf;
345
346 if (!hdmi_eld_valid(codec, nid))
347 return -ENOENT;
348
349 size = snd_hdmi_get_eld_size(codec, nid);
350 if (size == 0) {
351
352 snd_printd(KERN_INFO "HDMI: ELD buf size is 0, force 128\n");
353 size = 128;
354 }
355 if (size < ELD_FIXED_BYTES || size > PAGE_SIZE) {
356 snd_printd(KERN_INFO "HDMI: invalid ELD buf size %d\n", size);
357 return -ERANGE;
358 }
359
360 buf = kmalloc(size, GFP_KERNEL);
361 if (!buf)
362 return -ENOMEM;
363
364 for (i = 0; i < size; i++)
365 buf[i] = hdmi_get_eld_byte(codec, nid, i);
366
367 ret = hdmi_update_eld(eld, buf, size);
368
369 kfree(buf);
370 return ret;
371}
372
373static void hdmi_show_short_audio_desc(struct cea_sad *a)
374{
375 char buf[SND_PRINT_RATES_ADVISED_BUFSIZE];
376 char buf2[8 + SND_PRINT_BITS_ADVISED_BUFSIZE] = ", bits =";
377
378 if (!a->format)
379 return;
380
381 snd_print_pcm_rates(a->rates, buf, sizeof(buf));
382
383 if (a->format == AUDIO_CODING_TYPE_LPCM)
384 snd_print_pcm_bits(a->sample_bits, buf2 + 8, sizeof(buf2) - 8);
385 else if (a->max_bitrate)
386 snprintf(buf2, sizeof(buf2),
387 ", max bitrate = %d", a->max_bitrate);
388 else
389 buf2[0] = '\0';
390
391 printk(KERN_INFO "HDMI: supports coding type %s:"
392 " channels = %d, rates =%s%s\n",
393 cea_audio_coding_type_names[a->format],
394 a->channels,
395 buf,
396 buf2);
397}
398
399void snd_print_channel_allocation(int spk_alloc, char *buf, int buflen)
400{
401 int i, j;
402
403 for (i = 0, j = 0; i < ARRAY_SIZE(cea_speaker_allocation_names); i++) {
404 if (spk_alloc & (1 << i))
405 j += snprintf(buf + j, buflen - j, " %s",
406 cea_speaker_allocation_names[i]);
407 }
408 buf[j] = '\0';
409}
410
411void snd_hdmi_show_eld(struct hdmi_eld *e)
412{
413 int i;
414
415 printk(KERN_INFO "HDMI: detected monitor %s at connection type %s\n",
416 e->monitor_name,
417 eld_connection_type_names[e->conn_type]);
418
419 if (e->spk_alloc) {
420 char buf[SND_PRINT_CHANNEL_ALLOCATION_ADVISED_BUFSIZE];
421 snd_print_channel_allocation(e->spk_alloc, buf, sizeof(buf));
422 printk(KERN_INFO "HDMI: available speakers:%s\n", buf);
423 }
424
425 for (i = 0; i < e->sad_count; i++)
426 hdmi_show_short_audio_desc(e->sad + i);
427}
428
429#ifdef CONFIG_PROC_FS
430
431static void hdmi_print_sad_info(int i, struct cea_sad *a,
432 struct snd_info_buffer *buffer)
433{
434 char buf[SND_PRINT_RATES_ADVISED_BUFSIZE];
435
436 snd_iprintf(buffer, "sad%d_coding_type\t[0x%x] %s\n",
437 i, a->format, cea_audio_coding_type_names[a->format]);
438 snd_iprintf(buffer, "sad%d_channels\t\t%d\n", i, a->channels);
439
440 snd_print_pcm_rates(a->rates, buf, sizeof(buf));
441 snd_iprintf(buffer, "sad%d_rates\t\t[0x%x]%s\n", i, a->rates, buf);
442
443 if (a->format == AUDIO_CODING_TYPE_LPCM) {
444 snd_print_pcm_bits(a->sample_bits, buf, sizeof(buf));
445 snd_iprintf(buffer, "sad%d_bits\t\t[0x%x]%s\n",
446 i, a->sample_bits, buf);
447 }
448
449 if (a->max_bitrate)
450 snd_iprintf(buffer, "sad%d_max_bitrate\t%d\n",
451 i, a->max_bitrate);
452
453 if (a->profile)
454 snd_iprintf(buffer, "sad%d_profile\t\t%d\n", i, a->profile);
455}
456
457static void hdmi_print_eld_info(struct snd_info_entry *entry,
458 struct snd_info_buffer *buffer)
459{
460 struct hdmi_eld *e = entry->private_data;
461 char buf[SND_PRINT_CHANNEL_ALLOCATION_ADVISED_BUFSIZE];
462 int i;
463 static char *eld_versoin_names[32] = {
464 "reserved",
465 "reserved",
466 "CEA-861D or below",
467 [3 ... 30] = "reserved",
468 [31] = "partial"
469 };
470 static char *cea_edid_version_names[8] = {
471 "no CEA EDID Timing Extension block present",
472 "CEA-861",
473 "CEA-861-A",
474 "CEA-861-B, C or D",
475 [4 ... 7] = "reserved"
476 };
477
478 snd_iprintf(buffer, "monitor_present\t\t%d\n", e->monitor_present);
479 snd_iprintf(buffer, "eld_valid\t\t%d\n", e->eld_valid);
480 snd_iprintf(buffer, "monitor_name\t\t%s\n", e->monitor_name);
481 snd_iprintf(buffer, "connection_type\t\t%s\n",
482 eld_connection_type_names[e->conn_type]);
483 snd_iprintf(buffer, "eld_version\t\t[0x%x] %s\n", e->eld_ver,
484 eld_versoin_names[e->eld_ver]);
485 snd_iprintf(buffer, "edid_version\t\t[0x%x] %s\n", e->cea_edid_ver,
486 cea_edid_version_names[e->cea_edid_ver]);
487 snd_iprintf(buffer, "manufacture_id\t\t0x%x\n", e->manufacture_id);
488 snd_iprintf(buffer, "product_id\t\t0x%x\n", e->product_id);
489 snd_iprintf(buffer, "port_id\t\t\t0x%llx\n", (long long)e->port_id);
490 snd_iprintf(buffer, "support_hdcp\t\t%d\n", e->support_hdcp);
491 snd_iprintf(buffer, "support_ai\t\t%d\n", e->support_ai);
492 snd_iprintf(buffer, "audio_sync_delay\t%d\n", e->aud_synch_delay);
493
494 snd_print_channel_allocation(e->spk_alloc, buf, sizeof(buf));
495 snd_iprintf(buffer, "speakers\t\t[0x%x]%s\n", e->spk_alloc, buf);
496
497 snd_iprintf(buffer, "sad_count\t\t%d\n", e->sad_count);
498
499 for (i = 0; i < e->sad_count; i++)
500 hdmi_print_sad_info(i, e->sad + i, buffer);
501}
502
503static void hdmi_write_eld_info(struct snd_info_entry *entry,
504 struct snd_info_buffer *buffer)
505{
506 struct hdmi_eld *e = entry->private_data;
507 char line[64];
508 char name[64];
509 char *sname;
510 long long val;
511 unsigned int n;
512
513 while (!snd_info_get_line(buffer, line, sizeof(line))) {
514 if (sscanf(line, "%s %llx", name, &val) != 2)
515 continue;
516
517
518
519
520
521 if (!strcmp(name, "monitor_present"))
522 e->monitor_present = val;
523 else if (!strcmp(name, "eld_valid"))
524 e->eld_valid = val;
525 else if (!strcmp(name, "connection_type"))
526 e->conn_type = val;
527 else if (!strcmp(name, "port_id"))
528 e->port_id = val;
529 else if (!strcmp(name, "support_hdcp"))
530 e->support_hdcp = val;
531 else if (!strcmp(name, "support_ai"))
532 e->support_ai = val;
533 else if (!strcmp(name, "audio_sync_delay"))
534 e->aud_synch_delay = val;
535 else if (!strcmp(name, "speakers"))
536 e->spk_alloc = val;
537 else if (!strcmp(name, "sad_count"))
538 e->sad_count = val;
539 else if (!strncmp(name, "sad", 3)) {
540 sname = name + 4;
541 n = name[3] - '0';
542 if (name[4] >= '0' && name[4] <= '9') {
543 sname++;
544 n = 10 * n + name[4] - '0';
545 }
546 if (n >= ELD_MAX_SAD)
547 continue;
548 if (!strcmp(sname, "_coding_type"))
549 e->sad[n].format = val;
550 else if (!strcmp(sname, "_channels"))
551 e->sad[n].channels = val;
552 else if (!strcmp(sname, "_rates"))
553 e->sad[n].rates = val;
554 else if (!strcmp(sname, "_bits"))
555 e->sad[n].sample_bits = val;
556 else if (!strcmp(sname, "_max_bitrate"))
557 e->sad[n].max_bitrate = val;
558 else if (!strcmp(sname, "_profile"))
559 e->sad[n].profile = val;
560 if (n >= e->sad_count)
561 e->sad_count = n + 1;
562 }
563 }
564}
565
566
567int snd_hda_eld_proc_new(struct hda_codec *codec, struct hdmi_eld *eld,
568 int index)
569{
570 char name[32];
571 struct snd_info_entry *entry;
572 int err;
573
574 snprintf(name, sizeof(name), "eld#%d.%d", codec->addr, index);
575 err = snd_card_proc_new(codec->bus->card, name, &entry);
576 if (err < 0)
577 return err;
578
579 snd_info_set_text_ops(entry, eld, hdmi_print_eld_info);
580 entry->c.text.write = hdmi_write_eld_info;
581 entry->mode |= S_IWUSR;
582 eld->proc_entry = entry;
583
584 return 0;
585}
586
587void snd_hda_eld_proc_free(struct hda_codec *codec, struct hdmi_eld *eld)
588{
589 if (!codec->bus->shutdown && eld->proc_entry) {
590 snd_device_free(codec->bus->card, eld->proc_entry);
591 eld->proc_entry = NULL;
592 }
593}
594
595#endif
596
597
598void hdmi_eld_update_pcm_info(struct hdmi_eld *eld, struct hda_pcm_stream *pcm,
599 struct hda_pcm_stream *codec_pars)
600{
601 int i;
602
603
604
605
606 pcm->rates = SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000;
607 pcm->formats = SNDRV_PCM_FMTBIT_S16_LE;
608 pcm->maxbps = 16;
609 pcm->channels_max = 2;
610 for (i = 0; i < eld->sad_count; i++) {
611 struct cea_sad *a = &eld->sad[i];
612 pcm->rates |= a->rates;
613 if (a->channels > pcm->channels_max)
614 pcm->channels_max = a->channels;
615 if (a->format == AUDIO_CODING_TYPE_LPCM) {
616 if (a->sample_bits & AC_SUPPCM_BITS_20) {
617 pcm->formats |= SNDRV_PCM_FMTBIT_S32_LE;
618 if (pcm->maxbps < 20)
619 pcm->maxbps = 20;
620 }
621 if (a->sample_bits & AC_SUPPCM_BITS_24) {
622 pcm->formats |= SNDRV_PCM_FMTBIT_S32_LE;
623 if (pcm->maxbps < 24)
624 pcm->maxbps = 24;
625 }
626 }
627 }
628
629 if (!codec_pars)
630 return;
631
632
633 pcm->rates &= codec_pars->rates;
634 pcm->formats &= codec_pars->formats;
635 pcm->channels_max = min(pcm->channels_max, codec_pars->channels_max);
636 pcm->maxbps = min(pcm->maxbps, codec_pars->maxbps);
637}
638
