UAPI: (Scripted) Convert #include "..." to #include <path/...> in drivers/gpu/
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / 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 <drm/drmP.h>
27 #include <drm/radeon_drm.h>
28 #include "radeon.h"
29 #include "radeon_asic.h"
30 #include "r600d.h"
31 #include "atom.h"
32
33 /*
34 * HDMI color format
35 */
36 enum r600_hdmi_color_format {
37 RGB = 0,
38 YCC_422 = 1,
39 YCC_444 = 2
40 };
41
42 /*
43 * IEC60958 status bits
44 */
45 enum r600_hdmi_iec_status_bits {
46 AUDIO_STATUS_DIG_ENABLE = 0x01,
47 AUDIO_STATUS_V = 0x02,
48 AUDIO_STATUS_VCFG = 0x04,
49 AUDIO_STATUS_EMPHASIS = 0x08,
50 AUDIO_STATUS_COPYRIGHT = 0x10,
51 AUDIO_STATUS_NONAUDIO = 0x20,
52 AUDIO_STATUS_PROFESSIONAL = 0x40,
53 AUDIO_STATUS_LEVEL = 0x80
54 };
55
56 struct radeon_hdmi_acr r600_hdmi_predefined_acr[] = {
57 /* 32kHz 44.1kHz 48kHz */
58 /* Clock N CTS N CTS N CTS */
59 { 25174, 4576, 28125, 7007, 31250, 6864, 28125 }, /* 25,20/1.001 MHz */
60 { 25200, 4096, 25200, 6272, 28000, 6144, 25200 }, /* 25.20 MHz */
61 { 27000, 4096, 27000, 6272, 30000, 6144, 27000 }, /* 27.00 MHz */
62 { 27027, 4096, 27027, 6272, 30030, 6144, 27027 }, /* 27.00*1.001 MHz */
63 { 54000, 4096, 54000, 6272, 60000, 6144, 54000 }, /* 54.00 MHz */
64 { 54054, 4096, 54054, 6272, 60060, 6144, 54054 }, /* 54.00*1.001 MHz */
65 { 74175, 11648, 210937, 17836, 234375, 11648, 140625 }, /* 74.25/1.001 MHz */
66 { 74250, 4096, 74250, 6272, 82500, 6144, 74250 }, /* 74.25 MHz */
67 { 148351, 11648, 421875, 8918, 234375, 5824, 140625 }, /* 148.50/1.001 MHz */
68 { 148500, 4096, 148500, 6272, 165000, 6144, 148500 }, /* 148.50 MHz */
69 { 0, 4096, 0, 6272, 0, 6144, 0 } /* Other */
70 };
71
72 /*
73 * calculate CTS value if it's not found in the table
74 */
75 static void r600_hdmi_calc_cts(uint32_t clock, int *CTS, int N, int freq)
76 {
77 if (*CTS == 0)
78 *CTS = clock * N / (128 * freq) * 1000;
79 DRM_DEBUG("Using ACR timing N=%d CTS=%d for frequency %d\n",
80 N, *CTS, freq);
81 }
82
83 struct radeon_hdmi_acr r600_hdmi_acr(uint32_t clock)
84 {
85 struct radeon_hdmi_acr res;
86 u8 i;
87
88 for (i = 0; r600_hdmi_predefined_acr[i].clock != clock &&
89 r600_hdmi_predefined_acr[i].clock != 0; i++)
90 ;
91 res = r600_hdmi_predefined_acr[i];
92
93 /* In case some CTS are missing */
94 r600_hdmi_calc_cts(clock, &res.cts_32khz, res.n_32khz, 32000);
95 r600_hdmi_calc_cts(clock, &res.cts_44_1khz, res.n_44_1khz, 44100);
96 r600_hdmi_calc_cts(clock, &res.cts_48khz, res.n_48khz, 48000);
97
98 return res;
99 }
100
101 /*
102 * update the N and CTS parameters for a given pixel clock rate
103 */
104 static void r600_hdmi_update_ACR(struct drm_encoder *encoder, uint32_t clock)
105 {
106 struct drm_device *dev = encoder->dev;
107 struct radeon_device *rdev = dev->dev_private;
108 struct radeon_hdmi_acr acr = r600_hdmi_acr(clock);
109 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
110 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
111 uint32_t offset = dig->afmt->offset;
112
113 WREG32(HDMI0_ACR_32_0 + offset, HDMI0_ACR_CTS_32(acr.cts_32khz));
114 WREG32(HDMI0_ACR_32_1 + offset, acr.n_32khz);
115
116 WREG32(HDMI0_ACR_44_0 + offset, HDMI0_ACR_CTS_44(acr.cts_44_1khz));
117 WREG32(HDMI0_ACR_44_1 + offset, acr.n_44_1khz);
118
119 WREG32(HDMI0_ACR_48_0 + offset, HDMI0_ACR_CTS_48(acr.cts_48khz));
120 WREG32(HDMI0_ACR_48_1 + offset, acr.n_48khz);
121 }
122
123 /*
124 * calculate the crc for a given info frame
125 */
126 static void r600_hdmi_infoframe_checksum(uint8_t packetType,
127 uint8_t versionNumber,
128 uint8_t length,
129 uint8_t *frame)
130 {
131 int i;
132 frame[0] = packetType + versionNumber + length;
133 for (i = 1; i <= length; i++)
134 frame[0] += frame[i];
135 frame[0] = 0x100 - frame[0];
136 }
137
138 /*
139 * build a HDMI Video Info Frame
140 */
141 static void r600_hdmi_videoinfoframe(
142 struct drm_encoder *encoder,
143 enum r600_hdmi_color_format color_format,
144 int active_information_present,
145 uint8_t active_format_aspect_ratio,
146 uint8_t scan_information,
147 uint8_t colorimetry,
148 uint8_t ex_colorimetry,
149 uint8_t quantization,
150 int ITC,
151 uint8_t picture_aspect_ratio,
152 uint8_t video_format_identification,
153 uint8_t pixel_repetition,
154 uint8_t non_uniform_picture_scaling,
155 uint8_t bar_info_data_valid,
156 uint16_t top_bar,
157 uint16_t bottom_bar,
158 uint16_t left_bar,
159 uint16_t right_bar
160 )
161 {
162 struct drm_device *dev = encoder->dev;
163 struct radeon_device *rdev = dev->dev_private;
164 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
165 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
166 uint32_t offset = dig->afmt->offset;
167
168 uint8_t frame[14];
169
170 frame[0x0] = 0;
171 frame[0x1] =
172 (scan_information & 0x3) |
173 ((bar_info_data_valid & 0x3) << 2) |
174 ((active_information_present & 0x1) << 4) |
175 ((color_format & 0x3) << 5);
176 frame[0x2] =
177 (active_format_aspect_ratio & 0xF) |
178 ((picture_aspect_ratio & 0x3) << 4) |
179 ((colorimetry & 0x3) << 6);
180 frame[0x3] =
181 (non_uniform_picture_scaling & 0x3) |
182 ((quantization & 0x3) << 2) |
183 ((ex_colorimetry & 0x7) << 4) |
184 ((ITC & 0x1) << 7);
185 frame[0x4] = (video_format_identification & 0x7F);
186 frame[0x5] = (pixel_repetition & 0xF);
187 frame[0x6] = (top_bar & 0xFF);
188 frame[0x7] = (top_bar >> 8);
189 frame[0x8] = (bottom_bar & 0xFF);
190 frame[0x9] = (bottom_bar >> 8);
191 frame[0xA] = (left_bar & 0xFF);
192 frame[0xB] = (left_bar >> 8);
193 frame[0xC] = (right_bar & 0xFF);
194 frame[0xD] = (right_bar >> 8);
195
196 r600_hdmi_infoframe_checksum(0x82, 0x02, 0x0D, frame);
197 /* Our header values (type, version, length) should be alright, Intel
198 * is using the same. Checksum function also seems to be OK, it works
199 * fine for audio infoframe. However calculated value is always lower
200 * by 2 in comparison to fglrx. It breaks displaying anything in case
201 * of TVs that strictly check the checksum. Hack it manually here to
202 * workaround this issue. */
203 frame[0x0] += 2;
204
205 WREG32(HDMI0_AVI_INFO0 + offset,
206 frame[0x0] | (frame[0x1] << 8) | (frame[0x2] << 16) | (frame[0x3] << 24));
207 WREG32(HDMI0_AVI_INFO1 + offset,
208 frame[0x4] | (frame[0x5] << 8) | (frame[0x6] << 16) | (frame[0x7] << 24));
209 WREG32(HDMI0_AVI_INFO2 + offset,
210 frame[0x8] | (frame[0x9] << 8) | (frame[0xA] << 16) | (frame[0xB] << 24));
211 WREG32(HDMI0_AVI_INFO3 + offset,
212 frame[0xC] | (frame[0xD] << 8));
213 }
214
215 /*
216 * build a Audio Info Frame
217 */
218 static void r600_hdmi_audioinfoframe(
219 struct drm_encoder *encoder,
220 uint8_t channel_count,
221 uint8_t coding_type,
222 uint8_t sample_size,
223 uint8_t sample_frequency,
224 uint8_t format,
225 uint8_t channel_allocation,
226 uint8_t level_shift,
227 int downmix_inhibit
228 )
229 {
230 struct drm_device *dev = encoder->dev;
231 struct radeon_device *rdev = dev->dev_private;
232 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
233 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
234 uint32_t offset = dig->afmt->offset;
235
236 uint8_t frame[11];
237
238 frame[0x0] = 0;
239 frame[0x1] = (channel_count & 0x7) | ((coding_type & 0xF) << 4);
240 frame[0x2] = (sample_size & 0x3) | ((sample_frequency & 0x7) << 2);
241 frame[0x3] = format;
242 frame[0x4] = channel_allocation;
243 frame[0x5] = ((level_shift & 0xF) << 3) | ((downmix_inhibit & 0x1) << 7);
244 frame[0x6] = 0;
245 frame[0x7] = 0;
246 frame[0x8] = 0;
247 frame[0x9] = 0;
248 frame[0xA] = 0;
249
250 r600_hdmi_infoframe_checksum(0x84, 0x01, 0x0A, frame);
251
252 WREG32(HDMI0_AUDIO_INFO0 + offset,
253 frame[0x0] | (frame[0x1] << 8) | (frame[0x2] << 16) | (frame[0x3] << 24));
254 WREG32(HDMI0_AUDIO_INFO1 + offset,
255 frame[0x4] | (frame[0x5] << 8) | (frame[0x6] << 16) | (frame[0x8] << 24));
256 }
257
258 /*
259 * test if audio buffer is filled enough to start playing
260 */
261 static bool r600_hdmi_is_audio_buffer_filled(struct drm_encoder *encoder)
262 {
263 struct drm_device *dev = encoder->dev;
264 struct radeon_device *rdev = dev->dev_private;
265 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
266 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
267 uint32_t offset = dig->afmt->offset;
268
269 return (RREG32(HDMI0_STATUS + offset) & 0x10) != 0;
270 }
271
272 /*
273 * have buffer status changed since last call?
274 */
275 int r600_hdmi_buffer_status_changed(struct drm_encoder *encoder)
276 {
277 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
278 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
279 int status, result;
280
281 if (!dig->afmt || !dig->afmt->enabled)
282 return 0;
283
284 status = r600_hdmi_is_audio_buffer_filled(encoder);
285 result = dig->afmt->last_buffer_filled_status != status;
286 dig->afmt->last_buffer_filled_status = status;
287
288 return result;
289 }
290
291 /*
292 * write the audio workaround status to the hardware
293 */
294 static void r600_hdmi_audio_workaround(struct drm_encoder *encoder)
295 {
296 struct drm_device *dev = encoder->dev;
297 struct radeon_device *rdev = dev->dev_private;
298 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
299 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
300 uint32_t offset = dig->afmt->offset;
301 bool hdmi_audio_workaround = false; /* FIXME */
302 u32 value;
303
304 if (!hdmi_audio_workaround ||
305 r600_hdmi_is_audio_buffer_filled(encoder))
306 value = 0; /* disable workaround */
307 else
308 value = HDMI0_AUDIO_TEST_EN; /* enable workaround */
309 WREG32_P(HDMI0_AUDIO_PACKET_CONTROL + offset,
310 value, ~HDMI0_AUDIO_TEST_EN);
311 }
312
313
314 /*
315 * update the info frames with the data from the current display mode
316 */
317 void r600_hdmi_setmode(struct drm_encoder *encoder, struct drm_display_mode *mode)
318 {
319 struct drm_device *dev = encoder->dev;
320 struct radeon_device *rdev = dev->dev_private;
321 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
322 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
323 uint32_t offset;
324
325 /* Silent, r600_hdmi_enable will raise WARN for us */
326 if (!dig->afmt->enabled)
327 return;
328 offset = dig->afmt->offset;
329
330 r600_audio_set_clock(encoder, mode->clock);
331
332 WREG32(HDMI0_VBI_PACKET_CONTROL + offset,
333 HDMI0_NULL_SEND); /* send null packets when required */
334
335 WREG32(HDMI0_AUDIO_CRC_CONTROL + offset, 0x1000);
336
337 if (ASIC_IS_DCE32(rdev)) {
338 WREG32(HDMI0_AUDIO_PACKET_CONTROL + offset,
339 HDMI0_AUDIO_DELAY_EN(1) | /* default audio delay */
340 HDMI0_AUDIO_PACKETS_PER_LINE(3)); /* should be suffient for all audio modes and small enough for all hblanks */
341 WREG32(AFMT_AUDIO_PACKET_CONTROL + offset,
342 AFMT_AUDIO_SAMPLE_SEND | /* send audio packets */
343 AFMT_60958_CS_UPDATE); /* allow 60958 channel status fields to be updated */
344 } else {
345 WREG32(HDMI0_AUDIO_PACKET_CONTROL + offset,
346 HDMI0_AUDIO_SAMPLE_SEND | /* send audio packets */
347 HDMI0_AUDIO_DELAY_EN(1) | /* default audio delay */
348 HDMI0_AUDIO_PACKETS_PER_LINE(3) | /* should be suffient for all audio modes and small enough for all hblanks */
349 HDMI0_60958_CS_UPDATE); /* allow 60958 channel status fields to be updated */
350 }
351
352 WREG32(HDMI0_ACR_PACKET_CONTROL + offset,
353 HDMI0_ACR_AUTO_SEND | /* allow hw to sent ACR packets when required */
354 HDMI0_ACR_SOURCE); /* select SW CTS value */
355
356 WREG32(HDMI0_VBI_PACKET_CONTROL + offset,
357 HDMI0_NULL_SEND | /* send null packets when required */
358 HDMI0_GC_SEND | /* send general control packets */
359 HDMI0_GC_CONT); /* send general control packets every frame */
360
361 /* TODO: HDMI0_AUDIO_INFO_UPDATE */
362 WREG32(HDMI0_INFOFRAME_CONTROL0 + offset,
363 HDMI0_AVI_INFO_SEND | /* enable AVI info frames */
364 HDMI0_AVI_INFO_CONT | /* send AVI info frames every frame/field */
365 HDMI0_AUDIO_INFO_SEND | /* enable audio info frames (frames won't be set until audio is enabled) */
366 HDMI0_AUDIO_INFO_CONT); /* send audio info frames every frame/field */
367
368 WREG32(HDMI0_INFOFRAME_CONTROL1 + offset,
369 HDMI0_AVI_INFO_LINE(2) | /* anything other than 0 */
370 HDMI0_AUDIO_INFO_LINE(2)); /* anything other than 0 */
371
372 WREG32(HDMI0_GC + offset, 0); /* unset HDMI0_GC_AVMUTE */
373
374 r600_hdmi_videoinfoframe(encoder, RGB, 0, 0, 0, 0,
375 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0);
376
377 r600_hdmi_update_ACR(encoder, mode->clock);
378
379 /* it's unknown what these bits do excatly, but it's indeed quite useful for debugging */
380 WREG32(HDMI0_RAMP_CONTROL0 + offset, 0x00FFFFFF);
381 WREG32(HDMI0_RAMP_CONTROL1 + offset, 0x007FFFFF);
382 WREG32(HDMI0_RAMP_CONTROL2 + offset, 0x00000001);
383 WREG32(HDMI0_RAMP_CONTROL3 + offset, 0x00000001);
384
385 r600_hdmi_audio_workaround(encoder);
386 }
387
388 /*
389 * update settings with current parameters from audio engine
390 */
391 void r600_hdmi_update_audio_settings(struct drm_encoder *encoder)
392 {
393 struct drm_device *dev = encoder->dev;
394 struct radeon_device *rdev = dev->dev_private;
395 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
396 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
397 struct r600_audio audio = r600_audio_status(rdev);
398 uint32_t offset;
399 uint32_t iec;
400
401 if (!dig->afmt || !dig->afmt->enabled)
402 return;
403 offset = dig->afmt->offset;
404
405 DRM_DEBUG("%s with %d channels, %d Hz sampling rate, %d bits per sample,\n",
406 r600_hdmi_is_audio_buffer_filled(encoder) ? "playing" : "stopped",
407 audio.channels, audio.rate, audio.bits_per_sample);
408 DRM_DEBUG("0x%02X IEC60958 status bits and 0x%02X category code\n",
409 (int)audio.status_bits, (int)audio.category_code);
410
411 iec = 0;
412 if (audio.status_bits & AUDIO_STATUS_PROFESSIONAL)
413 iec |= 1 << 0;
414 if (audio.status_bits & AUDIO_STATUS_NONAUDIO)
415 iec |= 1 << 1;
416 if (audio.status_bits & AUDIO_STATUS_COPYRIGHT)
417 iec |= 1 << 2;
418 if (audio.status_bits & AUDIO_STATUS_EMPHASIS)
419 iec |= 1 << 3;
420
421 iec |= HDMI0_60958_CS_CATEGORY_CODE(audio.category_code);
422
423 switch (audio.rate) {
424 case 32000:
425 iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0x3);
426 break;
427 case 44100:
428 iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0x0);
429 break;
430 case 48000:
431 iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0x2);
432 break;
433 case 88200:
434 iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0x8);
435 break;
436 case 96000:
437 iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0xa);
438 break;
439 case 176400:
440 iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0xc);
441 break;
442 case 192000:
443 iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0xe);
444 break;
445 }
446
447 WREG32(HDMI0_60958_0 + offset, iec);
448
449 iec = 0;
450 switch (audio.bits_per_sample) {
451 case 16:
452 iec |= HDMI0_60958_CS_WORD_LENGTH(0x2);
453 break;
454 case 20:
455 iec |= HDMI0_60958_CS_WORD_LENGTH(0x3);
456 break;
457 case 24:
458 iec |= HDMI0_60958_CS_WORD_LENGTH(0xb);
459 break;
460 }
461 if (audio.status_bits & AUDIO_STATUS_V)
462 iec |= 0x5 << 16;
463 WREG32_P(HDMI0_60958_1 + offset, iec, ~0x5000f);
464
465 r600_hdmi_audioinfoframe(encoder, audio.channels - 1, 0, 0, 0, 0, 0, 0,
466 0);
467
468 r600_hdmi_audio_workaround(encoder);
469 }
470
471 /*
472 * enable the HDMI engine
473 */
474 void r600_hdmi_enable(struct drm_encoder *encoder)
475 {
476 struct drm_device *dev = encoder->dev;
477 struct radeon_device *rdev = dev->dev_private;
478 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
479 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
480 uint32_t offset;
481 u32 hdmi;
482
483 if (ASIC_IS_DCE6(rdev))
484 return;
485
486 /* Silent, r600_hdmi_enable will raise WARN for us */
487 if (dig->afmt->enabled)
488 return;
489 offset = dig->afmt->offset;
490
491 /* Older chipsets require setting HDMI and routing manually */
492 if (rdev->family >= CHIP_R600 && !ASIC_IS_DCE3(rdev)) {
493 hdmi = HDMI0_ERROR_ACK | HDMI0_ENABLE;
494 switch (radeon_encoder->encoder_id) {
495 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_TMDS1:
496 WREG32_P(AVIVO_TMDSA_CNTL, AVIVO_TMDSA_CNTL_HDMI_EN,
497 ~AVIVO_TMDSA_CNTL_HDMI_EN);
498 hdmi |= HDMI0_STREAM(HDMI0_STREAM_TMDSA);
499 break;
500 case ENCODER_OBJECT_ID_INTERNAL_LVTM1:
501 WREG32_P(AVIVO_LVTMA_CNTL, AVIVO_LVTMA_CNTL_HDMI_EN,
502 ~AVIVO_LVTMA_CNTL_HDMI_EN);
503 hdmi |= HDMI0_STREAM(HDMI0_STREAM_LVTMA);
504 break;
505 case ENCODER_OBJECT_ID_INTERNAL_DDI:
506 WREG32_P(DDIA_CNTL, DDIA_HDMI_EN, ~DDIA_HDMI_EN);
507 hdmi |= HDMI0_STREAM(HDMI0_STREAM_DDIA);
508 break;
509 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DVO1:
510 hdmi |= HDMI0_STREAM(HDMI0_STREAM_DVOA);
511 break;
512 default:
513 dev_err(rdev->dev, "Invalid encoder for HDMI: 0x%X\n",
514 radeon_encoder->encoder_id);
515 break;
516 }
517 WREG32(HDMI0_CONTROL + offset, hdmi);
518 }
519
520 if (rdev->irq.installed) {
521 /* if irq is available use it */
522 radeon_irq_kms_enable_afmt(rdev, dig->afmt->id);
523 }
524
525 dig->afmt->enabled = true;
526
527 DRM_DEBUG("Enabling HDMI interface @ 0x%04X for encoder 0x%x\n",
528 offset, radeon_encoder->encoder_id);
529 }
530
531 /*
532 * disable the HDMI engine
533 */
534 void r600_hdmi_disable(struct drm_encoder *encoder)
535 {
536 struct drm_device *dev = encoder->dev;
537 struct radeon_device *rdev = dev->dev_private;
538 struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
539 struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
540 uint32_t offset;
541
542 if (ASIC_IS_DCE6(rdev))
543 return;
544
545 /* Called for ATOM_ENCODER_MODE_HDMI only */
546 if (!dig || !dig->afmt) {
547 WARN_ON(1);
548 return;
549 }
550 if (!dig->afmt->enabled)
551 return;
552 offset = dig->afmt->offset;
553
554 DRM_DEBUG("Disabling HDMI interface @ 0x%04X for encoder 0x%x\n",
555 offset, radeon_encoder->encoder_id);
556
557 /* disable irq */
558 radeon_irq_kms_disable_afmt(rdev, dig->afmt->id);
559
560 /* Older chipsets not handled by AtomBIOS */
561 if (rdev->family >= CHIP_R600 && !ASIC_IS_DCE3(rdev)) {
562 switch (radeon_encoder->encoder_id) {
563 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_TMDS1:
564 WREG32_P(AVIVO_TMDSA_CNTL, 0,
565 ~AVIVO_TMDSA_CNTL_HDMI_EN);
566 break;
567 case ENCODER_OBJECT_ID_INTERNAL_LVTM1:
568 WREG32_P(AVIVO_LVTMA_CNTL, 0,
569 ~AVIVO_LVTMA_CNTL_HDMI_EN);
570 break;
571 case ENCODER_OBJECT_ID_INTERNAL_DDI:
572 WREG32_P(DDIA_CNTL, 0, ~DDIA_HDMI_EN);
573 break;
574 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DVO1:
575 break;
576 default:
577 dev_err(rdev->dev, "Invalid encoder for HDMI: 0x%X\n",
578 radeon_encoder->encoder_id);
579 break;
580 }
581 WREG32(HDMI0_CONTROL + offset, HDMI0_ERROR_ACK);
582 }
583
584 dig->afmt->enabled = false;
585 }