]> Pileus Git - ~andy/linux/blob - drivers/gpu/drm/radeon/r600_hdmi.c
Merge tag 'drm-intel-fixes-2013-11-07' of git://people.freedesktop.org/~danvet/drm...
[~andy/linux] / drivers / gpu / drm / radeon / r600_hdmi.c
1 /*
2  * Copyright 2008 Advanced Micro Devices, Inc.
3  * Copyright 2008 Red Hat Inc.
4  * Copyright 2009 Christian König.
5  *
6  * Permission is hereby granted, free of charge, to any person obtaining a
7  * copy of this software and associated documentation files (the "Software"),
8  * to deal in the Software without restriction, including without limitation
9  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
10  * and/or sell copies of the Software, and to permit persons to whom the
11  * Software is furnished to do so, subject to the following conditions:
12  *
13  * The above copyright notice and this permission notice shall be included in
14  * all copies or substantial portions of the Software.
15  *
16  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
19  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
20  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
21  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
22  * OTHER DEALINGS IN THE SOFTWARE.
23  *
24  * Authors: Christian König
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  * HDMI color format
36  */
37 enum r600_hdmi_color_format {
38         RGB = 0,
39         YCC_422 = 1,
40         YCC_444 = 2
41 };
42
43 /*
44  * IEC60958 status bits
45  */
46 enum 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
57 static const struct radeon_hdmi_acr r600_hdmi_predefined_acr[] = {
58     /*       32kHz        44.1kHz       48kHz    */
59     /* Clock      N     CTS      N     CTS      N     CTS */
60     {  25175,  4576,  28125,  7007,  31250,  6864,  28125 }, /*  25,20/1.001 MHz */
61     {  25200,  4096,  25200,  6272,  28000,  6144,  25200 }, /*  25.20       MHz */
62     {  27000,  4096,  27000,  6272,  30000,  6144,  27000 }, /*  27.00       MHz */
63     {  27027,  4096,  27027,  6272,  30030,  6144,  27027 }, /*  27.00*1.001 MHz */
64     {  54000,  4096,  54000,  6272,  60000,  6144,  54000 }, /*  54.00       MHz */
65     {  54054,  4096,  54054,  6272,  60060,  6144,  54054 }, /*  54.00*1.001 MHz */
66     {  74176, 11648, 210937, 17836, 234375, 11648, 140625 }, /*  74.25/1.001 MHz */
67     {  74250,  4096,  74250,  6272,  82500,  6144,  74250 }, /*  74.25       MHz */
68     { 148352, 11648, 421875,  8918, 234375,  5824, 140625 }, /* 148.50/1.001 MHz */
69     { 148500,  4096, 148500,  6272, 165000,  6144, 148500 }, /* 148.50       MHz */
70     {      0,  4096,      0,  6272,      0,  6144,      0 }  /* Other */
71 };
72
73 /*
74  * calculate CTS value if it's not found in the table
75  */
76 static 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
91 struct 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         /* In case some CTS are missing */
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  * update the N and CTS parameters for a given pixel clock rate
111  */
112 static 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  * build a HDMI Video Info Frame
133  */
134 static 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  * build a Audio Info Frame
157  */
158 static 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  * test if audio buffer is filled enough to start playing
176  */
177 static 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  * have buffer status changed since last call?
190  */
191 int 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  * write the audio workaround status to the hardware
209  */
210 static 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; /* FIXME */
218         u32 value;
219
220         if (!hdmi_audio_workaround ||
221             r600_hdmi_is_audio_buffer_filled(encoder))
222                 value = 0; /* disable workaround */
223         else
224                 value = HDMI0_AUDIO_TEST_EN; /* enable workaround */
225         WREG32_P(HDMI0_AUDIO_PACKET_CONTROL + offset,
226                  value, ~HDMI0_AUDIO_TEST_EN);
227 }
228
229 void 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         /* there are two DTOs selected by DCCG_AUDIO_DTO_SELECT.
260          * doesn't matter which one you use.  Just use the first one.
261          */
262         /* XXX two dtos; generally use dto0 for hdmi */
263         /* Express [24MHz / target pixel clock] as an exact rational
264          * number (coefficient of two integer numbers.  DCCG_AUDIO_DTOx_PHASE
265          * is the numerator, DCCG_AUDIO_DTOx_MODULE is the denominator
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); /* select DTO0 */
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); /* select DTO1 */
282                 }
283         } else if (ASIC_IS_DCE3(rdev)) {
284                 /* according to the reg specs, this should DCE3.2 only, but in
285                  * practice it seems to cover DCE3.0/3.1 as well.
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); /* select DTO0 */
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); /* select DTO1 */
295                 }
296         } else {
297                 /* according to the reg specs, this should be DCE2.0 and DCE3.0/3.1 */
298                 WREG32(AUDIO_DTO, AUDIO_DTO_PHASE(base_rate / 10) |
299                        AUDIO_DTO_MODULE(clock / 10));
300         }
301 }
302
303 static 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         /* XXX: setting this register causes hangs on some asics */
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                         break;
319                 }
320         }
321
322         if (!radeon_connector) {
323                 DRM_ERROR("Couldn't find encoder's connector\n");
324                 return;
325         }
326
327         sad_count = drm_edid_to_speaker_allocation(radeon_connector->edid, &sadb);
328         if (sad_count < 0) {
329                 DRM_ERROR("Couldn't read Speaker Allocation Data Block: %d\n", sad_count);
330                 return;
331         }
332
333         /* program the speaker allocation */
334         tmp = RREG32(AZ_F0_CODEC_PIN0_CONTROL_CHANNEL_SPEAKER);
335         tmp &= ~(DP_CONNECTION | SPEAKER_ALLOCATION_MASK);
336         /* set HDMI mode */
337         tmp |= HDMI_CONNECTION;
338         if (sad_count)
339                 tmp |= SPEAKER_ALLOCATION(sadb[0]);
340         else
341                 tmp |= SPEAKER_ALLOCATION(5); /* stereo */
342         WREG32(AZ_F0_CODEC_PIN0_CONTROL_CHANNEL_SPEAKER, tmp);
343
344         kfree(sadb);
345 }
346
347 static void dce3_2_afmt_write_sad_regs(struct drm_encoder *encoder)
348 {
349         struct radeon_device *rdev = encoder->dev->dev_private;
350         struct drm_connector *connector;
351         struct radeon_connector *radeon_connector = NULL;
352         struct cea_sad *sads;
353         int i, sad_count;
354
355         static const u16 eld_reg_to_type[][2] = {
356                 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR0, HDMI_AUDIO_CODING_TYPE_PCM },
357                 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR1, HDMI_AUDIO_CODING_TYPE_AC3 },
358                 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR2, HDMI_AUDIO_CODING_TYPE_MPEG1 },
359                 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR3, HDMI_AUDIO_CODING_TYPE_MP3 },
360                 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR4, HDMI_AUDIO_CODING_TYPE_MPEG2 },
361                 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR5, HDMI_AUDIO_CODING_TYPE_AAC_LC },
362                 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR6, HDMI_AUDIO_CODING_TYPE_DTS },
363                 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR7, HDMI_AUDIO_CODING_TYPE_ATRAC },
364                 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR9, HDMI_AUDIO_CODING_TYPE_EAC3 },
365                 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR10, HDMI_AUDIO_CODING_TYPE_DTS_HD },
366                 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR11, HDMI_AUDIO_CODING_TYPE_MLP },
367                 { AZ_F0_CODEC_PIN0_CONTROL_AUDIO_DESCRIPTOR13, HDMI_AUDIO_CODING_TYPE_WMA_PRO },
368         };
369
370         list_for_each_entry(connector, &encoder->dev->mode_config.connector_list, head) {
371                 if (connector->encoder == encoder) {
372                         radeon_connector = to_radeon_connector(connector);
373                         break;
374                 }
375         }
376
377         if (!radeon_connector) {
378                 DRM_ERROR("Couldn't find encoder's connector\n");
379                 return;
380         }
381
382         sad_count = drm_edid_to_sad(radeon_connector->edid, &sads);
383         if (sad_count < 0) {
384                 DRM_ERROR("Couldn't read SADs: %d\n", sad_count);
385                 return;
386         }
387         BUG_ON(!sads);
388
389         for (i = 0; i < ARRAY_SIZE(eld_reg_to_type); i++) {
390                 u32 value = 0;
391                 int j;
392
393                 for (j = 0; j < sad_count; j++) {
394                         struct cea_sad *sad = &sads[j];
395
396                         if (sad->format == eld_reg_to_type[i][1]) {
397                                 value = MAX_CHANNELS(sad->channels) |
398                                         DESCRIPTOR_BYTE_2(sad->byte2) |
399                                         SUPPORTED_FREQUENCIES(sad->freq);
400                                 if (sad->format == HDMI_AUDIO_CODING_TYPE_PCM)
401                                         value |= SUPPORTED_FREQUENCIES_STEREO(sad->freq);
402                                 break;
403                         }
404                 }
405                 WREG32(eld_reg_to_type[i][0], value);
406         }
407
408         kfree(sads);
409 }
410
411 /*
412  * update the info frames with the data from the current display mode
413  */
414 void r600_hdmi_setmode(struct drm_encoder *encoder, struct drm_display_mode *mode)
415 {
416         struct drm_device *dev = encoder->dev;
417         struct radeon_device *rdev = dev->dev_private;
418         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
419         struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
420         u8 buffer[HDMI_INFOFRAME_HEADER_SIZE + HDMI_AVI_INFOFRAME_SIZE];
421         struct hdmi_avi_infoframe frame;
422         uint32_t offset;
423         ssize_t err;
424
425         if (!dig || !dig->afmt)
426                 return;
427
428         /* Silent, r600_hdmi_enable will raise WARN for us */
429         if (!dig->afmt->enabled)
430                 return;
431         offset = dig->afmt->offset;
432
433         r600_audio_set_dto(encoder, mode->clock);
434
435         WREG32(HDMI0_VBI_PACKET_CONTROL + offset,
436                HDMI0_NULL_SEND); /* send null packets when required */
437
438         WREG32(HDMI0_AUDIO_CRC_CONTROL + offset, 0x1000);
439
440         if (ASIC_IS_DCE32(rdev)) {
441                 WREG32(HDMI0_AUDIO_PACKET_CONTROL + offset,
442                        HDMI0_AUDIO_DELAY_EN(1) | /* default audio delay */
443                        HDMI0_AUDIO_PACKETS_PER_LINE(3)); /* should be suffient for all audio modes and small enough for all hblanks */
444                 WREG32(AFMT_AUDIO_PACKET_CONTROL + offset,
445                        AFMT_AUDIO_SAMPLE_SEND | /* send audio packets */
446                        AFMT_60958_CS_UPDATE); /* allow 60958 channel status fields to be updated */
447         } else {
448                 WREG32(HDMI0_AUDIO_PACKET_CONTROL + offset,
449                        HDMI0_AUDIO_SAMPLE_SEND | /* send audio packets */
450                        HDMI0_AUDIO_DELAY_EN(1) | /* default audio delay */
451                        HDMI0_AUDIO_PACKETS_PER_LINE(3) | /* should be suffient for all audio modes and small enough for all hblanks */
452                        HDMI0_60958_CS_UPDATE); /* allow 60958 channel status fields to be updated */
453         }
454
455         if (ASIC_IS_DCE32(rdev)) {
456                 dce3_2_afmt_write_speaker_allocation(encoder);
457                 dce3_2_afmt_write_sad_regs(encoder);
458         }
459
460         WREG32(HDMI0_ACR_PACKET_CONTROL + offset,
461                HDMI0_ACR_SOURCE | /* select SW CTS value - XXX verify that hw CTS works on all families */
462                HDMI0_ACR_AUTO_SEND); /* allow hw to sent ACR packets when required */
463
464         WREG32(HDMI0_VBI_PACKET_CONTROL + offset,
465                HDMI0_NULL_SEND | /* send null packets when required */
466                HDMI0_GC_SEND | /* send general control packets */
467                HDMI0_GC_CONT); /* send general control packets every frame */
468
469         /* TODO: HDMI0_AUDIO_INFO_UPDATE */
470         WREG32(HDMI0_INFOFRAME_CONTROL0 + offset,
471                HDMI0_AVI_INFO_SEND | /* enable AVI info frames */
472                HDMI0_AVI_INFO_CONT | /* send AVI info frames every frame/field */
473                HDMI0_AUDIO_INFO_SEND | /* enable audio info frames (frames won't be set until audio is enabled) */
474                HDMI0_AUDIO_INFO_CONT); /* send audio info frames every frame/field */
475
476         WREG32(HDMI0_INFOFRAME_CONTROL1 + offset,
477                HDMI0_AVI_INFO_LINE(2) | /* anything other than 0 */
478                HDMI0_AUDIO_INFO_LINE(2)); /* anything other than 0 */
479
480         WREG32(HDMI0_GC + offset, 0); /* unset HDMI0_GC_AVMUTE */
481
482         err = drm_hdmi_avi_infoframe_from_display_mode(&frame, mode);
483         if (err < 0) {
484                 DRM_ERROR("failed to setup AVI infoframe: %zd\n", err);
485                 return;
486         }
487
488         err = hdmi_avi_infoframe_pack(&frame, buffer, sizeof(buffer));
489         if (err < 0) {
490                 DRM_ERROR("failed to pack AVI infoframe: %zd\n", err);
491                 return;
492         }
493
494         r600_hdmi_update_avi_infoframe(encoder, buffer, sizeof(buffer));
495         r600_hdmi_update_ACR(encoder, mode->clock);
496
497         /* it's unknown what these bits do excatly, but it's indeed quite useful for debugging */
498         WREG32(HDMI0_RAMP_CONTROL0 + offset, 0x00FFFFFF);
499         WREG32(HDMI0_RAMP_CONTROL1 + offset, 0x007FFFFF);
500         WREG32(HDMI0_RAMP_CONTROL2 + offset, 0x00000001);
501         WREG32(HDMI0_RAMP_CONTROL3 + offset, 0x00000001);
502
503         r600_hdmi_audio_workaround(encoder);
504 }
505
506 /*
507  * update settings with current parameters from audio engine
508  */
509 void r600_hdmi_update_audio_settings(struct drm_encoder *encoder)
510 {
511         struct drm_device *dev = encoder->dev;
512         struct radeon_device *rdev = dev->dev_private;
513         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
514         struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
515         struct r600_audio_pin audio = r600_audio_status(rdev);
516         uint8_t buffer[HDMI_INFOFRAME_HEADER_SIZE + HDMI_AUDIO_INFOFRAME_SIZE];
517         struct hdmi_audio_infoframe frame;
518         uint32_t offset;
519         uint32_t iec;
520         ssize_t err;
521
522         if (!dig->afmt || !dig->afmt->enabled)
523                 return;
524         offset = dig->afmt->offset;
525
526         DRM_DEBUG("%s with %d channels, %d Hz sampling rate, %d bits per sample,\n",
527                  r600_hdmi_is_audio_buffer_filled(encoder) ? "playing" : "stopped",
528                   audio.channels, audio.rate, audio.bits_per_sample);
529         DRM_DEBUG("0x%02X IEC60958 status bits and 0x%02X category code\n",
530                   (int)audio.status_bits, (int)audio.category_code);
531
532         iec = 0;
533         if (audio.status_bits & AUDIO_STATUS_PROFESSIONAL)
534                 iec |= 1 << 0;
535         if (audio.status_bits & AUDIO_STATUS_NONAUDIO)
536                 iec |= 1 << 1;
537         if (audio.status_bits & AUDIO_STATUS_COPYRIGHT)
538                 iec |= 1 << 2;
539         if (audio.status_bits & AUDIO_STATUS_EMPHASIS)
540                 iec |= 1 << 3;
541
542         iec |= HDMI0_60958_CS_CATEGORY_CODE(audio.category_code);
543
544         switch (audio.rate) {
545         case 32000:
546                 iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0x3);
547                 break;
548         case 44100:
549                 iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0x0);
550                 break;
551         case 48000:
552                 iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0x2);
553                 break;
554         case 88200:
555                 iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0x8);
556                 break;
557         case 96000:
558                 iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0xa);
559                 break;
560         case 176400:
561                 iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0xc);
562                 break;
563         case 192000:
564                 iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0xe);
565                 break;
566         }
567
568         WREG32(HDMI0_60958_0 + offset, iec);
569
570         iec = 0;
571         switch (audio.bits_per_sample) {
572         case 16:
573                 iec |= HDMI0_60958_CS_WORD_LENGTH(0x2);
574                 break;
575         case 20:
576                 iec |= HDMI0_60958_CS_WORD_LENGTH(0x3);
577                 break;
578         case 24:
579                 iec |= HDMI0_60958_CS_WORD_LENGTH(0xb);
580                 break;
581         }
582         if (audio.status_bits & AUDIO_STATUS_V)
583                 iec |= 0x5 << 16;
584         WREG32_P(HDMI0_60958_1 + offset, iec, ~0x5000f);
585
586         err = hdmi_audio_infoframe_init(&frame);
587         if (err < 0) {
588                 DRM_ERROR("failed to setup audio infoframe\n");
589                 return;
590         }
591
592         frame.channels = audio.channels;
593
594         err = hdmi_audio_infoframe_pack(&frame, buffer, sizeof(buffer));
595         if (err < 0) {
596                 DRM_ERROR("failed to pack audio infoframe\n");
597                 return;
598         }
599
600         r600_hdmi_update_audio_infoframe(encoder, buffer, sizeof(buffer));
601         r600_hdmi_audio_workaround(encoder);
602 }
603
604 /*
605  * enable the HDMI engine
606  */
607 void r600_hdmi_enable(struct drm_encoder *encoder, bool enable)
608 {
609         struct drm_device *dev = encoder->dev;
610         struct radeon_device *rdev = dev->dev_private;
611         struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
612         struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
613         u32 hdmi = HDMI0_ERROR_ACK;
614
615         if (!dig || !dig->afmt)
616                 return;
617
618         /* Silent, r600_hdmi_enable will raise WARN for us */
619         if (enable && dig->afmt->enabled)
620                 return;
621         if (!enable && !dig->afmt->enabled)
622                 return;
623
624         if (enable)
625                 dig->afmt->pin = r600_audio_get_pin(rdev);
626         else
627                 dig->afmt->pin = NULL;
628
629         /* Older chipsets require setting HDMI and routing manually */
630         if (!ASIC_IS_DCE3(rdev)) {
631                 if (enable)
632                         hdmi |= HDMI0_ENABLE;
633                 switch (radeon_encoder->encoder_id) {
634                 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_TMDS1:
635                         if (enable) {
636                                 WREG32_OR(AVIVO_TMDSA_CNTL, AVIVO_TMDSA_CNTL_HDMI_EN);
637                                 hdmi |= HDMI0_STREAM(HDMI0_STREAM_TMDSA);
638                         } else {
639                                 WREG32_AND(AVIVO_TMDSA_CNTL, ~AVIVO_TMDSA_CNTL_HDMI_EN);
640                         }
641                         break;
642                 case ENCODER_OBJECT_ID_INTERNAL_LVTM1:
643                         if (enable) {
644                                 WREG32_OR(AVIVO_LVTMA_CNTL, AVIVO_LVTMA_CNTL_HDMI_EN);
645                                 hdmi |= HDMI0_STREAM(HDMI0_STREAM_LVTMA);
646                         } else {
647                                 WREG32_AND(AVIVO_LVTMA_CNTL, ~AVIVO_LVTMA_CNTL_HDMI_EN);
648                         }
649                         break;
650                 case ENCODER_OBJECT_ID_INTERNAL_DDI:
651                         if (enable) {
652                                 WREG32_OR(DDIA_CNTL, DDIA_HDMI_EN);
653                                 hdmi |= HDMI0_STREAM(HDMI0_STREAM_DDIA);
654                         } else {
655                                 WREG32_AND(DDIA_CNTL, ~DDIA_HDMI_EN);
656                         }
657                         break;
658                 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DVO1:
659                         if (enable)
660                                 hdmi |= HDMI0_STREAM(HDMI0_STREAM_DVOA);
661                         break;
662                 default:
663                         dev_err(rdev->dev, "Invalid encoder for HDMI: 0x%X\n",
664                                 radeon_encoder->encoder_id);
665                         break;
666                 }
667                 WREG32(HDMI0_CONTROL + dig->afmt->offset, hdmi);
668         }
669
670         if (rdev->irq.installed) {
671                 /* if irq is available use it */
672                 /* XXX: shouldn't need this on any asics.  Double check DCE2/3 */
673                 if (enable)
674                         radeon_irq_kms_enable_afmt(rdev, dig->afmt->id);
675                 else
676                         radeon_irq_kms_disable_afmt(rdev, dig->afmt->id);
677         }
678
679         dig->afmt->enabled = enable;
680
681         DRM_DEBUG("%sabling HDMI interface @ 0x%04X for encoder 0x%x\n",
682                   enable ? "En" : "Dis", dig->afmt->offset, radeon_encoder->encoder_id);
683 }
684