drivers/gpu/drm/i915/intel_audio.c

   1 /*
   2  * Copyright © 2014 Intel Corporation
   3  *
   4  * Permission is hereby granted, free of charge, to any person obtaining a
   5  * copy of this software and associated documentation files (the "Software"),
   6  * to deal in the Software without restriction, including without limitation
   7  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
   8  * and/or sell copies of the Software, and to permit persons to whom the
   9  * Software is furnished to do so, subject to the following conditions:
  10  *
  11  * The above copyright notice and this permission notice (including the next
  12  * paragraph) shall be included in all copies or substantial portions of the
  13  * Software.
  14  *
  15  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  16  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  17  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  18  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  19  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
  20  * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
  21  * DEALINGS IN THE SOFTWARE.
  22  */
  23
  24 #include <linux/kernel.h>
  25 #include <linux/component.h>
  26 #include <drm/i915_component.h>
  27 #include <drm/intel_lpe_audio.h>
  28 #include "intel_drv.h"
  29
  30 #include <drm/drmP.h>
  31 #include <drm/drm_edid.h>
  32 #include "i915_drv.h"
  33
  34 /**
  35  * DOC: High Definition Audio over HDMI and Display Port
  36  *
  37  * The graphics and audio drivers together support High Definition Audio over
  38  * HDMI and Display Port. The audio programming sequences are divided into audio
  39  * codec and controller enable and disable sequences. The graphics driver
  40  * handles the audio codec sequences, while the audio driver handles the audio
  41  * controller sequences.
  42  *
  43  * The disable sequences must be performed before disabling the transcoder or
  44  * port. The enable sequences may only be performed after enabling the
  45  * transcoder and port, and after completed link training. Therefore the audio
  46  * enable/disable sequences are part of the modeset sequence.
  47  *
  48  * The codec and controller sequences could be done either parallel or serial,
  49  * but generally the ELDV/PD change in the codec sequence indicates to the audio
  50  * driver that the controller sequence should start. Indeed, most of the
  51  * co-operation between the graphics and audio drivers is handled via audio
  52  * related registers. (The notable exception is the power management, not
  53  * covered here.)
  54  *
  55  * The struct &i915_audio_component is used to interact between the graphics
  56  * and audio drivers. The struct &i915_audio_component_ops @ops in it is
  57  * defined in graphics driver and called in audio driver. The
  58  * struct &i915_audio_component_audio_ops @audio_ops is called from i915 driver.
  59  */
  60
  61 /* DP N/M table */
  62 #define LC_540M 540000
  63 #define LC_270M 270000
  64 #define LC_162M 162000
  65
  66 struct dp_aud_n_m {
  67         int sample_rate;
  68         int clock;
  69         u16 m;
  70         u16 n;
  71 };
  72
  73 /* Values according to DP 1.4 Table 2-104 */
  74 static const struct dp_aud_n_m dp_aud_n_m[] = {
  75         { 32000, LC_162M, 1024, 10125 },
  76         { 44100, LC_162M, 784, 5625 },
  77         { 48000, LC_162M, 512, 3375 },
  78         { 64000, LC_162M, 2048, 10125 },
  79         { 88200, LC_162M, 1568, 5625 },
  80         { 96000, LC_162M, 1024, 3375 },
  81         { 128000, LC_162M, 4096, 10125 },
  82         { 176400, LC_162M, 3136, 5625 },
  83         { 192000, LC_162M, 2048, 3375 },
  84         { 32000, LC_270M, 1024, 16875 },
  85         { 44100, LC_270M, 784, 9375 },
  86         { 48000, LC_270M, 512, 5625 },
  87         { 64000, LC_270M, 2048, 16875 },
  88         { 88200, LC_270M, 1568, 9375 },
  89         { 96000, LC_270M, 1024, 5625 },
  90         { 128000, LC_270M, 4096, 16875 },
  91         { 176400, LC_270M, 3136, 9375 },
  92         { 192000, LC_270M, 2048, 5625 },
  93         { 32000, LC_540M, 1024, 33750 },
  94         { 44100, LC_540M, 784, 18750 },
  95         { 48000, LC_540M, 512, 11250 },
  96         { 64000, LC_540M, 2048, 33750 },
  97         { 88200, LC_540M, 1568, 18750 },
  98         { 96000, LC_540M, 1024, 11250 },
  99         { 128000, LC_540M, 4096, 33750 },
 100         { 176400, LC_540M, 3136, 18750 },
 101         { 192000, LC_540M, 2048, 11250 },
 102 };
 103
 104 static const struct dp_aud_n_m *
 105 audio_config_dp_get_n_m(struct intel_crtc *intel_crtc, int rate)
 106 {
 107         int i;
 108
 109         for (i = 0; i < ARRAY_SIZE(dp_aud_n_m); i++) {
 110                 if (rate == dp_aud_n_m[i].sample_rate &&
 111                     intel_crtc->config->port_clock == dp_aud_n_m[i].clock)
 112                         return &dp_aud_n_m[i];
 113         }
 114
 115         return NULL;
 116 }
 117
 118 static const struct {
 119         int clock;
 120         u32 config;
 121 } hdmi_audio_clock[] = {
 122         { 25175, AUD_CONFIG_PIXEL_CLOCK_HDMI_25175 },
 123         { 25200, AUD_CONFIG_PIXEL_CLOCK_HDMI_25200 }, /* default per bspec */
 124         { 27000, AUD_CONFIG_PIXEL_CLOCK_HDMI_27000 },
 125         { 27027, AUD_CONFIG_PIXEL_CLOCK_HDMI_27027 },
 126         { 54000, AUD_CONFIG_PIXEL_CLOCK_HDMI_54000 },
 127         { 54054, AUD_CONFIG_PIXEL_CLOCK_HDMI_54054 },
 128         { 74176, AUD_CONFIG_PIXEL_CLOCK_HDMI_74176 },
 129         { 74250, AUD_CONFIG_PIXEL_CLOCK_HDMI_74250 },
 130         { 148352, AUD_CONFIG_PIXEL_CLOCK_HDMI_148352 },
 131         { 148500, AUD_CONFIG_PIXEL_CLOCK_HDMI_148500 },
 132 };
 133
 134 /* HDMI N/CTS table */
 135 #define TMDS_297M 297000
 136 #define TMDS_296M 296703
 137 static const struct {
 138         int sample_rate;
 139         int clock;
 140         int n;
 141         int cts;
 142 } hdmi_aud_ncts[] = {
 143         { 44100, TMDS_296M, 4459, 234375 },
 144         { 44100, TMDS_297M, 4704, 247500 },
 145         { 48000, TMDS_296M, 5824, 281250 },
 146         { 48000, TMDS_297M, 5120, 247500 },
 147         { 32000, TMDS_296M, 5824, 421875 },
 148         { 32000, TMDS_297M, 3072, 222750 },
 149         { 88200, TMDS_296M, 8918, 234375 },
 150         { 88200, TMDS_297M, 9408, 247500 },
 151         { 96000, TMDS_296M, 11648, 281250 },
 152         { 96000, TMDS_297M, 10240, 247500 },
 153         { 176400, TMDS_296M, 17836, 234375 },
 154         { 176400, TMDS_297M, 18816, 247500 },
 155         { 192000, TMDS_296M, 23296, 281250 },
 156         { 192000, TMDS_297M, 20480, 247500 },
 157 };
 158
 159 /* get AUD_CONFIG_PIXEL_CLOCK_HDMI_* value for mode */
 160 static u32 audio_config_hdmi_pixel_clock(const struct drm_display_mode *adjusted_mode)
 161 {
 162         int i;
 163
 164         for (i = 0; i < ARRAY_SIZE(hdmi_audio_clock); i++) {
 165                 if (adjusted_mode->crtc_clock == hdmi_audio_clock[i].clock)
 166                         break;
 167         }
 168
 169         if (i == ARRAY_SIZE(hdmi_audio_clock)) {
 170                 DRM_DEBUG_KMS("HDMI audio pixel clock setting for %d not found, falling back to defaults\n",
 171                               adjusted_mode->crtc_clock);
 172                 i = 1;
 173         }
 174
 175         DRM_DEBUG_KMS("Configuring HDMI audio for pixel clock %d (0x%08x)\n",
 176                       hdmi_audio_clock[i].clock,
 177                       hdmi_audio_clock[i].config);
 178
 179         return hdmi_audio_clock[i].config;
 180 }
 181
 182 static int audio_config_hdmi_get_n(const struct drm_display_mode *adjusted_mode,
 183                                    int rate)
 184 {
 185         int i;
 186
 187         for (i = 0; i < ARRAY_SIZE(hdmi_aud_ncts); i++) {
 188                 if (rate == hdmi_aud_ncts[i].sample_rate &&
 189                     adjusted_mode->crtc_clock == hdmi_aud_ncts[i].clock) {
 190                         return hdmi_aud_ncts[i].n;
 191                 }
 192         }
 193         return 0;
 194 }
 195
 196 static bool intel_eld_uptodate(struct drm_connector *connector,
 197                                i915_reg_t reg_eldv, uint32_t bits_eldv,
 198                                i915_reg_t reg_elda, uint32_t bits_elda,
 199                                i915_reg_t reg_edid)
 200 {
 201         struct drm_i915_private *dev_priv = to_i915(connector->dev);
 202         uint8_t *eld = connector->eld;
 203         uint32_t tmp;
 204         int i;
 205
 206         tmp = I915_READ(reg_eldv);
 207         tmp &= bits_eldv;
 208
 209         if (!tmp)
 210                 return false;
 211
 212         tmp = I915_READ(reg_elda);
 213         tmp &= ~bits_elda;
 214         I915_WRITE(reg_elda, tmp);
 215
 216         for (i = 0; i < drm_eld_size(eld) / 4; i++)
 217                 if (I915_READ(reg_edid) != *((uint32_t *)eld + i))
 218                         return false;
 219
 220         return true;
 221 }
 222
 223 static void g4x_audio_codec_disable(struct intel_encoder *encoder)
 224 {
 225         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
 226         uint32_t eldv, tmp;
 227
 228         DRM_DEBUG_KMS("Disable audio codec\n");
 229
 230         tmp = I915_READ(G4X_AUD_VID_DID);
 231         if (tmp == INTEL_AUDIO_DEVBLC || tmp == INTEL_AUDIO_DEVCL)
 232                 eldv = G4X_ELDV_DEVCL_DEVBLC;
 233         else
 234                 eldv = G4X_ELDV_DEVCTG;
 235
 236         /* Invalidate ELD */
 237         tmp = I915_READ(G4X_AUD_CNTL_ST);
 238         tmp &= ~eldv;
 239         I915_WRITE(G4X_AUD_CNTL_ST, tmp);
 240 }
 241
 242 static void g4x_audio_codec_enable(struct drm_connector *connector,
 243                                    struct intel_encoder *encoder,
 244                                    const struct drm_display_mode *adjusted_mode)
 245 {
 246         struct drm_i915_private *dev_priv = to_i915(connector->dev);
 247         uint8_t *eld = connector->eld;
 248         uint32_t eldv;
 249         uint32_t tmp;
 250         int len, i;
 251
 252         DRM_DEBUG_KMS("Enable audio codec, %u bytes ELD\n", eld[2]);
 253
 254         tmp = I915_READ(G4X_AUD_VID_DID);
 255         if (tmp == INTEL_AUDIO_DEVBLC || tmp == INTEL_AUDIO_DEVCL)
 256                 eldv = G4X_ELDV_DEVCL_DEVBLC;
 257         else
 258                 eldv = G4X_ELDV_DEVCTG;
 259
 260         if (intel_eld_uptodate(connector,
 261                                G4X_AUD_CNTL_ST, eldv,
 262                                G4X_AUD_CNTL_ST, G4X_ELD_ADDR_MASK,
 263                                G4X_HDMIW_HDMIEDID))
 264                 return;
 265
 266         tmp = I915_READ(G4X_AUD_CNTL_ST);
 267         tmp &= ~(eldv | G4X_ELD_ADDR_MASK);
 268         len = (tmp >> 9) & 0x1f;                /* ELD buffer size */
 269         I915_WRITE(G4X_AUD_CNTL_ST, tmp);
 270
 271         len = min(drm_eld_size(eld) / 4, len);
 272         DRM_DEBUG_DRIVER("ELD size %d\n", len);
 273         for (i = 0; i < len; i++)
 274                 I915_WRITE(G4X_HDMIW_HDMIEDID, *((uint32_t *)eld + i));
 275
 276         tmp = I915_READ(G4X_AUD_CNTL_ST);
 277         tmp |= eldv;
 278         I915_WRITE(G4X_AUD_CNTL_ST, tmp);
 279 }
 280
 281 static void
 282 hsw_dp_audio_config_update(struct intel_crtc *intel_crtc, enum port port,
 283                            const struct drm_display_mode *adjusted_mode)
 284 {
 285         struct drm_i915_private *dev_priv = to_i915(intel_crtc->base.dev);
 286         struct i915_audio_component *acomp = dev_priv->audio_component;
 287         int rate = acomp ? acomp->aud_sample_rate[port] : 0;
 288         const struct dp_aud_n_m *nm = audio_config_dp_get_n_m(intel_crtc, rate);
 289         enum pipe pipe = intel_crtc->pipe;
 290         u32 tmp;
 291
 292         if (nm)
 293                 DRM_DEBUG_KMS("using Maud %u, Naud %u\n", nm->m, nm->n);
 294         else
 295                 DRM_DEBUG_KMS("using automatic Maud, Naud\n");
 296
 297         tmp = I915_READ(HSW_AUD_CFG(pipe));
 298         tmp &= ~AUD_CONFIG_N_VALUE_INDEX;
 299         tmp &= ~AUD_CONFIG_PIXEL_CLOCK_HDMI_MASK;
 300         tmp &= ~AUD_CONFIG_N_PROG_ENABLE;
 301         tmp |= AUD_CONFIG_N_VALUE_INDEX;
 302
 303         if (nm) {
 304                 tmp &= ~AUD_CONFIG_N_MASK;
 305                 tmp |= AUD_CONFIG_N(nm->n);
 306                 tmp |= AUD_CONFIG_N_PROG_ENABLE;
 307         }
 308
 309         I915_WRITE(HSW_AUD_CFG(pipe), tmp);
 310
 311         tmp = I915_READ(HSW_AUD_M_CTS_ENABLE(pipe));
 312         tmp &= ~AUD_CONFIG_M_MASK;
 313         tmp &= ~AUD_M_CTS_M_VALUE_INDEX;
 314         tmp &= ~AUD_M_CTS_M_PROG_ENABLE;
 315
 316         if (nm) {
 317                 tmp |= nm->m;
 318                 tmp |= AUD_M_CTS_M_VALUE_INDEX;
 319                 tmp |= AUD_M_CTS_M_PROG_ENABLE;
 320         }
 321
 322         I915_WRITE(HSW_AUD_M_CTS_ENABLE(pipe), tmp);
 323 }
 324
 325 static void
 326 hsw_hdmi_audio_config_update(struct intel_crtc *intel_crtc, enum port port,
 327                              const struct drm_display_mode *adjusted_mode)
 328 {
 329         struct drm_i915_private *dev_priv = to_i915(intel_crtc->base.dev);
 330         struct i915_audio_component *acomp = dev_priv->audio_component;
 331         int rate = acomp ? acomp->aud_sample_rate[port] : 0;
 332         enum pipe pipe = intel_crtc->pipe;
 333         int n;
 334         u32 tmp;
 335
 336         tmp = I915_READ(HSW_AUD_CFG(pipe));
 337         tmp &= ~AUD_CONFIG_N_VALUE_INDEX;
 338         tmp &= ~AUD_CONFIG_PIXEL_CLOCK_HDMI_MASK;
 339         tmp &= ~AUD_CONFIG_N_PROG_ENABLE;
 340         tmp |= audio_config_hdmi_pixel_clock(adjusted_mode);
 341
 342         n = audio_config_hdmi_get_n(adjusted_mode, rate);
 343         if (n != 0) {
 344                 DRM_DEBUG_KMS("using N %d\n", n);
 345
 346                 tmp &= ~AUD_CONFIG_N_MASK;
 347                 tmp |= AUD_CONFIG_N(n);
 348                 tmp |= AUD_CONFIG_N_PROG_ENABLE;
 349         } else {
 350                 DRM_DEBUG_KMS("using automatic N\n");
 351         }
 352
 353         I915_WRITE(HSW_AUD_CFG(pipe), tmp);
 354
 355         /*
 356          * Let's disable "Enable CTS or M Prog bit"
 357          * and let HW calculate the value
 358          */
 359         tmp = I915_READ(HSW_AUD_M_CTS_ENABLE(pipe));
 360         tmp &= ~AUD_M_CTS_M_PROG_ENABLE;
 361         tmp &= ~AUD_M_CTS_M_VALUE_INDEX;
 362         I915_WRITE(HSW_AUD_M_CTS_ENABLE(pipe), tmp);
 363 }
 364
 365 static void
 366 hsw_audio_config_update(struct intel_crtc *intel_crtc, enum port port,
 367                         const struct drm_display_mode *adjusted_mode)
 368 {
 369         if (intel_crtc_has_dp_encoder(intel_crtc->config))
 370                 hsw_dp_audio_config_update(intel_crtc, port, adjusted_mode);
 371         else
 372                 hsw_hdmi_audio_config_update(intel_crtc, port, adjusted_mode);
 373 }
 374
 375 static void hsw_audio_codec_disable(struct intel_encoder *encoder)
 376 {
 377         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
 378         struct intel_crtc *intel_crtc = to_intel_crtc(encoder->base.crtc);
 379         enum pipe pipe = intel_crtc->pipe;
 380         uint32_t tmp;
 381
 382         DRM_DEBUG_KMS("Disable audio codec on pipe %c\n", pipe_name(pipe));
 383
 384         mutex_lock(&dev_priv->av_mutex);
 385
 386         /* Disable timestamps */
 387         tmp = I915_READ(HSW_AUD_CFG(pipe));
 388         tmp &= ~AUD_CONFIG_N_VALUE_INDEX;
 389         tmp |= AUD_CONFIG_N_PROG_ENABLE;
 390         tmp &= ~AUD_CONFIG_UPPER_N_MASK;
 391         tmp &= ~AUD_CONFIG_LOWER_N_MASK;
 392         if (intel_crtc_has_dp_encoder(intel_crtc->config))
 393                 tmp |= AUD_CONFIG_N_VALUE_INDEX;
 394         I915_WRITE(HSW_AUD_CFG(pipe), tmp);
 395
 396         /* Invalidate ELD */
 397         tmp = I915_READ(HSW_AUD_PIN_ELD_CP_VLD);
 398         tmp &= ~AUDIO_ELD_VALID(pipe);
 399         tmp &= ~AUDIO_OUTPUT_ENABLE(pipe);
 400         I915_WRITE(HSW_AUD_PIN_ELD_CP_VLD, tmp);
 401
 402         mutex_unlock(&dev_priv->av_mutex);
 403 }
 404
 405 static void hsw_audio_codec_enable(struct drm_connector *connector,
 406                                    struct intel_encoder *intel_encoder,
 407                                    const struct drm_display_mode *adjusted_mode)
 408 {
 409         struct drm_i915_private *dev_priv = to_i915(connector->dev);
 410         struct intel_crtc *intel_crtc = to_intel_crtc(intel_encoder->base.crtc);
 411         enum pipe pipe = intel_crtc->pipe;
 412         enum port port = intel_encoder->port;
 413         const uint8_t *eld = connector->eld;
 414         uint32_t tmp;
 415         int len, i;
 416
 417         DRM_DEBUG_KMS("Enable audio codec on pipe %c, %u bytes ELD\n",
 418                       pipe_name(pipe), drm_eld_size(eld));
 419
 420         mutex_lock(&dev_priv->av_mutex);
 421
 422         /* Enable audio presence detect, invalidate ELD */
 423         tmp = I915_READ(HSW_AUD_PIN_ELD_CP_VLD);
 424         tmp |= AUDIO_OUTPUT_ENABLE(pipe);
 425         tmp &= ~AUDIO_ELD_VALID(pipe);
 426         I915_WRITE(HSW_AUD_PIN_ELD_CP_VLD, tmp);
 427
 428         /*
 429          * FIXME: We're supposed to wait for vblank here, but we have vblanks
 430          * disabled during the mode set. The proper fix would be to push the
 431          * rest of the setup into a vblank work item, queued here, but the
 432          * infrastructure is not there yet.
 433          */
 434
 435         /* Reset ELD write address */
 436         tmp = I915_READ(HSW_AUD_DIP_ELD_CTRL(pipe));
 437         tmp &= ~IBX_ELD_ADDRESS_MASK;
 438         I915_WRITE(HSW_AUD_DIP_ELD_CTRL(pipe), tmp);
 439
 440         /* Up to 84 bytes of hw ELD buffer */
 441         len = min(drm_eld_size(eld), 84);
 442         for (i = 0; i < len / 4; i++)
 443                 I915_WRITE(HSW_AUD_EDID_DATA(pipe), *((uint32_t *)eld + i));
 444
 445         /* ELD valid */
 446         tmp = I915_READ(HSW_AUD_PIN_ELD_CP_VLD);
 447         tmp |= AUDIO_ELD_VALID(pipe);
 448         I915_WRITE(HSW_AUD_PIN_ELD_CP_VLD, tmp);
 449
 450         /* Enable timestamps */
 451         hsw_audio_config_update(intel_crtc, port, adjusted_mode);
 452
 453         mutex_unlock(&dev_priv->av_mutex);
 454 }
 455
 456 static void ilk_audio_codec_disable(struct intel_encoder *intel_encoder)
 457 {
 458         struct drm_i915_private *dev_priv = to_i915(intel_encoder->base.dev);
 459         struct intel_crtc *intel_crtc = to_intel_crtc(intel_encoder->base.crtc);
 460         enum pipe pipe = intel_crtc->pipe;
 461         enum port port = intel_encoder->port;
 462         uint32_t tmp, eldv;
 463         i915_reg_t aud_config, aud_cntrl_st2;
 464
 465         DRM_DEBUG_KMS("Disable audio codec on port %c, pipe %c\n",
 466                       port_name(port), pipe_name(pipe));
 467
 468         if (WARN_ON(port == PORT_A))
 469                 return;
 470
 471         if (HAS_PCH_IBX(dev_priv)) {
 472                 aud_config = IBX_AUD_CFG(pipe);
 473                 aud_cntrl_st2 = IBX_AUD_CNTL_ST2;
 474         } else if (IS_VALLEYVIEW(dev_priv) || IS_CHERRYVIEW(dev_priv)) {
 475                 aud_config = VLV_AUD_CFG(pipe);
 476                 aud_cntrl_st2 = VLV_AUD_CNTL_ST2;
 477         } else {
 478                 aud_config = CPT_AUD_CFG(pipe);
 479                 aud_cntrl_st2 = CPT_AUD_CNTRL_ST2;
 480         }
 481
 482         /* Disable timestamps */
 483         tmp = I915_READ(aud_config);
 484         tmp &= ~AUD_CONFIG_N_VALUE_INDEX;
 485         tmp |= AUD_CONFIG_N_PROG_ENABLE;
 486         tmp &= ~AUD_CONFIG_UPPER_N_MASK;
 487         tmp &= ~AUD_CONFIG_LOWER_N_MASK;
 488         if (intel_crtc_has_dp_encoder(intel_crtc->config))
 489                 tmp |= AUD_CONFIG_N_VALUE_INDEX;
 490         I915_WRITE(aud_config, tmp);
 491
 492         eldv = IBX_ELD_VALID(port);
 493
 494         /* Invalidate ELD */
 495         tmp = I915_READ(aud_cntrl_st2);
 496         tmp &= ~eldv;
 497         I915_WRITE(aud_cntrl_st2, tmp);
 498 }
 499
 500 static void ilk_audio_codec_enable(struct drm_connector *connector,
 501                                    struct intel_encoder *intel_encoder,
 502                                    const struct drm_display_mode *adjusted_mode)
 503 {
 504         struct drm_i915_private *dev_priv = to_i915(connector->dev);
 505         struct intel_crtc *intel_crtc = to_intel_crtc(intel_encoder->base.crtc);
 506         enum pipe pipe = intel_crtc->pipe;
 507         enum port port = intel_encoder->port;
 508         uint8_t *eld = connector->eld;
 509         uint32_t tmp, eldv;
 510         int len, i;
 511         i915_reg_t hdmiw_hdmiedid, aud_config, aud_cntl_st, aud_cntrl_st2;
 512
 513         DRM_DEBUG_KMS("Enable audio codec on port %c, pipe %c, %u bytes ELD\n",
 514                       port_name(port), pipe_name(pipe), drm_eld_size(eld));
 515
 516         if (WARN_ON(port == PORT_A))
 517                 return;
 518
 519         /*
 520          * FIXME: We're supposed to wait for vblank here, but we have vblanks
 521          * disabled during the mode set. The proper fix would be to push the
 522          * rest of the setup into a vblank work item, queued here, but the
 523          * infrastructure is not there yet.
 524          */
 525
 526         if (HAS_PCH_IBX(dev_priv)) {
 527                 hdmiw_hdmiedid = IBX_HDMIW_HDMIEDID(pipe);
 528                 aud_config = IBX_AUD_CFG(pipe);
 529                 aud_cntl_st = IBX_AUD_CNTL_ST(pipe);
 530                 aud_cntrl_st2 = IBX_AUD_CNTL_ST2;
 531         } else if (IS_VALLEYVIEW(dev_priv) ||
 532                    IS_CHERRYVIEW(dev_priv)) {
 533                 hdmiw_hdmiedid = VLV_HDMIW_HDMIEDID(pipe);
 534                 aud_config = VLV_AUD_CFG(pipe);
 535                 aud_cntl_st = VLV_AUD_CNTL_ST(pipe);
 536                 aud_cntrl_st2 = VLV_AUD_CNTL_ST2;
 537         } else {
 538                 hdmiw_hdmiedid = CPT_HDMIW_HDMIEDID(pipe);
 539                 aud_config = CPT_AUD_CFG(pipe);
 540                 aud_cntl_st = CPT_AUD_CNTL_ST(pipe);
 541                 aud_cntrl_st2 = CPT_AUD_CNTRL_ST2;
 542         }
 543
 544         eldv = IBX_ELD_VALID(port);
 545
 546         /* Invalidate ELD */
 547         tmp = I915_READ(aud_cntrl_st2);
 548         tmp &= ~eldv;
 549         I915_WRITE(aud_cntrl_st2, tmp);
 550
 551         /* Reset ELD write address */
 552         tmp = I915_READ(aud_cntl_st);
 553         tmp &= ~IBX_ELD_ADDRESS_MASK;
 554         I915_WRITE(aud_cntl_st, tmp);
 555
 556         /* Up to 84 bytes of hw ELD buffer */
 557         len = min(drm_eld_size(eld), 84);
 558         for (i = 0; i < len / 4; i++)
 559                 I915_WRITE(hdmiw_hdmiedid, *((uint32_t *)eld + i));
 560
 561         /* ELD valid */
 562         tmp = I915_READ(aud_cntrl_st2);
 563         tmp |= eldv;
 564         I915_WRITE(aud_cntrl_st2, tmp);
 565
 566         /* Enable timestamps */
 567         tmp = I915_READ(aud_config);
 568         tmp &= ~AUD_CONFIG_N_VALUE_INDEX;
 569         tmp &= ~AUD_CONFIG_N_PROG_ENABLE;
 570         tmp &= ~AUD_CONFIG_PIXEL_CLOCK_HDMI_MASK;
 571         if (intel_crtc_has_dp_encoder(intel_crtc->config))
 572                 tmp |= AUD_CONFIG_N_VALUE_INDEX;
 573         else
 574                 tmp |= audio_config_hdmi_pixel_clock(adjusted_mode);
 575         I915_WRITE(aud_config, tmp);
 576 }
 577
 578 /**
 579  * intel_audio_codec_enable - Enable the audio codec for HD audio
 580  * @intel_encoder: encoder on which to enable audio
 581  * @crtc_state: pointer to the current crtc state.
 582  * @conn_state: pointer to the current connector state.
 583  *
 584  * The enable sequences may only be performed after enabling the transcoder and
 585  * port, and after completed link training.
 586  */
 587 void intel_audio_codec_enable(struct intel_encoder *intel_encoder,
 588                               const struct intel_crtc_state *crtc_state,
 589                               const struct drm_connector_state *conn_state)
 590 {
 591         struct drm_encoder *encoder = &intel_encoder->base;
 592         const struct drm_display_mode *adjusted_mode = &crtc_state->base.adjusted_mode;
 593         struct drm_connector *connector;
 594         struct drm_i915_private *dev_priv = to_i915(encoder->dev);
 595         struct i915_audio_component *acomp = dev_priv->audio_component;
 596         enum port port = intel_encoder->port;
 597         enum pipe pipe = to_intel_crtc(crtc_state->base.crtc)->pipe;
 598
 599         connector = conn_state->connector;
 600         if (!connector || !connector->eld[0])
 601                 return;
 602
 603         DRM_DEBUG_DRIVER("ELD on [CONNECTOR:%d:%s], [ENCODER:%d:%s]\n",
 604                          connector->base.id,
 605                          connector->name,
 606                          connector->encoder->base.id,
 607                          connector->encoder->name);
 608
 609         connector->eld[6] = drm_av_sync_delay(connector, adjusted_mode) / 2;
 610
 611         if (dev_priv->display.audio_codec_enable)
 612                 dev_priv->display.audio_codec_enable(connector, intel_encoder,
 613                                                      adjusted_mode);
 614
 615         mutex_lock(&dev_priv->av_mutex);
 616         intel_encoder->audio_connector = connector;
 617
 618         /* referred in audio callbacks */
 619         dev_priv->av_enc_map[pipe] = intel_encoder;
 620         mutex_unlock(&dev_priv->av_mutex);
 621
 622         if (acomp && acomp->audio_ops && acomp->audio_ops->pin_eld_notify) {
 623                 /* audio drivers expect pipe = -1 to indicate Non-MST cases */
 624                 if (intel_encoder->type != INTEL_OUTPUT_DP_MST)
 625                         pipe = -1;
 626                 acomp->audio_ops->pin_eld_notify(acomp->audio_ops->audio_ptr,
 627                                                  (int) port, (int) pipe);
 628         }
 629
 630         intel_lpe_audio_notify(dev_priv, pipe, port, connector->eld,
 631                                crtc_state->port_clock,
 632                                intel_encoder->type == INTEL_OUTPUT_DP);
 633 }
 634
 635 /**
 636  * intel_audio_codec_disable - Disable the audio codec for HD audio
 637  * @intel_encoder: encoder on which to disable audio
 638  *
 639  * The disable sequences must be performed before disabling the transcoder or
 640  * port.
 641  */
 642 void intel_audio_codec_disable(struct intel_encoder *intel_encoder)
 643 {
 644         struct drm_encoder *encoder = &intel_encoder->base;
 645         struct drm_i915_private *dev_priv = to_i915(encoder->dev);
 646         struct i915_audio_component *acomp = dev_priv->audio_component;
 647         enum port port = intel_encoder->port;
 648         struct intel_crtc *crtc = to_intel_crtc(encoder->crtc);
 649         enum pipe pipe = crtc->pipe;
 650
 651         if (dev_priv->display.audio_codec_disable)
 652                 dev_priv->display.audio_codec_disable(intel_encoder);
 653
 654         mutex_lock(&dev_priv->av_mutex);
 655         intel_encoder->audio_connector = NULL;
 656         dev_priv->av_enc_map[pipe] = NULL;
 657         mutex_unlock(&dev_priv->av_mutex);
 658
 659         if (acomp && acomp->audio_ops && acomp->audio_ops->pin_eld_notify) {
 660                 /* audio drivers expect pipe = -1 to indicate Non-MST cases */
 661                 if (intel_encoder->type != INTEL_OUTPUT_DP_MST)
 662                         pipe = -1;
 663                 acomp->audio_ops->pin_eld_notify(acomp->audio_ops->audio_ptr,
 664                                                  (int) port, (int) pipe);
 665         }
 666
 667         intel_lpe_audio_notify(dev_priv, pipe, port, NULL, 0, false);
 668 }
 669
 670 /**
 671  * intel_init_audio_hooks - Set up chip specific audio hooks
 672  * @dev_priv: device private
 673  */
 674 void intel_init_audio_hooks(struct drm_i915_private *dev_priv)
 675 {
 676         if (IS_G4X(dev_priv)) {
 677                 dev_priv->display.audio_codec_enable = g4x_audio_codec_enable;
 678                 dev_priv->display.audio_codec_disable = g4x_audio_codec_disable;
 679         } else if (IS_VALLEYVIEW(dev_priv) || IS_CHERRYVIEW(dev_priv)) {
 680                 dev_priv->display.audio_codec_enable = ilk_audio_codec_enable;
 681                 dev_priv->display.audio_codec_disable = ilk_audio_codec_disable;
 682         } else if (IS_HASWELL(dev_priv) || INTEL_INFO(dev_priv)->gen >= 8) {
 683                 dev_priv->display.audio_codec_enable = hsw_audio_codec_enable;
 684                 dev_priv->display.audio_codec_disable = hsw_audio_codec_disable;
 685         } else if (HAS_PCH_SPLIT(dev_priv)) {
 686                 dev_priv->display.audio_codec_enable = ilk_audio_codec_enable;
 687                 dev_priv->display.audio_codec_disable = ilk_audio_codec_disable;
 688         }
 689 }
 690
 691 static void i915_audio_component_get_power(struct device *kdev)
 692 {
 693         intel_display_power_get(kdev_to_i915(kdev), POWER_DOMAIN_AUDIO);
 694 }
 695
 696 static void i915_audio_component_put_power(struct device *kdev)
 697 {
 698         intel_display_power_put(kdev_to_i915(kdev), POWER_DOMAIN_AUDIO);
 699 }
 700
 701 static void i915_audio_component_codec_wake_override(struct device *kdev,
 702                                                      bool enable)
 703 {
 704         struct drm_i915_private *dev_priv = kdev_to_i915(kdev);
 705         u32 tmp;
 706
 707         if (!IS_GEN9_BC(dev_priv))
 708                 return;
 709
 710         i915_audio_component_get_power(kdev);
 711
 712         /*
 713          * Enable/disable generating the codec wake signal, overriding the
 714          * internal logic to generate the codec wake to controller.
 715          */
 716         tmp = I915_READ(HSW_AUD_CHICKENBIT);
 717         tmp &= ~SKL_AUD_CODEC_WAKE_SIGNAL;
 718         I915_WRITE(HSW_AUD_CHICKENBIT, tmp);
 719         usleep_range(1000, 1500);
 720
 721         if (enable) {
 722                 tmp = I915_READ(HSW_AUD_CHICKENBIT);
 723                 tmp |= SKL_AUD_CODEC_WAKE_SIGNAL;
 724                 I915_WRITE(HSW_AUD_CHICKENBIT, tmp);
 725                 usleep_range(1000, 1500);
 726         }
 727
 728         i915_audio_component_put_power(kdev);
 729 }
 730
 731 /* Get CDCLK in kHz  */
 732 static int i915_audio_component_get_cdclk_freq(struct device *kdev)
 733 {
 734         struct drm_i915_private *dev_priv = kdev_to_i915(kdev);
 735
 736         if (WARN_ON_ONCE(!HAS_DDI(dev_priv)))
 737                 return -ENODEV;
 738
 739         return dev_priv->cdclk.hw.cdclk;
 740 }
 741
 742 /*
 743  * get the intel_encoder according to the parameter port and pipe
 744  * intel_encoder is saved by the index of pipe
 745  * MST & (pipe >= 0): return the av_enc_map[pipe],
 746  *   when port is matched
 747  * MST & (pipe < 0): this is invalid
 748  * Non-MST & (pipe >= 0): only pipe = 0 (the first device entry)
 749  *   will get the right intel_encoder with port matched
 750  * Non-MST & (pipe < 0): get the right intel_encoder with port matched
 751  */
 752 static struct intel_encoder *get_saved_enc(struct drm_i915_private *dev_priv,
 753                                                int port, int pipe)
 754 {
 755         struct intel_encoder *encoder;
 756
 757         if (WARN_ON(pipe >= I915_MAX_PIPES))
 758                 return NULL;
 759
 760         /* MST */
 761         if (pipe >= 0) {
 762                 encoder = dev_priv->av_enc_map[pipe];
 763                 /*
 764                  * when bootup, audio driver may not know it is
 765                  * MST or not. So it will poll all the port & pipe
 766                  * combinations
 767                  */
 768                 if (encoder != NULL && encoder->port == port &&
 769                     encoder->type == INTEL_OUTPUT_DP_MST)
 770                         return encoder;
 771         }
 772
 773         /* Non-MST */
 774         if (pipe > 0)
 775                 return NULL;
 776
 777         for_each_pipe(dev_priv, pipe) {
 778                 encoder = dev_priv->av_enc_map[pipe];
 779                 if (encoder == NULL)
 780                         continue;
 781
 782                 if (encoder->type == INTEL_OUTPUT_DP_MST)
 783                         continue;
 784
 785                 if (port == encoder->port)
 786                         return encoder;
 787         }
 788
 789         return NULL;
 790 }
 791
 792 static int i915_audio_component_sync_audio_rate(struct device *kdev, int port,
 793                                                 int pipe, int rate)
 794 {
 795         struct drm_i915_private *dev_priv = kdev_to_i915(kdev);
 796         struct intel_encoder *intel_encoder;
 797         struct intel_crtc *crtc;
 798         struct drm_display_mode *adjusted_mode;
 799         struct i915_audio_component *acomp = dev_priv->audio_component;
 800         int err = 0;
 801
 802         if (!HAS_DDI(dev_priv))
 803                 return 0;
 804
 805         i915_audio_component_get_power(kdev);
 806         mutex_lock(&dev_priv->av_mutex);
 807
 808         /* 1. get the pipe */
 809         intel_encoder = get_saved_enc(dev_priv, port, pipe);
 810         if (!intel_encoder || !intel_encoder->base.crtc) {
 811                 DRM_DEBUG_KMS("Not valid for port %c\n", port_name(port));
 812                 err = -ENODEV;
 813                 goto unlock;
 814         }
 815
 816         /* pipe passed from the audio driver will be -1 for Non-MST case */
 817         crtc = to_intel_crtc(intel_encoder->base.crtc);
 818         pipe = crtc->pipe;
 819
 820         adjusted_mode = &crtc->config->base.adjusted_mode;
 821
 822         /* port must be valid now, otherwise the pipe will be invalid */
 823         acomp->aud_sample_rate[port] = rate;
 824
 825         hsw_audio_config_update(crtc, port, adjusted_mode);
 826
 827  unlock:
 828         mutex_unlock(&dev_priv->av_mutex);
 829         i915_audio_component_put_power(kdev);
 830         return err;
 831 }
 832
 833 static int i915_audio_component_get_eld(struct device *kdev, int port,
 834                                         int pipe, bool *enabled,
 835                                         unsigned char *buf, int max_bytes)
 836 {
 837         struct drm_i915_private *dev_priv = kdev_to_i915(kdev);
 838         struct intel_encoder *intel_encoder;
 839         const u8 *eld;
 840         int ret = -EINVAL;
 841
 842         mutex_lock(&dev_priv->av_mutex);
 843
 844         intel_encoder = get_saved_enc(dev_priv, port, pipe);
 845         if (!intel_encoder) {
 846                 DRM_DEBUG_KMS("Not valid for port %c\n", port_name(port));
 847                 mutex_unlock(&dev_priv->av_mutex);
 848                 return ret;
 849         }
 850
 851         ret = 0;
 852         *enabled = intel_encoder->audio_connector != NULL;
 853         if (*enabled) {
 854                 eld = intel_encoder->audio_connector->eld;
 855                 ret = drm_eld_size(eld);
 856                 memcpy(buf, eld, min(max_bytes, ret));
 857         }
 858
 859         mutex_unlock(&dev_priv->av_mutex);
 860         return ret;
 861 }
 862
 863 static const struct i915_audio_component_ops i915_audio_component_ops = {
 864         .owner          = THIS_MODULE,
 865         .get_power      = i915_audio_component_get_power,
 866         .put_power      = i915_audio_component_put_power,
 867         .codec_wake_override = i915_audio_component_codec_wake_override,
 868         .get_cdclk_freq = i915_audio_component_get_cdclk_freq,
 869         .sync_audio_rate = i915_audio_component_sync_audio_rate,
 870         .get_eld        = i915_audio_component_get_eld,
 871 };
 872
 873 static int i915_audio_component_bind(struct device *i915_kdev,
 874                                      struct device *hda_kdev, void *data)
 875 {
 876         struct i915_audio_component *acomp = data;
 877         struct drm_i915_private *dev_priv = kdev_to_i915(i915_kdev);
 878         int i;
 879
 880         if (WARN_ON(acomp->ops || acomp->dev))
 881                 return -EEXIST;
 882
 883         drm_modeset_lock_all(&dev_priv->drm);
 884         acomp->ops = &i915_audio_component_ops;
 885         acomp->dev = i915_kdev;
 886         BUILD_BUG_ON(MAX_PORTS != I915_MAX_PORTS);
 887         for (i = 0; i < ARRAY_SIZE(acomp->aud_sample_rate); i++)
 888                 acomp->aud_sample_rate[i] = 0;
 889         dev_priv->audio_component = acomp;
 890         drm_modeset_unlock_all(&dev_priv->drm);
 891
 892         return 0;
 893 }
 894
 895 static void i915_audio_component_unbind(struct device *i915_kdev,
 896                                         struct device *hda_kdev, void *data)
 897 {
 898         struct i915_audio_component *acomp = data;
 899         struct drm_i915_private *dev_priv = kdev_to_i915(i915_kdev);
 900
 901         drm_modeset_lock_all(&dev_priv->drm);
 902         acomp->ops = NULL;
 903         acomp->dev = NULL;
 904         dev_priv->audio_component = NULL;
 905         drm_modeset_unlock_all(&dev_priv->drm);
 906 }
 907
 908 static const struct component_ops i915_audio_component_bind_ops = {
 909         .bind   = i915_audio_component_bind,
 910         .unbind = i915_audio_component_unbind,
 911 };
 912
 913 /**
 914  * i915_audio_component_init - initialize and register the audio component
 915  * @dev_priv: i915 device instance
 916  *
 917  * This will register with the component framework a child component which
 918  * will bind dynamically to the snd_hda_intel driver's corresponding master
 919  * component when the latter is registered. During binding the child
 920  * initializes an instance of struct i915_audio_component which it receives
 921  * from the master. The master can then start to use the interface defined by
 922  * this struct. Each side can break the binding at any point by deregistering
 923  * its own component after which each side's component unbind callback is
 924  * called.
 925  *
 926  * We ignore any error during registration and continue with reduced
 927  * functionality (i.e. without HDMI audio).
 928  */
 929 void i915_audio_component_init(struct drm_i915_private *dev_priv)
 930 {
 931         int ret;
 932
 933         if (INTEL_INFO(dev_priv)->num_pipes == 0)
 934                 return;
 935
 936         ret = component_add(dev_priv->drm.dev, &i915_audio_component_bind_ops);
 937         if (ret < 0) {
 938                 DRM_ERROR("failed to add audio component (%d)\n", ret);
 939                 /* continue with reduced functionality */
 940                 return;
 941         }
 942
 943         dev_priv->audio_component_registered = true;
 944 }
 945
 946 /**
 947  * i915_audio_component_cleanup - deregister the audio component
 948  * @dev_priv: i915 device instance
 949  *
 950  * Deregisters the audio component, breaking any existing binding to the
 951  * corresponding snd_hda_intel driver's master component.
 952  */
 953 void i915_audio_component_cleanup(struct drm_i915_private *dev_priv)
 954 {
 955         if (!dev_priv->audio_component_registered)
 956                 return;
 957
 958         component_del(dev_priv->drm.dev, &i915_audio_component_bind_ops);
 959         dev_priv->audio_component_registered = false;
 960 }
 961
 962 /**
 963  * intel_audio_init() - Initialize the audio driver either using
 964  * component framework or using lpe audio bridge
 965  * @dev_priv: the i915 drm device private data
 966  *
 967  */
 968 void intel_audio_init(struct drm_i915_private *dev_priv)
 969 {
 970         if (intel_lpe_audio_init(dev_priv) < 0)
 971                 i915_audio_component_init(dev_priv);
 972 }
 973
 974 /**
 975  * intel_audio_deinit() - deinitialize the audio driver
 976  * @dev_priv: the i915 drm device private data
 977  *
 978  */
 979 void intel_audio_deinit(struct drm_i915_private *dev_priv)
 980 {
 981         if ((dev_priv)->lpe_audio.platdev != NULL)
 982                 intel_lpe_audio_teardown(dev_priv);
 983         else
 984                 i915_audio_component_cleanup(dev_priv);
 985 }