]> Pileus Git - ~andy/linux/blobdiff - drivers/gpu/drm/radeon/r600_hdmi.c
ALSA: hda - give 3-pin jack the name "Headphone Mic Jack"
[~andy/linux] / drivers / gpu / drm / radeon / r600_hdmi.c
index 7d24753108fa9fe745fcd825f302dfd3efa88b3b..226379e00ac1de31bc7dcdb1781ff64ee4457b8c 100644 (file)
@@ -53,19 +53,7 @@ enum r600_hdmi_iec_status_bits {
        AUDIO_STATUS_LEVEL        = 0x80
 };
 
-struct {
-       uint32_t Clock;
-
-       int N_32kHz;
-       int CTS_32kHz;
-
-       int N_44_1kHz;
-       int CTS_44_1kHz;
-
-       int N_48kHz;
-       int CTS_48kHz;
-
-} r600_hdmi_ACR[] = {
+struct radeon_hdmi_acr r600_hdmi_predefined_acr[] = {
     /*      32kHz        44.1kHz       48kHz    */
     /* Clock      N     CTS      N     CTS      N     CTS */
     {  25174,  4576,  28125,  7007,  31250,  6864,  28125 }, /*  25,20/1.001 MHz */
@@ -84,7 +72,7 @@ struct {
 /*
  * calculate CTS value if it's not found in the table
  */
-static void r600_hdmi_calc_CTS(uint32_t clock, int *CTS, int N, int freq)
+static void r600_hdmi_calc_cts(uint32_t clock, int *CTS, int N, int freq)
 {
        if (*CTS == 0)
                *CTS = clock * N / (128 * freq) * 1000;
@@ -92,6 +80,24 @@ static void r600_hdmi_calc_CTS(uint32_t clock, int *CTS, int N, int freq)
                  N, *CTS, freq);
 }
 
+struct radeon_hdmi_acr r600_hdmi_acr(uint32_t clock)
+{
+       struct radeon_hdmi_acr res;
+       u8 i;
+
+       for (i = 0; r600_hdmi_predefined_acr[i].clock != clock &&
+            r600_hdmi_predefined_acr[i].clock != 0; i++)
+               ;
+       res = r600_hdmi_predefined_acr[i];
+
+       /* In case some CTS are missing */
+       r600_hdmi_calc_cts(clock, &res.cts_32khz, res.n_32khz, 32000);
+       r600_hdmi_calc_cts(clock, &res.cts_44_1khz, res.n_44_1khz, 44100);
+       r600_hdmi_calc_cts(clock, &res.cts_48khz, res.n_48khz, 48000);
+
+       return res;
+}
+
 /*
  * update the N and CTS parameters for a given pixel clock rate
  */
@@ -99,30 +105,19 @@ static void r600_hdmi_update_ACR(struct drm_encoder *encoder, uint32_t clock)
 {
        struct drm_device *dev = encoder->dev;
        struct radeon_device *rdev = dev->dev_private;
-       uint32_t offset = to_radeon_encoder(encoder)->hdmi_offset;
-       int CTS;
-       int N;
-       int i;
+       struct radeon_hdmi_acr acr = r600_hdmi_acr(clock);
+       struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
+       struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
+       uint32_t offset = dig->afmt->offset;
+
+       WREG32(HDMI0_ACR_32_0 + offset, HDMI0_ACR_CTS_32(acr.cts_32khz));
+       WREG32(HDMI0_ACR_32_1 + offset, acr.n_32khz);
 
-       for (i = 0; r600_hdmi_ACR[i].Clock != clock && r600_hdmi_ACR[i].Clock != 0; i++);
-
-       CTS = r600_hdmi_ACR[i].CTS_32kHz;
-       N = r600_hdmi_ACR[i].N_32kHz;
-       r600_hdmi_calc_CTS(clock, &CTS, N, 32000);
-       WREG32(HDMI0_ACR_32_0 + offset, HDMI0_ACR_CTS_32(CTS));
-       WREG32(HDMI0_ACR_32_1 + offset, N);
-
-       CTS = r600_hdmi_ACR[i].CTS_44_1kHz;
-       N = r600_hdmi_ACR[i].N_44_1kHz;
-       r600_hdmi_calc_CTS(clock, &CTS, N, 44100);
-       WREG32(HDMI0_ACR_44_0 + offset, HDMI0_ACR_CTS_44(CTS));
-       WREG32(HDMI0_ACR_44_1 + offset, N);
-
-       CTS = r600_hdmi_ACR[i].CTS_48kHz;
-       N = r600_hdmi_ACR[i].N_48kHz;
-       r600_hdmi_calc_CTS(clock, &CTS, N, 48000);
-       WREG32(HDMI0_ACR_48_0 + offset, HDMI0_ACR_CTS_48(CTS));
-       WREG32(HDMI0_ACR_48_1 + offset, N);
+       WREG32(HDMI0_ACR_44_0 + offset, HDMI0_ACR_CTS_44(acr.cts_44_1khz));
+       WREG32(HDMI0_ACR_44_1 + offset, acr.n_44_1khz);
+
+       WREG32(HDMI0_ACR_48_0 + offset, HDMI0_ACR_CTS_48(acr.cts_48khz));
+       WREG32(HDMI0_ACR_48_1 + offset, acr.n_48khz);
 }
 
 /*
@@ -166,7 +161,9 @@ static void r600_hdmi_videoinfoframe(
 {
        struct drm_device *dev = encoder->dev;
        struct radeon_device *rdev = dev->dev_private;
-       uint32_t offset = to_radeon_encoder(encoder)->hdmi_offset;
+       struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
+       struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
+       uint32_t offset = dig->afmt->offset;
 
        uint8_t frame[14];
 
@@ -232,7 +229,9 @@ static void r600_hdmi_audioinfoframe(
 {
        struct drm_device *dev = encoder->dev;
        struct radeon_device *rdev = dev->dev_private;
-       uint32_t offset = to_radeon_encoder(encoder)->hdmi_offset;
+       struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
+       struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
+       uint32_t offset = dig->afmt->offset;
 
        uint8_t frame[11];
 
@@ -259,11 +258,13 @@ static void r600_hdmi_audioinfoframe(
 /*
  * test if audio buffer is filled enough to start playing
  */
-static int r600_hdmi_is_audio_buffer_filled(struct drm_encoder *encoder)
+static bool r600_hdmi_is_audio_buffer_filled(struct drm_encoder *encoder)
 {
        struct drm_device *dev = encoder->dev;
        struct radeon_device *rdev = dev->dev_private;
-       uint32_t offset = to_radeon_encoder(encoder)->hdmi_offset;
+       struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
+       struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
+       uint32_t offset = dig->afmt->offset;
 
        return (RREG32(HDMI0_STATUS + offset) & 0x10) != 0;
 }
@@ -274,14 +275,15 @@ static int r600_hdmi_is_audio_buffer_filled(struct drm_encoder *encoder)
 int r600_hdmi_buffer_status_changed(struct drm_encoder *encoder)
 {
        struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
+       struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
        int status, result;
 
-       if (!radeon_encoder->hdmi_enabled)
+       if (!dig->afmt || !dig->afmt->enabled)
                return 0;
 
        status = r600_hdmi_is_audio_buffer_filled(encoder);
-       result = radeon_encoder->hdmi_buffer_status != status;
-       radeon_encoder->hdmi_buffer_status = status;
+       result = dig->afmt->last_buffer_filled_status != status;
+       dig->afmt->last_buffer_filled_status = status;
 
        return result;
 }
@@ -289,28 +291,23 @@ int r600_hdmi_buffer_status_changed(struct drm_encoder *encoder)
 /*
  * write the audio workaround status to the hardware
  */
-void r600_hdmi_audio_workaround(struct drm_encoder *encoder)
+static void r600_hdmi_audio_workaround(struct drm_encoder *encoder)
 {
        struct drm_device *dev = encoder->dev;
        struct radeon_device *rdev = dev->dev_private;
        struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
-       uint32_t offset = radeon_encoder->hdmi_offset;
-
-       if (!radeon_encoder->hdmi_enabled)
-               return;
-
-       if (!radeon_encoder->hdmi_audio_workaround ||
-               r600_hdmi_is_audio_buffer_filled(encoder)) {
-
-               /* disable audio workaround */
-               WREG32_P(HDMI0_AUDIO_PACKET_CONTROL + offset,
-                        0, ~HDMI0_AUDIO_TEST_EN);
+       struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
+       uint32_t offset = dig->afmt->offset;
+       bool hdmi_audio_workaround = false; /* FIXME */
+       u32 value;
 
-       } else {
-               /* enable audio workaround */
-               WREG32_P(HDMI0_AUDIO_PACKET_CONTROL + offset,
-                        HDMI0_AUDIO_TEST_EN, ~HDMI0_AUDIO_TEST_EN);
-       }
+       if (!hdmi_audio_workaround ||
+           r600_hdmi_is_audio_buffer_filled(encoder))
+               value = 0; /* disable workaround */
+       else
+               value = HDMI0_AUDIO_TEST_EN; /* enable workaround */
+       WREG32_P(HDMI0_AUDIO_PACKET_CONTROL + offset,
+                value, ~HDMI0_AUDIO_TEST_EN);
 }
 
 
@@ -321,41 +318,68 @@ void r600_hdmi_setmode(struct drm_encoder *encoder, struct drm_display_mode *mod
 {
        struct drm_device *dev = encoder->dev;
        struct radeon_device *rdev = dev->dev_private;
-       uint32_t offset = to_radeon_encoder(encoder)->hdmi_offset;
+       struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
+       struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
+       uint32_t offset;
 
        if (ASIC_IS_DCE5(rdev))
                return;
 
-       if (!to_radeon_encoder(encoder)->hdmi_enabled)
+       /* Silent, r600_hdmi_enable will raise WARN for us */
+       if (!dig->afmt->enabled)
                return;
+       offset = dig->afmt->offset;
 
        r600_audio_set_clock(encoder, mode->clock);
 
+       WREG32(HDMI0_VBI_PACKET_CONTROL + offset,
+              HDMI0_NULL_SEND); /* send null packets when required */
+
        WREG32(HDMI0_AUDIO_CRC_CONTROL + offset, 0x1000);
-       WREG32(HDMI0_GC + offset, 0x0);
-
-       /* Send audio packets */
-       if (ASIC_IS_DCE4(rdev))
-               WREG32_P(0x74fc + offset,
-                        AFMT_AUDIO_SAMPLE_SEND, ~AFMT_AUDIO_SAMPLE_SEND);
-       else if (ASIC_IS_DCE32(rdev))
-               WREG32_P(AFMT_AUDIO_PACKET_CONTROL + offset,
-                        AFMT_AUDIO_SAMPLE_SEND, ~AFMT_AUDIO_SAMPLE_SEND);
-       else
-               WREG32_P(HDMI0_AUDIO_PACKET_CONTROL + offset,
-                        HDMI0_AUDIO_SAMPLE_SEND, ~HDMI0_AUDIO_SAMPLE_SEND);
 
-       WREG32(HDMI0_ACR_PACKET_CONTROL + offset, 0x1000);
+       if (ASIC_IS_DCE32(rdev)) {
+               WREG32(HDMI0_AUDIO_PACKET_CONTROL + offset,
+                      HDMI0_AUDIO_DELAY_EN(1) | /* default audio delay */
+                      HDMI0_AUDIO_PACKETS_PER_LINE(3)); /* should be suffient for all audio modes and small enough for all hblanks */
+               WREG32(AFMT_AUDIO_PACKET_CONTROL + offset,
+                      AFMT_AUDIO_SAMPLE_SEND | /* send audio packets */
+                      AFMT_60958_CS_UPDATE); /* allow 60958 channel status fields to be updated */
+       } else {
+               WREG32(HDMI0_AUDIO_PACKET_CONTROL + offset,
+                      HDMI0_AUDIO_SAMPLE_SEND | /* send audio packets */
+                      HDMI0_AUDIO_DELAY_EN(1) | /* default audio delay */
+                      HDMI0_AUDIO_SEND_MAX_PACKETS | /* send NULL packets if no audio is available */
+                      HDMI0_AUDIO_PACKETS_PER_LINE(3) | /* should be suffient for all audio modes and small enough for all hblanks */
+                      HDMI0_60958_CS_UPDATE); /* allow 60958 channel status fields to be updated */
+       }
 
-       r600_hdmi_update_ACR(encoder, mode->clock);
+       WREG32(HDMI0_ACR_PACKET_CONTROL + offset,
+              HDMI0_ACR_AUTO_SEND | /* allow hw to sent ACR packets when required */
+              HDMI0_ACR_SOURCE); /* select SW CTS value */
+
+       WREG32(HDMI0_VBI_PACKET_CONTROL + offset,
+              HDMI0_NULL_SEND | /* send null packets when required */
+              HDMI0_GC_SEND | /* send general control packets */
+              HDMI0_GC_CONT); /* send general control packets every frame */
 
-       WREG32(HDMI0_INFOFRAME_CONTROL0 + offset, 0x13);
+       /* TODO: HDMI0_AUDIO_INFO_UPDATE */
+       WREG32(HDMI0_INFOFRAME_CONTROL0 + offset,
+              HDMI0_AVI_INFO_SEND | /* enable AVI info frames */
+              HDMI0_AVI_INFO_CONT | /* send AVI info frames every frame/field */
+              HDMI0_AUDIO_INFO_SEND | /* enable audio info frames (frames won't be set until audio is enabled) */
+              HDMI0_AUDIO_INFO_CONT); /* send audio info frames every frame/field */
 
-       WREG32(HDMI0_INFOFRAME_CONTROL1 + offset, 0x202);
+       WREG32(HDMI0_INFOFRAME_CONTROL1 + offset,
+              HDMI0_AVI_INFO_LINE(2) | /* anything other than 0 */
+              HDMI0_AUDIO_INFO_LINE(2)); /* anything other than 0 */
+
+       WREG32(HDMI0_GC + offset, 0); /* unset HDMI0_GC_AVMUTE */
 
        r600_hdmi_videoinfoframe(encoder, RGB, 0, 0, 0, 0,
                0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0);
 
+       r600_hdmi_update_ACR(encoder, mode->clock);
+
        /* it's unknown what these bits do excatly, but it's indeed quite useful for debugging */
        WREG32(HDMI0_RAMP_CONTROL0 + offset, 0x00FFFFFF);
        WREG32(HDMI0_RAMP_CONTROL1 + offset, 0x007FFFFF);
@@ -363,9 +387,6 @@ void r600_hdmi_setmode(struct drm_encoder *encoder, struct drm_display_mode *mod
        WREG32(HDMI0_RAMP_CONTROL3 + offset, 0x00000001);
 
        r600_hdmi_audio_workaround(encoder);
-
-       /* audio packets per line, does anyone know how to calc this ? */
-       WREG32_P(HDMI0_AUDIO_PACKET_CONTROL + offset, 0x00040000, ~0x001F0000);
 }
 
 /*
@@ -375,115 +396,82 @@ void r600_hdmi_update_audio_settings(struct drm_encoder *encoder)
 {
        struct drm_device *dev = encoder->dev;
        struct radeon_device *rdev = dev->dev_private;
-       uint32_t offset = to_radeon_encoder(encoder)->hdmi_offset;
-
-       int channels = r600_audio_channels(rdev);
-       int rate = r600_audio_rate(rdev);
-       int bps = r600_audio_bits_per_sample(rdev);
-       uint8_t status_bits = r600_audio_status_bits(rdev);
-       uint8_t category_code = r600_audio_category_code(rdev);
-
+       struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
+       struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
+       struct r600_audio audio = r600_audio_status(rdev);
+       uint32_t offset;
        uint32_t iec;
 
-       if (!to_radeon_encoder(encoder)->hdmi_enabled)
+       if (!dig->afmt || !dig->afmt->enabled)
                return;
+       offset = dig->afmt->offset;
 
        DRM_DEBUG("%s with %d channels, %d Hz sampling rate, %d bits per sample,\n",
                 r600_hdmi_is_audio_buffer_filled(encoder) ? "playing" : "stopped",
-               channels, rate, bps);
+                 audio.channels, audio.rate, audio.bits_per_sample);
        DRM_DEBUG("0x%02X IEC60958 status bits and 0x%02X category code\n",
-                 (int)status_bits, (int)category_code);
+                 (int)audio.status_bits, (int)audio.category_code);
 
        iec = 0;
-       if (status_bits & AUDIO_STATUS_PROFESSIONAL)
+       if (audio.status_bits & AUDIO_STATUS_PROFESSIONAL)
                iec |= 1 << 0;
-       if (status_bits & AUDIO_STATUS_NONAUDIO)
+       if (audio.status_bits & AUDIO_STATUS_NONAUDIO)
                iec |= 1 << 1;
-       if (status_bits & AUDIO_STATUS_COPYRIGHT)
+       if (audio.status_bits & AUDIO_STATUS_COPYRIGHT)
                iec |= 1 << 2;
-       if (status_bits & AUDIO_STATUS_EMPHASIS)
+       if (audio.status_bits & AUDIO_STATUS_EMPHASIS)
                iec |= 1 << 3;
 
-       iec |= category_code << 8;
-
-       switch (rate) {
-       case  32000: iec |= 0x3 << 24; break;
-       case  44100: iec |= 0x0 << 24; break;
-       case  88200: iec |= 0x8 << 24; break;
-       case 176400: iec |= 0xc << 24; break;
-       case  48000: iec |= 0x2 << 24; break;
-       case  96000: iec |= 0xa << 24; break;
-       case 192000: iec |= 0xe << 24; break;
+       iec |= HDMI0_60958_CS_CATEGORY_CODE(audio.category_code);
+
+       switch (audio.rate) {
+       case 32000:
+               iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0x3);
+               break;
+       case 44100:
+               iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0x0);
+               break;
+       case 48000:
+               iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0x2);
+               break;
+       case 88200:
+               iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0x8);
+               break;
+       case 96000:
+               iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0xa);
+               break;
+       case 176400:
+               iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0xc);
+               break;
+       case 192000:
+               iec |= HDMI0_60958_CS_SAMPLING_FREQUENCY(0xe);
+               break;
        }
 
        WREG32(HDMI0_60958_0 + offset, iec);
 
        iec = 0;
-       switch (bps) {
-       case 16: iec |= 0x2; break;
-       case 20: iec |= 0x3; break;
-       case 24: iec |= 0xb; break;
+       switch (audio.bits_per_sample) {
+       case 16:
+               iec |= HDMI0_60958_CS_WORD_LENGTH(0x2);
+               break;
+       case 20:
+               iec |= HDMI0_60958_CS_WORD_LENGTH(0x3);
+               break;
+       case 24:
+               iec |= HDMI0_60958_CS_WORD_LENGTH(0xb);
+               break;
        }
-       if (status_bits & AUDIO_STATUS_V)
+       if (audio.status_bits & AUDIO_STATUS_V)
                iec |= 0x5 << 16;
-
        WREG32_P(HDMI0_60958_1 + offset, iec, ~0x5000f);
 
-       /* 0x021 or 0x031 sets the audio frame length */
-       WREG32(HDMI0_VBI_PACKET_CONTROL + offset, 0x31);
-       r600_hdmi_audioinfoframe(encoder, channels-1, 0, 0, 0, 0, 0, 0, 0);
+       r600_hdmi_audioinfoframe(encoder, audio.channels - 1, 0, 0, 0, 0, 0, 0,
+                                0);
 
        r600_hdmi_audio_workaround(encoder);
 }
 
-static void r600_hdmi_assign_block(struct drm_encoder *encoder)
-{
-       struct drm_device *dev = encoder->dev;
-       struct radeon_device *rdev = dev->dev_private;
-       struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
-       struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
-
-       u16 eg_offsets[] = {
-               EVERGREEN_CRTC0_REGISTER_OFFSET,
-               EVERGREEN_CRTC1_REGISTER_OFFSET,
-               EVERGREEN_CRTC2_REGISTER_OFFSET,
-               EVERGREEN_CRTC3_REGISTER_OFFSET,
-               EVERGREEN_CRTC4_REGISTER_OFFSET,
-               EVERGREEN_CRTC5_REGISTER_OFFSET,
-       };
-
-       if (!dig) {
-               dev_err(rdev->dev, "Enabling HDMI on non-dig encoder\n");
-               return;
-       }
-
-       if (ASIC_IS_DCE5(rdev)) {
-               /* TODO */
-       } else if (ASIC_IS_DCE4(rdev)) {
-               if (dig->dig_encoder >= ARRAY_SIZE(eg_offsets)) {
-                       dev_err(rdev->dev, "Enabling HDMI on unknown dig\n");
-                       return;
-               }
-               radeon_encoder->hdmi_offset = eg_offsets[dig->dig_encoder];
-               /* Temp hack for Evergreen until we split r600_hdmi.c
-                * Evergreen first block is 0x7030 instead of 0x7400.
-                */
-               radeon_encoder->hdmi_offset -= 0x3d0;
-       } else if (ASIC_IS_DCE3(rdev)) {
-               radeon_encoder->hdmi_offset = dig->dig_encoder ?
-                       DCE3_HDMI_OFFSET1 : DCE3_HDMI_OFFSET0;
-       } else if (rdev->family >= CHIP_R600) {
-               /* 2 routable blocks, but using dig_encoder should be fine */
-               radeon_encoder->hdmi_offset = dig->dig_encoder ?
-                       DCE2_HDMI_OFFSET1 : DCE2_HDMI_OFFSET0;
-       } else if (rdev->family == CHIP_RS600 || rdev->family == CHIP_RS690 ||
-                  rdev->family == CHIP_RS740) {
-               /* Only 1 routable block */
-               radeon_encoder->hdmi_offset = DCE2_HDMI_OFFSET0;
-       }
-       radeon_encoder->hdmi_enabled = true;
-}
-
 /*
  * enable the HDMI engine
  */
@@ -492,22 +480,17 @@ void r600_hdmi_enable(struct drm_encoder *encoder)
        struct drm_device *dev = encoder->dev;
        struct radeon_device *rdev = dev->dev_private;
        struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
+       struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
        uint32_t offset;
        u32 hdmi;
 
        if (ASIC_IS_DCE5(rdev))
                return;
 
-       if (!radeon_encoder->hdmi_enabled) {
-               r600_hdmi_assign_block(encoder);
-               if (!radeon_encoder->hdmi_enabled) {
-                       dev_warn(rdev->dev, "Could not find HDMI block for "
-                               "0x%x encoder\n", radeon_encoder->encoder_id);
-                       return;
-               }
-       }
-
-       offset = radeon_encoder->hdmi_offset;
+       /* Silent, r600_hdmi_enable will raise WARN for us */
+       if (dig->afmt->enabled)
+               return;
+       offset = dig->afmt->offset;
 
        /* Older chipsets require setting HDMI and routing manually */
        if (rdev->family >= CHIP_R600 && !ASIC_IS_DCE3(rdev)) {
@@ -540,12 +523,14 @@ void r600_hdmi_enable(struct drm_encoder *encoder)
 
        if (rdev->irq.installed) {
                /* if irq is available use it */
-               rdev->irq.afmt[offset == 0 ? 0 : 1] = true;
+               rdev->irq.afmt[dig->afmt->id] = true;
                radeon_irq_set(rdev);
        }
 
+       dig->afmt->enabled = true;
+
        DRM_DEBUG("Enabling HDMI interface @ 0x%04X for encoder 0x%x\n",
-               radeon_encoder->hdmi_offset, radeon_encoder->encoder_id);
+                 offset, radeon_encoder->encoder_id);
 }
 
 /*
@@ -556,22 +541,26 @@ void r600_hdmi_disable(struct drm_encoder *encoder)
        struct drm_device *dev = encoder->dev;
        struct radeon_device *rdev = dev->dev_private;
        struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);
+       struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv;
        uint32_t offset;
 
        if (ASIC_IS_DCE5(rdev))
                return;
 
-       offset = radeon_encoder->hdmi_offset;
-       if (!radeon_encoder->hdmi_enabled) {
-               dev_err(rdev->dev, "Disabling not enabled HDMI\n");
+       /* Called for ATOM_ENCODER_MODE_HDMI only */
+       if (!dig || !dig->afmt) {
+               WARN_ON(1);
                return;
        }
+       if (!dig->afmt->enabled)
+               return;
+       offset = dig->afmt->offset;
 
        DRM_DEBUG("Disabling HDMI interface @ 0x%04X for encoder 0x%x\n",
-               offset, radeon_encoder->encoder_id);
+                 offset, radeon_encoder->encoder_id);
 
        /* disable irq */
-       rdev->irq.afmt[offset == 0 ? 0 : 1] = false;
+       rdev->irq.afmt[dig->afmt->id] = false;
        radeon_irq_set(rdev);
 
        /* Older chipsets not handled by AtomBIOS */
@@ -598,6 +587,5 @@ void r600_hdmi_disable(struct drm_encoder *encoder)
                WREG32(HDMI0_CONTROL + offset, HDMI0_ERROR_ACK);
        }
 
-       radeon_encoder->hdmi_enabled = false;
-       radeon_encoder->hdmi_offset = 0;
+       dig->afmt->enabled = false;
 }