1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26#include <linux/hdmi.h>
27#include <drm/drmP.h>
28#include <drm/radeon_drm.h>
29#include "radeon.h"
30#include "radeon_asic.h"
31#include "r600d.h"
32#include "atom.h"
33
34
35
36
37enum r600_hdmi_color_format {
38 RGB = 0,
39 YCC_422 = 1,
40 YCC_444 = 2
41};
42
43
44
45
46enum r600_hdmi_iec_status_bits {
47 AUDIO_STATUS_DIG_ENABLE = 0x01,
48 AUDIO_STATUS_V = 0x02,
49 AUDIO_STATUS_VCFG = 0x04,
50 AUDIO_STATUS_EMPHASIS = 0x08,
51 AUDIO_STATUS_COPYRIGHT = 0x10,
52 AUDIO_STATUS_NONAUDIO = 0x20,
53 AUDIO_STATUS_PROFESSIONAL = 0x40,
54 AUDIO_STATUS_LEVEL = 0x80
55};
56
57static const struct radeon_hdmi_acr r600_hdmi_predefined_acr[] = {
58
59
60 { 25175, 4576, 28125, 7007, 31250, 6864, 28125 },
61 { 25200, 4096, 25200, 6272, 28000, 6144, 25200 },
62 { 27000, 4096, 27000, 6272, 30000, 6144, 27000 },
63 { 27027, 4096, 27027, 6272, 30030, 6144, 27027 },
64 { 54000, 4096, 54000, 6272, 60000, 6144, 54000 },
65 { 54054, 4096, 54054, 6272, 60060, 6144, 54054 },
66 { 74176, 11648, 210937, 17836, 234375, 11648, 140625 },
67 { 74250, 4096, 74250, 6272, 82500, 6144, 74250 },
68 { 148352, 11648, 421875, 8918, 234375, 5824, 140625 },
69 { 148500, 4096, 148500, 6272, 165000, 6144, 148500 },
70 { 0, 4096, 0, 6272, 0, 6144, 0 }
71};
72
73
74
75
76static void r600_hdmi_calc_cts(uint32_t clock, int *CTS, int N, int freq)
77{
78 u64 n;
79 u32 d;
80
81 if (*CTS == 0) {
82 n = (u64)clock * (u64)N * 1000ULL;
83 d = 128 * freq;
84 do_div(n, d);
85 *CTS = n;
86 }
87 DRM_DEBUG("Using ACR timing N=%d CTS=%d for frequency %d\n",
88 N, *CTS, freq);
89}
90
91struct radeon_hdmi_acr r600_hdmi_acr(uint32_t clock)
92{
93 struct radeon_hdmi_acr res;
94 u8 i;
95
96 for (i = 0; r600_hdmi_predefined_acr[i].clock != clock &&
97 r600_hdmi_predefined_acr[i].clock != 0; i++)
98 ;
99 res = r600_hdmi_predefined_acr[i];
100
101
102 r600_hdmi_calc_cts(clock, &res.cts_32khz, res.n_32khz, 32000);
103 r600_hdmi_calc_cts(clock, &res.cts_44_1khz, res.n_44_1khz, 44100);
104 r600_hdmi_calc_cts(clock, &res.cts_48khz, res.n_48khz, 48000);
105
106 return res;
107}
108
109
110
111
112static void r600_hdmi_update_ACR(struct drm_encoder *encoder, uint32_t clock)
113{
114 struct drm_device *dev = encoder->dev;
115 struct radeon_device *rdev = dev->dev_private;
116 struct radeon_hdmi_acr acr = r600_hdmi_acr(clock);
117 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
118 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
119 uint32_t offset = dig->afmt->offset;
120
121 WREG32(HDMI0_ACR_32_0 + offset, HDMI0_ACR_CTS_32(acr.cts_32khz));
122 WREG32(HDMI0_ACR_32_1 + offset, acr.n_32khz);
123
124 WREG32(HDMI0_ACR_44_0 + offset, HDMI0_ACR_CTS_44(acr.cts_44_1khz));
125 WREG32(HDMI0_ACR_44_1 + offset, acr.n_44_1khz);
126
127 WREG32(HDMI0_ACR_48_0 + offset, HDMI0_ACR_CTS_48(acr.cts_48khz));
128 WREG32(HDMI0_ACR_48_1 + offset, acr.n_48khz);
129}
130
131
132
133
134static void r600_hdmi_update_avi_infoframe(struct drm_encoder *encoder,
135 void *buffer, size_t size)
136{
137 struct drm_device *dev = encoder->dev;
138 struct radeon_device *rdev = dev->dev_private;
139 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
140 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
141 uint32_t offset = dig->afmt->offset;
142 uint8_t *frame = buffer + 3;
143 uint8_t *header = buffer;
144
145 WREG32(HDMI0_AVI_INFO0 + offset,
146 frame[0x0] | (frame[0x1] << 8) | (frame[0x2] << 16) | (frame[0x3] << 24));
147 WREG32(HDMI0_AVI_INFO1 + offset,
148 frame[0x4] | (frame[0x5] << 8) | (frame[0x6] << 16) | (frame[0x7] << 24));
149 WREG32(HDMI0_AVI_INFO2 + offset,
150 frame[0x8] | (frame[0x9] << 8) | (frame[0xA] << 16) | (frame[0xB] << 24));
151 WREG32(HDMI0_AVI_INFO3 + offset,
152 frame[0xC] | (frame[0xD] << 8) | (header[1] << 24));
153}
154
155
156
157
158static void r600_hdmi_update_audio_infoframe(struct drm_encoder *encoder,
159 const void *buffer, size_t size)
160{
161 struct drm_device *dev = encoder->dev;
162 struct radeon_device *rdev = dev->dev_private;
163 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
164 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
165 uint32_t offset = dig->afmt->offset;
166 const u8 *frame = buffer + 3;
167
168 WREG32(HDMI0_AUDIO_INFO0 + offset,
169 frame[0x0] | (frame[0x1] << 8) | (frame[0x2] << 16) | (frame[0x3] << 24));
170 WREG32(HDMI0_AUDIO_INFO1 + offset,
171 frame[0x4] | (frame[0x5] << 8) | (frame[0x6] << 16) | (frame[0x8] << 24));
172}
173
174
175
176
177static bool r600_hdmi_is_audio_buffer_filled(struct drm_encoder *encoder)
178{
179 struct drm_device *dev = encoder->dev;
180 struct radeon_device *rdev = dev->dev_private;
181 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
182 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
183 uint32_t offset = dig->afmt->offset;
184
185 return (RREG32(HDMI0_STATUS + offset) & 0x10) != 0;
186}
187
188
189
190
191int r600_hdmi_buffer_status_changed(struct drm_encoder *encoder)
192{
193 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
194 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
195 int status, result;
196
197 if (!dig->afmt || !dig->afmt->enabled)
198 return 0;
199
200 status = r600_hdmi_is_audio_buffer_filled(encoder);
201 result = dig->afmt->last_buffer_filled_status != status;
202 dig->afmt->last_buffer_filled_status = status;
203
204 return result;
205}
206
207
208
209
210static void r600_hdmi_audio_workaround(struct drm_encoder *encoder)
211{
212 struct drm_device *dev = encoder->dev;
213 struct radeon_device *rdev = dev->dev_private;
214 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
215 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
216 uint32_t offset = dig->afmt->offset;
217 bool hdmi_audio_workaround = false;
218 u32 value;
219
220 if (!hdmi_audio_workaround ||
221 r600_hdmi_is_audio_buffer_filled(encoder))
222 value = 0;
223 else
224 value = HDMI0_AUDIO_TEST_EN;
225 WREG32_P(HDMI0_AUDIO_PACKET_CONTROL + offset,
226 value, ~HDMI0_AUDIO_TEST_EN);
227}
228
229void r600_audio_set_dto(struct drm_encoder *encoder, u32 clock)
230{
231 struct drm_device *dev = encoder->dev;
232 struct radeon_device *rdev = dev->dev_private;
233 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
234 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
235 u32 base_rate = 24000;
236 u32 max_ratio = clock / base_rate;
237 u32 dto_phase;
238 u32 dto_modulo = clock;
239 u32 wallclock_ratio;
240 u32 dto_cntl;
241
242 if (!dig || !dig->afmt)
243 return;
244
245 if (max_ratio >= 8) {
246 dto_phase = 192 * 1000;
247 wallclock_ratio = 3;
248 } else if (max_ratio >= 4) {
249 dto_phase = 96 * 1000;
250 wallclock_ratio = 2;
251 } else if (max_ratio >= 2) {
252 dto_phase = 48 * 1000;
253 wallclock_ratio = 1;
254 } else {
255 dto_phase = 24 * 1000;
256 wallclock_ratio = 0;
257 }
258
259
260
261
262
263
264
265
266
267 if (ASIC_IS_DCE32(rdev)) {
268 if (dig->dig_encoder == 0) {
269 dto_cntl = RREG32(DCCG_AUDIO_DTO0_CNTL) & ~DCCG_AUDIO_DTO_WALLCLOCK_RATIO_MASK;
270 dto_cntl |= DCCG_AUDIO_DTO_WALLCLOCK_RATIO(wallclock_ratio);
271 WREG32(DCCG_AUDIO_DTO0_CNTL, dto_cntl);
272 WREG32(DCCG_AUDIO_DTO0_PHASE, dto_phase);
273 WREG32(DCCG_AUDIO_DTO0_MODULE, dto_modulo);
274 WREG32(DCCG_AUDIO_DTO_SELECT, 0);
275 } else {
276 dto_cntl = RREG32(DCCG_AUDIO_DTO1_CNTL) & ~DCCG_AUDIO_DTO_WALLCLOCK_RATIO_MASK;
277 dto_cntl |= DCCG_AUDIO_DTO_WALLCLOCK_RATIO(wallclock_ratio);
278 WREG32(DCCG_AUDIO_DTO1_CNTL, dto_cntl);
279 WREG32(DCCG_AUDIO_DTO1_PHASE, dto_phase);
280 WREG32(DCCG_AUDIO_DTO1_MODULE, dto_modulo);
281 WREG32(DCCG_AUDIO_DTO_SELECT, 1);
282 }
283 } else if (ASIC_IS_DCE3(rdev)) {
284
285
286
287 if (dig->dig_encoder == 0) {
288 WREG32(DCCG_AUDIO_DTO0_PHASE, base_rate * 100);
289 WREG32(DCCG_AUDIO_DTO0_MODULE, clock * 100);
290 WREG32(DCCG_AUDIO_DTO_SELECT, 0);
291 } else {
292 WREG32(DCCG_AUDIO_DTO1_PHASE, base_rate * 100);
293 WREG32(DCCG_AUDIO_DTO1_MODULE, clock * 100);
294 WREG32(DCCG_AUDIO_DTO_SELECT, 1);
295 }
296 } else {
297
298 WREG32(AUDIO_DTO, AUDIO_DTO_PHASE(base_rate / 10) |
299 AUDIO_DTO_MODULE(clock / 10));
300 }
301}
302
303static void dce3_2_afmt_write_speaker_allocation(struct drm_encoder *encoder)
304{
305 struct radeon_device *rdev = encoder->dev->dev_private;
306 struct drm_connector *connector;
307 struct radeon_connector *radeon_connector = NULL;
308 u32 tmp;
309 u8 *sadb;
310 int sad_count;
311
312
313 return;
314
315 list_for_each_entry(connector, &encoder->dev->mode_config.connector_list, head) {
316 if (connector->encoder == encoder)
317 radeon_connector = to_radeon_connector(connector);
318 }
319
320 if (!radeon_connector) {
321 DRM_ERROR("Couldn't find encoder's connector\n");
322 return;
323 }
324
325 sad_count = drm_edid_to_speaker_allocation(radeon_connector->edid, &sadb);
326 if (sad_count < 0) {
327 DRM_ERROR("Couldn't read Speaker Allocation Data Block: %d\n", sad_count);
328 return;
329 }
330
331
332 tmp = RREG32(AZ_F0_CODEC_PIN0_CONTROL_CHANNEL_SPEAKER);
333 tmp &= ~(DP_CONNECTION | SPEAKER_ALLOCATION_MASK);
334
335 tmp |= HDMI_CONNECTION;
336 if (sad_count)
337 tmp |= SPEAKER_ALLOCATION(sadb[0]);
338 else
339 tmp |= SPEAKER_ALLOCATION(5);
340 WREG32(AZ_F0_CODEC_PIN0_CONTROL_CHANNEL_SPEAKER, tmp);
341
342 kfree(sadb);
343}
344
345static void dce3_2_afmt_write_sad_regs(struct drm_encoder *encoder)
346{
347 struct radeon_device *rdev = encoder->dev->dev_private;
348 struct drm_connector *connector;
349 struct radeon_connector *radeon_connector = NULL;
350 struct cea_sad *sads;
351 int i, sad_count;
352
353 static const u16 eld_reg_to_type[][2] = {
354 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR0, HDMI_AUDIO_CODING_TYPE_PCM },
355 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR1, HDMI_AUDIO_CODING_TYPE_AC3 },
356 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR2, HDMI_AUDIO_CODING_TYPE_MPEG1 },
357 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR3, HDMI_AUDIO_CODING_TYPE_MP3 },
358 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR4, HDMI_AUDIO_CODING_TYPE_MPEG2 },
359 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR5, HDMI_AUDIO_CODING_TYPE_AAC_LC },
360 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR6, HDMI_AUDIO_CODING_TYPE_DTS },
361 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR7, HDMI_AUDIO_CODING_TYPE_ATRAC },
362 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR9, HDMI_AUDIO_CODING_TYPE_EAC3 },
363 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR10, HDMI_AUDIO_CODING_TYPE_DTS_HD },
364 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR11, HDMI_AUDIO_CODING_TYPE_MLP },
365 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR13, HDMI_AUDIO_CODING_TYPE_WMA_PRO },
366 };
367
368 list_for_each_entry(connector, &encoder->dev->mode_config.connector_list, head) {
369 if (connector->encoder == encoder)
370 radeon_connector = to_radeon_connector(connector);
371 }
372
373 if (!radeon_connector) {
374 DRM_ERROR("Couldn't find encoder's connector\n");
375 return;
376 }
377
378 sad_count = drm_edid_to_sad(radeon_connector->edid, &sads);
379 if (sad_count < 0) {
380 DRM_ERROR("Couldn't read SADs: %d\n", sad_count);
381 return;
382 }
383 BUG_ON(!sads);
384
385 for (i = 0; i < ARRAY_SIZE(eld_reg_to_type); i++) {
386 u32 value = 0;
387 int j;
388
389 for (j = 0; j < sad_count; j++) {
390 struct cea_sad *sad = &sads[j];
391
392 if (sad->format == eld_reg_to_type[i][1]) {
393 value = MAX_CHANNELS(sad->channels) |
394 DESCRIPTOR_BYTE_2(sad->byte2) |
395 SUPPORTED_FREQUENCIES(sad->freq);
396 if (sad->format == HDMI_AUDIO_CODING_TYPE_PCM)
397 value |= SUPPORTED_FREQUENCIES_STEREO(sad->freq);
398 break;
399 }
400 }
401 WREG32(eld_reg_to_type[i][0], value);
402 }
403
404 kfree(sads);
405}
406
407
408
409
410void r600_hdmi_setmode(struct drm_encoder *encoder, struct drm_display_mode *mode)
411{
412 struct drm_device *dev = encoder->dev;
413 struct radeon_device *rdev = dev->dev_private;
414 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
415 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
416 u8 buffer[HDMI_INFOFRAME_HEADER_SIZE + HDMI_AVI_INFOFRAME_SIZE];
417 struct hdmi_avi_infoframe frame;
418 uint32_t offset;
419 ssize_t err;
420
421 if (!dig || !dig->afmt)
422 return;
423
424
425 if (!dig->afmt->enabled)
426 return;
427 offset = dig->afmt->offset;
428
429 r600_audio_set_dto(encoder, mode->clock);
430
431 WREG32(HDMI0_VBI_PACKET_CONTROL + offset,
432 HDMI0_NULL_SEND);
433
434 WREG32(HDMI0_AUDIO_CRC_CONTROL + offset, 0x1000);
435
436 if (ASIC_IS_DCE32(rdev)) {
437 WREG32(HDMI0_AUDIO_PACKET_CONTROL + offset,
438 HDMI0_AUDIO_DELAY_EN(1) |
439 HDMI0_AUDIO_PACKETS_PER_LINE(3));
440 WREG32(AFMT_AUDIO_PACKET_CONTROL + offset,
441 AFMT_AUDIO_SAMPLE_SEND |
442 AFMT_60958_CS_UPDATE);
443 } else {
444 WREG32(HDMI0_AUDIO_PACKET_CONTROL + offset,
445 HDMI0_AUDIO_SAMPLE_SEND |
446 HDMI0_AUDIO_DELAY_EN(1) |
447 HDMI0_AUDIO_PACKETS_PER_LINE(3) |
448 HDMI0_60958_CS_UPDATE);
449 }
450
451 if (ASIC_IS_DCE32(rdev)) {
452 dce3_2_afmt_write_speaker_allocation(encoder);
453 dce3_2_afmt_write_sad_regs(encoder);
454 }
455
456 WREG32(HDMI0_ACR_PACKET_CONTROL + offset,
457 HDMI0_ACR_SOURCE |
458 HDMI0_ACR_AUTO_SEND);
459
460 WREG32(HDMI0_VBI_PACKET_CONTROL + offset,
461 HDMI0_NULL_SEND |
462 HDMI0_GC_SEND |
463 HDMI0_GC_CONT);
464
465
466 WREG32(HDMI0_INFOFRAME_CONTROL0 + offset,
467 HDMI0_AVI_INFO_SEND |
468 HDMI0_AVI_INFO_CONT |
469 HDMI0_AUDIO_INFO_SEND |
470 HDMI0_AUDIO_INFO_CONT);
471
472 WREG32(HDMI0_INFOFRAME_CONTROL1 + offset,
473 HDMI0_AVI_INFO_LINE(2) |
474 HDMI0_AUDIO_INFO_LINE(2));
475
476 WREG32(HDMI0_GC + offset, 0);
477
478 err = drm_hdmi_avi_infoframe_from_display_mode(&frame, mode);
479 if (err < 0) {
480 DRM_ERROR("failed to setup AVI infoframe: %zd\n", err);
481 return;
482 }
483
484 err = hdmi_avi_infoframe_pack(&frame, buffer, sizeof(buffer));
485 if (err < 0) {
486 DRM_ERROR("failed to pack AVI infoframe: %zd\n", err);
487 return;
488 }
489
490 r600_hdmi_update_avi_infoframe(encoder, buffer, sizeof(buffer));
491 r600_hdmi_update_ACR(encoder, mode->clock);
492
493
494 WREG32(HDMI0_RAMP_CONTROL0 + offset, 0x00FFFFFF);
495 WREG32(HDMI0_RAMP_CONTROL1 + offset, 0x007FFFFF);
496 WREG32(HDMI0_RAMP_CONTROL2 + offset, 0x00000001);
497 WREG32(HDMI0_RAMP_CONTROL3 + offset, 0x00000001);
498
499 r600_hdmi_audio_workaround(encoder);
500}
501
502
503
504
505void r600_hdmi_update_audio_settings(struct drm_encoder *encoder)
506{
507 struct drm_device *dev = encoder->dev;
508 struct radeon_device *rdev = dev->dev_private;
509 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
510 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
511 struct r600_audio_pin audio = r600_audio_status(rdev);
512 uint8_t buffer[HDMI_INFOFRAME_HEADER_SIZE + HDMI_AUDIO_INFOFRAME_SIZE];
513 struct hdmi_audio_infoframe frame;
514 uint32_t offset;
515 uint32_t iec;
516 ssize_t err;
517
518 if (!dig->afmt || !dig->afmt->enabled)
519 return;
520 offset = dig->afmt->offset;
521
522 DRM_DEBUG("%s with %d channels, %d Hz sampling rate, %d bits per sample,\n",
523 r600_hdmi_is_audio_buffer_filled(encoder) ? "playing" : "stopped",
524 audio.channels, audio.rate, audio.bits_per_sample);
525 DRM_DEBUG("0x%02X IEC60958 status bits and 0x%02X category code\n",
526 (int)audio.status_bits, (int)audio.category_code);
527
528 iec = 0;
529 if (audio.status_bits & AUDIO_STATUS_PROFESSIONAL)
530 iec |= 1 << 0;
531 if (audio.status_bits & AUDIO_STATUS_NONAUDIO)
532 iec |= 1 << 1;
533 if (audio.status_bits & AUDIO_STATUS_COPYRIGHT)
534 iec |= 1 << 2;
535 if (audio.status_bits & AUDIO_STATUS_EMPHASIS)
536 iec |= 1 << 3;
537
538 iec |= HDMI0_60958_CS_CATEGORY_CODE(audio.category_code);
539
540 switch (audio.rate) {
541 case 32000:
542 iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0x3);
543 break;
544 case 44100:
545 iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0x0);
546 break;
547 case 48000:
548 iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0x2);
549 break;
550 case 88200:
551 iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0x8);
552 break;
553 case 96000:
554 iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0xa);
555 break;
556 case 176400:
557 iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0xc);
558 break;
559 case 192000:
560 iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0xe);
561 break;
562 }
563
564 WREG32(HDMI0_60958_0 + offset, iec);
565
566 iec = 0;
567 switch (audio.bits_per_sample) {
568 case 16:
569 iec |= HDMI0_60958_CS_WORD_LENGTH(0x2);
570 break;
571 case 20:
572 iec |= HDMI0_60958_CS_WORD_LENGTH(0x3);
573 break;
574 case 24:
575 iec |= HDMI0_60958_CS_WORD_LENGTH(0xb);
576 break;
577 }
578 if (audio.status_bits & AUDIO_STATUS_V)
579 iec |= 0x5 << 16;
580 WREG32_P(HDMI0_60958_1 + offset, iec, ~0x5000f);
581
582 err = hdmi_audio_infoframe_init(&frame);
583 if (err < 0) {
584 DRM_ERROR("failed to setup audio infoframe\n");
585 return;
586 }
587
588 frame.channels = audio.channels;
589
590 err = hdmi_audio_infoframe_pack(&frame, buffer, sizeof(buffer));
591 if (err < 0) {
592 DRM_ERROR("failed to pack audio infoframe\n");
593 return;
594 }
595
596 r600_hdmi_update_audio_infoframe(encoder, buffer, sizeof(buffer));
597 r600_hdmi_audio_workaround(encoder);
598}
599
600
601
602
603void r600_hdmi_enable(struct drm_encoder *encoder, bool enable)
604{
605 struct drm_device *dev = encoder->dev;
606 struct radeon_device *rdev = dev->dev_private;
607 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
608 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
609 u32 hdmi = HDMI0_ERROR_ACK;
610
611 if (!dig || !dig->afmt)
612 return;
613
614
615 if (enable && dig->afmt->enabled)
616 return;
617 if (!enable && !dig->afmt->enabled)
618 return;
619
620 if (enable)
621 dig->afmt->pin = r600_audio_get_pin(rdev);
622 else
623 dig->afmt->pin = NULL;
624
625
626 if (!ASIC_IS_DCE3(rdev)) {
627 if (enable)
628 hdmi |= HDMI0_ENABLE;
629 switch (radeon_encoder->encoder_id) {
630 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_TMDS1:
631 if (enable) {
632 WREG32_OR(AVIVO_TMDSA_CNTL, AVIVO_TMDSA_CNTL_HDMI_EN);
633 hdmi |= HDMI0_STREAM(HDMI0_STREAM_TMDSA);
634 } else {
635 WREG32_AND(AVIVO_TMDSA_CNTL, ~AVIVO_TMDSA_CNTL_HDMI_EN);
636 }
637 break;
638 case ENCODER_OBJECT_ID_INTERNAL_LVTM1:
639 if (enable) {
640 WREG32_OR(AVIVO_LVTMA_CNTL, AVIVO_LVTMA_CNTL_HDMI_EN);
641 hdmi |= HDMI0_STREAM(HDMI0_STREAM_LVTMA);
642 } else {
643 WREG32_AND(AVIVO_LVTMA_CNTL, ~AVIVO_LVTMA_CNTL_HDMI_EN);
644 }
645 break;
646 case ENCODER_OBJECT_ID_INTERNAL_DDI:
647 if (enable) {
648 WREG32_OR(DDIA_CNTL, DDIA_HDMI_EN);
649 hdmi |= HDMI0_STREAM(HDMI0_STREAM_DDIA);
650 } else {
651 WREG32_AND(DDIA_CNTL, ~DDIA_HDMI_EN);
652 }
653 break;
654 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DVO1:
655 if (enable)
656 hdmi |= HDMI0_STREAM(HDMI0_STREAM_DVOA);
657 break;
658 default:
659 dev_err(rdev->dev, "Invalid encoder for HDMI: 0x%X\n",
660 radeon_encoder->encoder_id);
661 break;
662 }
663 WREG32(HDMI0_CONTROL + dig->afmt->offset, hdmi);
664 }
665
666 if (rdev->irq.installed) {
667
668
669 if (enable)
670 radeon_irq_kms_enable_afmt(rdev, dig->afmt->id);
671 else
672 radeon_irq_kms_disable_afmt(rdev, dig->afmt->id);
673 }
674
675 dig->afmt->enabled = enable;
676
677 DRM_DEBUG("%sabling HDMI interface @ 0x%04X for encoder 0x%x\n",
678 enable ? "En" : "Dis", dig->afmt->offset, radeon_encoder->encoder_id);
679}
680
681