blob: fdc8b2a1d0ae9c68fa667f691bc79d4fc767d4a3 [file] [log] [blame]
Jani Nikula7c10a2b2014-10-27 16:26:43 +02001/*
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>
Imre Deak58fddc22015-01-08 17:54:14 +020025#include <linux/component.h>
26#include <drm/i915_component.h>
27#include "intel_drv.h"
Jani Nikula7c10a2b2014-10-27 16:26:43 +020028
29#include <drm/drmP.h>
30#include <drm/drm_edid.h>
Jani Nikula7c10a2b2014-10-27 16:26:43 +020031#include "i915_drv.h"
32
Jani Nikula28855d22014-10-27 16:27:00 +020033/**
34 * DOC: High Definition Audio over HDMI and Display Port
35 *
36 * The graphics and audio drivers together support High Definition Audio over
37 * HDMI and Display Port. The audio programming sequences are divided into audio
38 * codec and controller enable and disable sequences. The graphics driver
39 * handles the audio codec sequences, while the audio driver handles the audio
40 * controller sequences.
41 *
42 * The disable sequences must be performed before disabling the transcoder or
43 * port. The enable sequences may only be performed after enabling the
Jani Nikula3e6da4a2015-07-02 16:05:27 +030044 * transcoder and port, and after completed link training. Therefore the audio
45 * enable/disable sequences are part of the modeset sequence.
Jani Nikula28855d22014-10-27 16:27:00 +020046 *
47 * The codec and controller sequences could be done either parallel or serial,
48 * but generally the ELDV/PD change in the codec sequence indicates to the audio
49 * driver that the controller sequence should start. Indeed, most of the
50 * co-operation between the graphics and audio drivers is handled via audio
51 * related registers. (The notable exception is the power management, not
52 * covered here.)
Libin Yangcb422612015-10-01 17:01:09 +080053 *
54 * The struct i915_audio_component is used to interact between the graphics
55 * and audio drivers. The struct i915_audio_component_ops *ops in it is
56 * defined in graphics driver and called in audio driver. The
57 * struct i915_audio_component_audio_ops *audio_ops is called from i915 driver.
Jani Nikula28855d22014-10-27 16:27:00 +020058 */
59
Jani Nikula87fcb2a2014-10-27 16:26:44 +020060static const struct {
Jani Nikula7c10a2b2014-10-27 16:26:43 +020061 int clock;
62 u32 config;
63} hdmi_audio_clock[] = {
Ville Syrjälä606bb5e2015-10-08 11:43:34 +030064 { 25175, AUD_CONFIG_PIXEL_CLOCK_HDMI_25175 },
Jani Nikula7c10a2b2014-10-27 16:26:43 +020065 { 25200, AUD_CONFIG_PIXEL_CLOCK_HDMI_25200 }, /* default per bspec */
66 { 27000, AUD_CONFIG_PIXEL_CLOCK_HDMI_27000 },
Ville Syrjälä606bb5e2015-10-08 11:43:34 +030067 { 27027, AUD_CONFIG_PIXEL_CLOCK_HDMI_27027 },
Jani Nikula7c10a2b2014-10-27 16:26:43 +020068 { 54000, AUD_CONFIG_PIXEL_CLOCK_HDMI_54000 },
Ville Syrjälä606bb5e2015-10-08 11:43:34 +030069 { 54054, AUD_CONFIG_PIXEL_CLOCK_HDMI_54054 },
70 { 74176, AUD_CONFIG_PIXEL_CLOCK_HDMI_74176 },
Jani Nikula7c10a2b2014-10-27 16:26:43 +020071 { 74250, AUD_CONFIG_PIXEL_CLOCK_HDMI_74250 },
Ville Syrjälä606bb5e2015-10-08 11:43:34 +030072 { 148352, AUD_CONFIG_PIXEL_CLOCK_HDMI_148352 },
Jani Nikula7c10a2b2014-10-27 16:26:43 +020073 { 148500, AUD_CONFIG_PIXEL_CLOCK_HDMI_148500 },
74};
75
Libin Yang4a21ef72015-09-02 14:11:39 +080076/* HDMI N/CTS table */
77#define TMDS_297M 297000
Ville Syrjälä606bb5e2015-10-08 11:43:34 +030078#define TMDS_296M 296703
Libin Yang4a21ef72015-09-02 14:11:39 +080079static const struct {
80 int sample_rate;
81 int clock;
82 int n;
83 int cts;
84} aud_ncts[] = {
85 { 44100, TMDS_296M, 4459, 234375 },
86 { 44100, TMDS_297M, 4704, 247500 },
87 { 48000, TMDS_296M, 5824, 281250 },
88 { 48000, TMDS_297M, 5120, 247500 },
89 { 32000, TMDS_296M, 5824, 421875 },
90 { 32000, TMDS_297M, 3072, 222750 },
91 { 88200, TMDS_296M, 8918, 234375 },
92 { 88200, TMDS_297M, 9408, 247500 },
93 { 96000, TMDS_296M, 11648, 281250 },
94 { 96000, TMDS_297M, 10240, 247500 },
95 { 176400, TMDS_296M, 17836, 234375 },
96 { 176400, TMDS_297M, 18816, 247500 },
97 { 192000, TMDS_296M, 23296, 281250 },
98 { 192000, TMDS_297M, 20480, 247500 },
99};
100
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200101/* get AUD_CONFIG_PIXEL_CLOCK_HDMI_* value for mode */
Ville Syrjälä5e7234c2015-09-25 16:37:43 +0300102static u32 audio_config_hdmi_pixel_clock(const struct drm_display_mode *adjusted_mode)
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200103{
104 int i;
105
106 for (i = 0; i < ARRAY_SIZE(hdmi_audio_clock); i++) {
Ville Syrjäläaad941d2015-09-25 16:38:56 +0300107 if (adjusted_mode->crtc_clock == hdmi_audio_clock[i].clock)
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200108 break;
109 }
110
111 if (i == ARRAY_SIZE(hdmi_audio_clock)) {
Ville Syrjälä5e7234c2015-09-25 16:37:43 +0300112 DRM_DEBUG_KMS("HDMI audio pixel clock setting for %d not found, falling back to defaults\n",
Ville Syrjäläaad941d2015-09-25 16:38:56 +0300113 adjusted_mode->crtc_clock);
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200114 i = 1;
115 }
116
117 DRM_DEBUG_KMS("Configuring HDMI audio for pixel clock %d (0x%08x)\n",
118 hdmi_audio_clock[i].clock,
119 hdmi_audio_clock[i].config);
120
121 return hdmi_audio_clock[i].config;
122}
123
Libin Yang4a21ef72015-09-02 14:11:39 +0800124static int audio_config_get_n(const struct drm_display_mode *mode, int rate)
125{
126 int i;
127
128 for (i = 0; i < ARRAY_SIZE(aud_ncts); i++) {
129 if ((rate == aud_ncts[i].sample_rate) &&
130 (mode->clock == aud_ncts[i].clock)) {
131 return aud_ncts[i].n;
132 }
133 }
134 return 0;
135}
136
Libin Yang7e8275c2015-09-25 09:36:12 +0800137static uint32_t audio_config_setup_n_reg(int n, uint32_t val)
138{
139 int n_low, n_up;
140 uint32_t tmp = val;
141
142 n_low = n & 0xfff;
143 n_up = (n >> 12) & 0xff;
144 tmp &= ~(AUD_CONFIG_UPPER_N_MASK | AUD_CONFIG_LOWER_N_MASK);
145 tmp |= ((n_up << AUD_CONFIG_UPPER_N_SHIFT) |
146 (n_low << AUD_CONFIG_LOWER_N_SHIFT) |
147 AUD_CONFIG_N_PROG_ENABLE);
148 return tmp;
149}
150
Libin Yang4a21ef72015-09-02 14:11:39 +0800151/* check whether N/CTS/M need be set manually */
152static bool audio_rate_need_prog(struct intel_crtc *crtc,
Takashi Iwai87f77ef2015-09-30 09:39:01 +0200153 const struct drm_display_mode *mode)
Libin Yang4a21ef72015-09-02 14:11:39 +0800154{
155 if (((mode->clock == TMDS_297M) ||
156 (mode->clock == TMDS_296M)) &&
157 intel_pipe_has_type(crtc, INTEL_OUTPUT_HDMI))
158 return true;
159 else
160 return false;
161}
162
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200163static bool intel_eld_uptodate(struct drm_connector *connector,
Ville Syrjäläf0f59a02015-11-18 15:33:26 +0200164 i915_reg_t reg_eldv, uint32_t bits_eldv,
165 i915_reg_t reg_elda, uint32_t bits_elda,
166 i915_reg_t reg_edid)
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200167{
168 struct drm_i915_private *dev_priv = connector->dev->dev_private;
169 uint8_t *eld = connector->eld;
Jani Nikulaf9f682a2014-10-27 16:26:45 +0200170 uint32_t tmp;
171 int i;
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200172
Jani Nikulaf9f682a2014-10-27 16:26:45 +0200173 tmp = I915_READ(reg_eldv);
174 tmp &= bits_eldv;
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200175
Jani Nikulaf9f682a2014-10-27 16:26:45 +0200176 if (!tmp)
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200177 return false;
178
Jani Nikulaf9f682a2014-10-27 16:26:45 +0200179 tmp = I915_READ(reg_elda);
180 tmp &= ~bits_elda;
181 I915_WRITE(reg_elda, tmp);
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200182
Jani Nikula938fd8a2014-10-28 16:20:48 +0200183 for (i = 0; i < drm_eld_size(eld) / 4; i++)
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200184 if (I915_READ(reg_edid) != *((uint32_t *)eld + i))
185 return false;
186
187 return true;
188}
189
Jani Nikula76d8d3e2014-10-27 16:26:57 +0200190static void g4x_audio_codec_disable(struct intel_encoder *encoder)
191{
192 struct drm_i915_private *dev_priv = encoder->base.dev->dev_private;
193 uint32_t eldv, tmp;
194
195 DRM_DEBUG_KMS("Disable audio codec\n");
196
197 tmp = I915_READ(G4X_AUD_VID_DID);
198 if (tmp == INTEL_AUDIO_DEVBLC || tmp == INTEL_AUDIO_DEVCL)
199 eldv = G4X_ELDV_DEVCL_DEVBLC;
200 else
201 eldv = G4X_ELDV_DEVCTG;
202
203 /* Invalidate ELD */
204 tmp = I915_READ(G4X_AUD_CNTL_ST);
205 tmp &= ~eldv;
206 I915_WRITE(G4X_AUD_CNTL_ST, tmp);
207}
208
Jani Nikula69bfe1a2014-10-27 16:26:50 +0200209static void g4x_audio_codec_enable(struct drm_connector *connector,
210 struct intel_encoder *encoder,
Ville Syrjälä5e7234c2015-09-25 16:37:43 +0300211 const struct drm_display_mode *adjusted_mode)
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200212{
213 struct drm_i915_private *dev_priv = connector->dev->dev_private;
214 uint8_t *eld = connector->eld;
215 uint32_t eldv;
Jani Nikulaf9f682a2014-10-27 16:26:45 +0200216 uint32_t tmp;
217 int len, i;
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200218
Jani Nikulad5ee08d2014-10-27 16:26:58 +0200219 DRM_DEBUG_KMS("Enable audio codec, %u bytes ELD\n", eld[2]);
220
Jani Nikulaf9f682a2014-10-27 16:26:45 +0200221 tmp = I915_READ(G4X_AUD_VID_DID);
222 if (tmp == INTEL_AUDIO_DEVBLC || tmp == INTEL_AUDIO_DEVCL)
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200223 eldv = G4X_ELDV_DEVCL_DEVBLC;
224 else
225 eldv = G4X_ELDV_DEVCTG;
226
227 if (intel_eld_uptodate(connector,
228 G4X_AUD_CNTL_ST, eldv,
Jani Nikulac46f1112014-10-27 16:26:52 +0200229 G4X_AUD_CNTL_ST, G4X_ELD_ADDR_MASK,
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200230 G4X_HDMIW_HDMIEDID))
231 return;
232
Jani Nikulaf9f682a2014-10-27 16:26:45 +0200233 tmp = I915_READ(G4X_AUD_CNTL_ST);
Jani Nikulac46f1112014-10-27 16:26:52 +0200234 tmp &= ~(eldv | G4X_ELD_ADDR_MASK);
Jani Nikulaf9f682a2014-10-27 16:26:45 +0200235 len = (tmp >> 9) & 0x1f; /* ELD buffer size */
236 I915_WRITE(G4X_AUD_CNTL_ST, tmp);
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200237
Jani Nikula938fd8a2014-10-28 16:20:48 +0200238 len = min(drm_eld_size(eld) / 4, len);
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200239 DRM_DEBUG_DRIVER("ELD size %d\n", len);
240 for (i = 0; i < len; i++)
241 I915_WRITE(G4X_HDMIW_HDMIEDID, *((uint32_t *)eld + i));
242
Jani Nikulaf9f682a2014-10-27 16:26:45 +0200243 tmp = I915_READ(G4X_AUD_CNTL_ST);
244 tmp |= eldv;
245 I915_WRITE(G4X_AUD_CNTL_ST, tmp);
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200246}
247
Jani Nikula69bfe1a2014-10-27 16:26:50 +0200248static void hsw_audio_codec_disable(struct intel_encoder *encoder)
249{
Jani Nikula5fad84a2014-11-04 10:30:23 +0200250 struct drm_i915_private *dev_priv = encoder->base.dev->dev_private;
251 struct intel_crtc *intel_crtc = to_intel_crtc(encoder->base.crtc);
252 enum pipe pipe = intel_crtc->pipe;
Jani Nikula69bfe1a2014-10-27 16:26:50 +0200253 uint32_t tmp;
254
Jani Nikula5fad84a2014-11-04 10:30:23 +0200255 DRM_DEBUG_KMS("Disable audio codec on pipe %c\n", pipe_name(pipe));
256
Libin Yang4a21ef72015-09-02 14:11:39 +0800257 mutex_lock(&dev_priv->av_mutex);
258
Jani Nikula5fad84a2014-11-04 10:30:23 +0200259 /* Disable timestamps */
260 tmp = I915_READ(HSW_AUD_CFG(pipe));
261 tmp &= ~AUD_CONFIG_N_VALUE_INDEX;
262 tmp |= AUD_CONFIG_N_PROG_ENABLE;
263 tmp &= ~AUD_CONFIG_UPPER_N_MASK;
264 tmp &= ~AUD_CONFIG_LOWER_N_MASK;
Libin Yang3d52ccf2015-12-02 14:09:44 +0800265 if (intel_pipe_has_type(intel_crtc, INTEL_OUTPUT_DISPLAYPORT) ||
266 intel_pipe_has_type(intel_crtc, INTEL_OUTPUT_DP_MST))
Jani Nikula5fad84a2014-11-04 10:30:23 +0200267 tmp |= AUD_CONFIG_N_VALUE_INDEX;
268 I915_WRITE(HSW_AUD_CFG(pipe), tmp);
269
270 /* Invalidate ELD */
Jani Nikula69bfe1a2014-10-27 16:26:50 +0200271 tmp = I915_READ(HSW_AUD_PIN_ELD_CP_VLD);
Jani Nikula82910ac2014-10-27 16:26:59 +0200272 tmp &= ~AUDIO_ELD_VALID(pipe);
Jani Nikulaeb45fa02014-11-18 12:11:29 +0200273 tmp &= ~AUDIO_OUTPUT_ENABLE(pipe);
Jani Nikula69bfe1a2014-10-27 16:26:50 +0200274 I915_WRITE(HSW_AUD_PIN_ELD_CP_VLD, tmp);
Libin Yang4a21ef72015-09-02 14:11:39 +0800275
276 mutex_unlock(&dev_priv->av_mutex);
Jani Nikula69bfe1a2014-10-27 16:26:50 +0200277}
278
279static void hsw_audio_codec_enable(struct drm_connector *connector,
280 struct intel_encoder *encoder,
Ville Syrjälä5e7234c2015-09-25 16:37:43 +0300281 const struct drm_display_mode *adjusted_mode)
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200282{
283 struct drm_i915_private *dev_priv = connector->dev->dev_private;
Jani Nikula820d2d72014-10-27 16:26:47 +0200284 struct intel_crtc *intel_crtc = to_intel_crtc(encoder->base.crtc);
Jani Nikula5fad84a2014-11-04 10:30:23 +0200285 enum pipe pipe = intel_crtc->pipe;
Libin Yang7e8275c2015-09-25 09:36:12 +0800286 struct i915_audio_component *acomp = dev_priv->audio_component;
Jani Nikula5fad84a2014-11-04 10:30:23 +0200287 const uint8_t *eld = connector->eld;
Libin Yang7e8275c2015-09-25 09:36:12 +0800288 struct intel_digital_port *intel_dig_port =
289 enc_to_dig_port(&encoder->base);
290 enum port port = intel_dig_port->port;
Jani Nikulaf9f682a2014-10-27 16:26:45 +0200291 uint32_t tmp;
292 int len, i;
Libin Yang7e8275c2015-09-25 09:36:12 +0800293 int n, rate;
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200294
Jani Nikula5fad84a2014-11-04 10:30:23 +0200295 DRM_DEBUG_KMS("Enable audio codec on pipe %c, %u bytes ELD\n",
Jani Nikula938fd8a2014-10-28 16:20:48 +0200296 pipe_name(pipe), drm_eld_size(eld));
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200297
Libin Yang4a21ef72015-09-02 14:11:39 +0800298 mutex_lock(&dev_priv->av_mutex);
299
Jani Nikula5fad84a2014-11-04 10:30:23 +0200300 /* Enable audio presence detect, invalidate ELD */
Jani Nikula69bfe1a2014-10-27 16:26:50 +0200301 tmp = I915_READ(HSW_AUD_PIN_ELD_CP_VLD);
Jani Nikula82910ac2014-10-27 16:26:59 +0200302 tmp |= AUDIO_OUTPUT_ENABLE(pipe);
303 tmp &= ~AUDIO_ELD_VALID(pipe);
Jani Nikula69bfe1a2014-10-27 16:26:50 +0200304 I915_WRITE(HSW_AUD_PIN_ELD_CP_VLD, tmp);
Jani Nikula5fad84a2014-11-04 10:30:23 +0200305
306 /*
307 * FIXME: We're supposed to wait for vblank here, but we have vblanks
308 * disabled during the mode set. The proper fix would be to push the
309 * rest of the setup into a vblank work item, queued here, but the
310 * infrastructure is not there yet.
311 */
312
313 /* Reset ELD write address */
314 tmp = I915_READ(HSW_AUD_DIP_ELD_CTRL(pipe));
315 tmp &= ~IBX_ELD_ADDRESS_MASK;
316 I915_WRITE(HSW_AUD_DIP_ELD_CTRL(pipe), tmp);
317
318 /* Up to 84 bytes of hw ELD buffer */
Jani Nikula938fd8a2014-10-28 16:20:48 +0200319 len = min(drm_eld_size(eld), 84);
320 for (i = 0; i < len / 4; i++)
Jani Nikula5fad84a2014-11-04 10:30:23 +0200321 I915_WRITE(HSW_AUD_EDID_DATA(pipe), *((uint32_t *)eld + i));
322
323 /* ELD valid */
324 tmp = I915_READ(HSW_AUD_PIN_ELD_CP_VLD);
Jani Nikula82910ac2014-10-27 16:26:59 +0200325 tmp |= AUDIO_ELD_VALID(pipe);
Jani Nikula5fad84a2014-11-04 10:30:23 +0200326 I915_WRITE(HSW_AUD_PIN_ELD_CP_VLD, tmp);
327
328 /* Enable timestamps */
329 tmp = I915_READ(HSW_AUD_CFG(pipe));
330 tmp &= ~AUD_CONFIG_N_VALUE_INDEX;
Jani Nikula5fad84a2014-11-04 10:30:23 +0200331 tmp &= ~AUD_CONFIG_PIXEL_CLOCK_HDMI_MASK;
332 if (intel_pipe_has_type(intel_crtc, INTEL_OUTPUT_DISPLAYPORT))
333 tmp |= AUD_CONFIG_N_VALUE_INDEX;
334 else
Ville Syrjälä5e7234c2015-09-25 16:37:43 +0300335 tmp |= audio_config_hdmi_pixel_clock(adjusted_mode);
Libin Yang7e8275c2015-09-25 09:36:12 +0800336
337 tmp &= ~AUD_CONFIG_N_PROG_ENABLE;
Daniel Vetter28446592015-10-07 15:34:15 +0200338 if (audio_rate_need_prog(intel_crtc, adjusted_mode)) {
Libin Yang7e8275c2015-09-25 09:36:12 +0800339 if (!acomp)
340 rate = 0;
341 else if (port >= PORT_A && port <= PORT_E)
342 rate = acomp->aud_sample_rate[port];
343 else {
344 DRM_ERROR("invalid port: %d\n", port);
345 rate = 0;
346 }
Daniel Vetter28446592015-10-07 15:34:15 +0200347 n = audio_config_get_n(adjusted_mode, rate);
Libin Yang7e8275c2015-09-25 09:36:12 +0800348 if (n != 0)
349 tmp = audio_config_setup_n_reg(n, tmp);
350 else
351 DRM_DEBUG_KMS("no suitable N value is found\n");
352 }
353
Jani Nikula5fad84a2014-11-04 10:30:23 +0200354 I915_WRITE(HSW_AUD_CFG(pipe), tmp);
Libin Yang4a21ef72015-09-02 14:11:39 +0800355
356 mutex_unlock(&dev_priv->av_mutex);
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200357}
358
Jani Nikula495a5bb2014-10-27 16:26:55 +0200359static void ilk_audio_codec_disable(struct intel_encoder *encoder)
360{
361 struct drm_i915_private *dev_priv = encoder->base.dev->dev_private;
362 struct intel_crtc *intel_crtc = to_intel_crtc(encoder->base.crtc);
363 struct intel_digital_port *intel_dig_port =
364 enc_to_dig_port(&encoder->base);
365 enum port port = intel_dig_port->port;
366 enum pipe pipe = intel_crtc->pipe;
367 uint32_t tmp, eldv;
Ville Syrjäläf0f59a02015-11-18 15:33:26 +0200368 i915_reg_t aud_config, aud_cntrl_st2;
Jani Nikula495a5bb2014-10-27 16:26:55 +0200369
370 DRM_DEBUG_KMS("Disable audio codec on port %c, pipe %c\n",
371 port_name(port), pipe_name(pipe));
372
Jani Nikulad3902c32015-05-04 17:20:49 +0300373 if (WARN_ON(port == PORT_A))
374 return;
375
Jani Nikula495a5bb2014-10-27 16:26:55 +0200376 if (HAS_PCH_IBX(dev_priv->dev)) {
377 aud_config = IBX_AUD_CFG(pipe);
378 aud_cntrl_st2 = IBX_AUD_CNTL_ST2;
Wayne Boyer666a4532015-12-09 12:29:35 -0800379 } else if (IS_VALLEYVIEW(dev_priv) || IS_CHERRYVIEW(dev_priv)) {
Jani Nikula495a5bb2014-10-27 16:26:55 +0200380 aud_config = VLV_AUD_CFG(pipe);
381 aud_cntrl_st2 = VLV_AUD_CNTL_ST2;
382 } else {
383 aud_config = CPT_AUD_CFG(pipe);
384 aud_cntrl_st2 = CPT_AUD_CNTRL_ST2;
385 }
386
387 /* Disable timestamps */
388 tmp = I915_READ(aud_config);
389 tmp &= ~AUD_CONFIG_N_VALUE_INDEX;
390 tmp |= AUD_CONFIG_N_PROG_ENABLE;
391 tmp &= ~AUD_CONFIG_UPPER_N_MASK;
392 tmp &= ~AUD_CONFIG_LOWER_N_MASK;
393 if (intel_pipe_has_type(intel_crtc, INTEL_OUTPUT_DISPLAYPORT))
394 tmp |= AUD_CONFIG_N_VALUE_INDEX;
395 I915_WRITE(aud_config, tmp);
396
Jani Nikulad3902c32015-05-04 17:20:49 +0300397 eldv = IBX_ELD_VALID(port);
Jani Nikula495a5bb2014-10-27 16:26:55 +0200398
399 /* Invalidate ELD */
400 tmp = I915_READ(aud_cntrl_st2);
401 tmp &= ~eldv;
402 I915_WRITE(aud_cntrl_st2, tmp);
403}
404
Jani Nikula69bfe1a2014-10-27 16:26:50 +0200405static void ilk_audio_codec_enable(struct drm_connector *connector,
406 struct intel_encoder *encoder,
Ville Syrjälä5e7234c2015-09-25 16:37:43 +0300407 const struct drm_display_mode *adjusted_mode)
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200408{
409 struct drm_i915_private *dev_priv = connector->dev->dev_private;
Jani Nikula820d2d72014-10-27 16:26:47 +0200410 struct intel_crtc *intel_crtc = to_intel_crtc(encoder->base.crtc);
Jani Nikulac6bde932014-11-04 10:31:28 +0200411 struct intel_digital_port *intel_dig_port =
412 enc_to_dig_port(&encoder->base);
413 enum port port = intel_dig_port->port;
414 enum pipe pipe = intel_crtc->pipe;
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200415 uint8_t *eld = connector->eld;
416 uint32_t eldv;
Jani Nikulaf9f682a2014-10-27 16:26:45 +0200417 uint32_t tmp;
418 int len, i;
Ville Syrjäläf0f59a02015-11-18 15:33:26 +0200419 i915_reg_t hdmiw_hdmiedid, aud_config, aud_cntl_st, aud_cntrl_st2;
Jani Nikulac6bde932014-11-04 10:31:28 +0200420
421 DRM_DEBUG_KMS("Enable audio codec on port %c, pipe %c, %u bytes ELD\n",
Jani Nikula938fd8a2014-10-28 16:20:48 +0200422 port_name(port), pipe_name(pipe), drm_eld_size(eld));
Jani Nikulac6bde932014-11-04 10:31:28 +0200423
Jani Nikulad3902c32015-05-04 17:20:49 +0300424 if (WARN_ON(port == PORT_A))
425 return;
426
Jani Nikulac6bde932014-11-04 10:31:28 +0200427 /*
428 * FIXME: We're supposed to wait for vblank here, but we have vblanks
429 * disabled during the mode set. The proper fix would be to push the
430 * rest of the setup into a vblank work item, queued here, but the
431 * infrastructure is not there yet.
432 */
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200433
434 if (HAS_PCH_IBX(connector->dev)) {
435 hdmiw_hdmiedid = IBX_HDMIW_HDMIEDID(pipe);
436 aud_config = IBX_AUD_CFG(pipe);
437 aud_cntl_st = IBX_AUD_CNTL_ST(pipe);
438 aud_cntrl_st2 = IBX_AUD_CNTL_ST2;
Wayne Boyer666a4532015-12-09 12:29:35 -0800439 } else if (IS_VALLEYVIEW(connector->dev) ||
440 IS_CHERRYVIEW(connector->dev)) {
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200441 hdmiw_hdmiedid = VLV_HDMIW_HDMIEDID(pipe);
442 aud_config = VLV_AUD_CFG(pipe);
443 aud_cntl_st = VLV_AUD_CNTL_ST(pipe);
444 aud_cntrl_st2 = VLV_AUD_CNTL_ST2;
445 } else {
446 hdmiw_hdmiedid = CPT_HDMIW_HDMIEDID(pipe);
447 aud_config = CPT_AUD_CFG(pipe);
448 aud_cntl_st = CPT_AUD_CNTL_ST(pipe);
449 aud_cntrl_st2 = CPT_AUD_CNTRL_ST2;
450 }
451
Jani Nikulad3902c32015-05-04 17:20:49 +0300452 eldv = IBX_ELD_VALID(port);
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200453
Jani Nikulac6bde932014-11-04 10:31:28 +0200454 /* Invalidate ELD */
Jani Nikulaf9f682a2014-10-27 16:26:45 +0200455 tmp = I915_READ(aud_cntrl_st2);
456 tmp &= ~eldv;
457 I915_WRITE(aud_cntrl_st2, tmp);
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200458
Jani Nikulac6bde932014-11-04 10:31:28 +0200459 /* Reset ELD write address */
Jani Nikulaf9f682a2014-10-27 16:26:45 +0200460 tmp = I915_READ(aud_cntl_st);
Jani Nikulac46f1112014-10-27 16:26:52 +0200461 tmp &= ~IBX_ELD_ADDRESS_MASK;
Jani Nikulaf9f682a2014-10-27 16:26:45 +0200462 I915_WRITE(aud_cntl_st, tmp);
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200463
Jani Nikulac6bde932014-11-04 10:31:28 +0200464 /* Up to 84 bytes of hw ELD buffer */
Jani Nikula938fd8a2014-10-28 16:20:48 +0200465 len = min(drm_eld_size(eld), 84);
466 for (i = 0; i < len / 4; i++)
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200467 I915_WRITE(hdmiw_hdmiedid, *((uint32_t *)eld + i));
468
Jani Nikulac6bde932014-11-04 10:31:28 +0200469 /* ELD valid */
Jani Nikulaf9f682a2014-10-27 16:26:45 +0200470 tmp = I915_READ(aud_cntrl_st2);
471 tmp |= eldv;
472 I915_WRITE(aud_cntrl_st2, tmp);
Jani Nikulac6bde932014-11-04 10:31:28 +0200473
474 /* Enable timestamps */
475 tmp = I915_READ(aud_config);
476 tmp &= ~AUD_CONFIG_N_VALUE_INDEX;
477 tmp &= ~AUD_CONFIG_N_PROG_ENABLE;
478 tmp &= ~AUD_CONFIG_PIXEL_CLOCK_HDMI_MASK;
Libin Yang3d52ccf2015-12-02 14:09:44 +0800479 if (intel_pipe_has_type(intel_crtc, INTEL_OUTPUT_DISPLAYPORT) ||
480 intel_pipe_has_type(intel_crtc, INTEL_OUTPUT_DP_MST))
Jani Nikulac6bde932014-11-04 10:31:28 +0200481 tmp |= AUD_CONFIG_N_VALUE_INDEX;
482 else
Ville Syrjälä5e7234c2015-09-25 16:37:43 +0300483 tmp |= audio_config_hdmi_pixel_clock(adjusted_mode);
Jani Nikulac6bde932014-11-04 10:31:28 +0200484 I915_WRITE(aud_config, tmp);
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200485}
486
Jani Nikula69bfe1a2014-10-27 16:26:50 +0200487/**
488 * intel_audio_codec_enable - Enable the audio codec for HD audio
489 * @intel_encoder: encoder on which to enable audio
490 *
491 * The enable sequences may only be performed after enabling the transcoder and
492 * port, and after completed link training.
493 */
494void intel_audio_codec_enable(struct intel_encoder *intel_encoder)
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200495{
Jani Nikula33d1e7c62014-10-27 16:26:46 +0200496 struct drm_encoder *encoder = &intel_encoder->base;
497 struct intel_crtc *crtc = to_intel_crtc(encoder->crtc);
Ville Syrjälä7c5f93b2015-09-08 13:40:49 +0300498 const struct drm_display_mode *adjusted_mode = &crtc->config->base.adjusted_mode;
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200499 struct drm_connector *connector;
500 struct drm_device *dev = encoder->dev;
501 struct drm_i915_private *dev_priv = dev->dev_private;
David Henningsson51e1d832015-08-19 10:48:56 +0200502 struct i915_audio_component *acomp = dev_priv->audio_component;
503 struct intel_digital_port *intel_dig_port = enc_to_dig_port(encoder);
504 enum port port = intel_dig_port->port;
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200505
Ville Syrjälä9e5a3b52015-09-07 18:22:57 +0300506 connector = drm_select_eld(encoder);
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200507 if (!connector)
508 return;
509
510 DRM_DEBUG_DRIVER("ELD on [CONNECTOR:%d:%s], [ENCODER:%d:%s]\n",
511 connector->base.id,
512 connector->name,
513 connector->encoder->base.id,
514 connector->encoder->name);
515
Jani Nikula6189b032014-10-28 13:53:01 +0200516 /* ELD Conn_Type */
517 connector->eld[5] &= ~(3 << 2);
Libin Yang3d52ccf2015-12-02 14:09:44 +0800518 if (intel_pipe_has_type(crtc, INTEL_OUTPUT_DISPLAYPORT) ||
519 intel_pipe_has_type(crtc, INTEL_OUTPUT_DP_MST))
Jani Nikula6189b032014-10-28 13:53:01 +0200520 connector->eld[5] |= (1 << 2);
521
Ville Syrjälä124abe02015-09-08 13:40:45 +0300522 connector->eld[6] = drm_av_sync_delay(connector, adjusted_mode) / 2;
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200523
Jani Nikula69bfe1a2014-10-27 16:26:50 +0200524 if (dev_priv->display.audio_codec_enable)
Ville Syrjälä124abe02015-09-08 13:40:45 +0300525 dev_priv->display.audio_codec_enable(connector, intel_encoder,
526 adjusted_mode);
David Henningsson51e1d832015-08-19 10:48:56 +0200527
Takashi Iwaicae666c2015-11-12 15:23:41 +0100528 mutex_lock(&dev_priv->av_mutex);
529 intel_dig_port->audio_connector = connector;
Takashi Iwai9dfbffc2016-02-24 15:35:22 +0100530 /* referred in audio callbacks */
531 dev_priv->dig_port_map[port] = intel_encoder;
Takashi Iwaicae666c2015-11-12 15:23:41 +0100532 mutex_unlock(&dev_priv->av_mutex);
533
David Henningsson51e1d832015-08-19 10:48:56 +0200534 if (acomp && acomp->audio_ops && acomp->audio_ops->pin_eld_notify)
David Henningssonf0675d42015-09-03 11:51:34 +0200535 acomp->audio_ops->pin_eld_notify(acomp->audio_ops->audio_ptr, (int) port);
Jani Nikula69bfe1a2014-10-27 16:26:50 +0200536}
537
538/**
539 * intel_audio_codec_disable - Disable the audio codec for HD audio
Geliang Tang95d0be62015-09-15 06:04:36 -0700540 * @intel_encoder: encoder on which to disable audio
Jani Nikula69bfe1a2014-10-27 16:26:50 +0200541 *
542 * The disable sequences must be performed before disabling the transcoder or
543 * port.
544 */
David Henningsson51e1d832015-08-19 10:48:56 +0200545void intel_audio_codec_disable(struct intel_encoder *intel_encoder)
Jani Nikula69bfe1a2014-10-27 16:26:50 +0200546{
David Henningsson51e1d832015-08-19 10:48:56 +0200547 struct drm_encoder *encoder = &intel_encoder->base;
548 struct drm_device *dev = encoder->dev;
Jani Nikula69bfe1a2014-10-27 16:26:50 +0200549 struct drm_i915_private *dev_priv = dev->dev_private;
David Henningsson51e1d832015-08-19 10:48:56 +0200550 struct i915_audio_component *acomp = dev_priv->audio_component;
551 struct intel_digital_port *intel_dig_port = enc_to_dig_port(encoder);
552 enum port port = intel_dig_port->port;
Jani Nikula69bfe1a2014-10-27 16:26:50 +0200553
554 if (dev_priv->display.audio_codec_disable)
David Henningsson51e1d832015-08-19 10:48:56 +0200555 dev_priv->display.audio_codec_disable(intel_encoder);
556
Takashi Iwaicae666c2015-11-12 15:23:41 +0100557 mutex_lock(&dev_priv->av_mutex);
558 intel_dig_port->audio_connector = NULL;
Takashi Iwai9dfbffc2016-02-24 15:35:22 +0100559 dev_priv->dig_port_map[port] = NULL;
Takashi Iwaicae666c2015-11-12 15:23:41 +0100560 mutex_unlock(&dev_priv->av_mutex);
561
David Henningsson51e1d832015-08-19 10:48:56 +0200562 if (acomp && acomp->audio_ops && acomp->audio_ops->pin_eld_notify)
David Henningssonf0675d42015-09-03 11:51:34 +0200563 acomp->audio_ops->pin_eld_notify(acomp->audio_ops->audio_ptr, (int) port);
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200564}
565
566/**
Imre Deak88212942016-03-16 13:38:53 +0200567 * intel_init_audio_hooks - Set up chip specific audio hooks
568 * @dev_priv: device private
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200569 */
Imre Deak88212942016-03-16 13:38:53 +0200570void intel_init_audio_hooks(struct drm_i915_private *dev_priv)
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200571{
Imre Deak88212942016-03-16 13:38:53 +0200572 if (IS_G4X(dev_priv)) {
Jani Nikula69bfe1a2014-10-27 16:26:50 +0200573 dev_priv->display.audio_codec_enable = g4x_audio_codec_enable;
Jani Nikula76d8d3e2014-10-27 16:26:57 +0200574 dev_priv->display.audio_codec_disable = g4x_audio_codec_disable;
Imre Deak88212942016-03-16 13:38:53 +0200575 } else if (IS_VALLEYVIEW(dev_priv) || IS_CHERRYVIEW(dev_priv)) {
Jani Nikula69bfe1a2014-10-27 16:26:50 +0200576 dev_priv->display.audio_codec_enable = ilk_audio_codec_enable;
Jani Nikula495a5bb2014-10-27 16:26:55 +0200577 dev_priv->display.audio_codec_disable = ilk_audio_codec_disable;
Imre Deak88212942016-03-16 13:38:53 +0200578 } else if (IS_HASWELL(dev_priv) || INTEL_INFO(dev_priv)->gen >= 8) {
Jani Nikula69bfe1a2014-10-27 16:26:50 +0200579 dev_priv->display.audio_codec_enable = hsw_audio_codec_enable;
580 dev_priv->display.audio_codec_disable = hsw_audio_codec_disable;
Imre Deak88212942016-03-16 13:38:53 +0200581 } else if (HAS_PCH_SPLIT(dev_priv)) {
Jani Nikula69bfe1a2014-10-27 16:26:50 +0200582 dev_priv->display.audio_codec_enable = ilk_audio_codec_enable;
Jani Nikula495a5bb2014-10-27 16:26:55 +0200583 dev_priv->display.audio_codec_disable = ilk_audio_codec_disable;
Jani Nikula69bfe1a2014-10-27 16:26:50 +0200584 }
Jani Nikula7c10a2b2014-10-27 16:26:43 +0200585}
Imre Deak58fddc22015-01-08 17:54:14 +0200586
587static void i915_audio_component_get_power(struct device *dev)
588{
589 intel_display_power_get(dev_to_i915(dev), POWER_DOMAIN_AUDIO);
590}
591
592static void i915_audio_component_put_power(struct device *dev)
593{
594 intel_display_power_put(dev_to_i915(dev), POWER_DOMAIN_AUDIO);
595}
596
Lu, Han632f3ab2015-05-05 09:05:47 +0800597static void i915_audio_component_codec_wake_override(struct device *dev,
598 bool enable)
599{
600 struct drm_i915_private *dev_priv = dev_to_i915(dev);
601 u32 tmp;
602
Rodrigo Vivief11bdb2015-10-28 04:16:45 -0700603 if (!IS_SKYLAKE(dev_priv) && !IS_KABYLAKE(dev_priv))
Lu, Han632f3ab2015-05-05 09:05:47 +0800604 return;
605
606 /*
607 * Enable/disable generating the codec wake signal, overriding the
608 * internal logic to generate the codec wake to controller.
609 */
610 tmp = I915_READ(HSW_AUD_CHICKENBIT);
611 tmp &= ~SKL_AUD_CODEC_WAKE_SIGNAL;
612 I915_WRITE(HSW_AUD_CHICKENBIT, tmp);
613 usleep_range(1000, 1500);
614
615 if (enable) {
616 tmp = I915_READ(HSW_AUD_CHICKENBIT);
617 tmp |= SKL_AUD_CODEC_WAKE_SIGNAL;
618 I915_WRITE(HSW_AUD_CHICKENBIT, tmp);
619 usleep_range(1000, 1500);
620 }
621}
622
Imre Deak58fddc22015-01-08 17:54:14 +0200623/* Get CDCLK in kHz */
624static int i915_audio_component_get_cdclk_freq(struct device *dev)
625{
626 struct drm_i915_private *dev_priv = dev_to_i915(dev);
627 int ret;
628
629 if (WARN_ON_ONCE(!HAS_DDI(dev_priv)))
630 return -ENODEV;
631
632 intel_display_power_get(dev_priv, POWER_DOMAIN_AUDIO);
Ville Syrjälä1652d192015-03-31 14:12:01 +0300633 ret = dev_priv->display.get_display_clock_speed(dev_priv->dev);
634
Imre Deak58fddc22015-01-08 17:54:14 +0200635 intel_display_power_put(dev_priv, POWER_DOMAIN_AUDIO);
636
637 return ret;
638}
639
Libin Yang4a21ef72015-09-02 14:11:39 +0800640static int i915_audio_component_sync_audio_rate(struct device *dev,
641 int port, int rate)
642{
643 struct drm_i915_private *dev_priv = dev_to_i915(dev);
Libin Yang4a21ef72015-09-02 14:11:39 +0800644 struct intel_encoder *intel_encoder;
Libin Yang4a21ef72015-09-02 14:11:39 +0800645 struct intel_crtc *crtc;
646 struct drm_display_mode *mode;
Libin Yang7e8275c2015-09-25 09:36:12 +0800647 struct i915_audio_component *acomp = dev_priv->audio_component;
Takashi Iwai0bdf5a02015-11-30 18:19:39 +0100648 enum pipe pipe = INVALID_PIPE;
Libin Yang4a21ef72015-09-02 14:11:39 +0800649 u32 tmp;
Libin Yang7e8275c2015-09-25 09:36:12 +0800650 int n;
Takashi Iwai0bdf5a02015-11-30 18:19:39 +0100651 int err = 0;
Libin Yang4a21ef72015-09-02 14:11:39 +0800652
Rodrigo Vivief11bdb2015-10-28 04:16:45 -0700653 /* HSW, BDW, SKL, KBL need this fix */
Libin Yang4a21ef72015-09-02 14:11:39 +0800654 if (!IS_SKYLAKE(dev_priv) &&
Rodrigo Vivief11bdb2015-10-28 04:16:45 -0700655 !IS_KABYLAKE(dev_priv) &&
656 !IS_BROADWELL(dev_priv) &&
657 !IS_HASWELL(dev_priv))
Libin Yang4a21ef72015-09-02 14:11:39 +0800658 return 0;
659
660 mutex_lock(&dev_priv->av_mutex);
661 /* 1. get the pipe */
Takashi Iwai0bdf5a02015-11-30 18:19:39 +0100662 intel_encoder = dev_priv->dig_port_map[port];
663 /* intel_encoder might be NULL for DP MST */
664 if (!intel_encoder || !intel_encoder->base.crtc ||
665 intel_encoder->type != INTEL_OUTPUT_HDMI) {
666 DRM_DEBUG_KMS("no valid port %c\n", port_name(port));
667 err = -ENODEV;
668 goto unlock;
Libin Yang4a21ef72015-09-02 14:11:39 +0800669 }
Takashi Iwai0bdf5a02015-11-30 18:19:39 +0100670 crtc = to_intel_crtc(intel_encoder->base.crtc);
671 pipe = crtc->pipe;
Libin Yang4a21ef72015-09-02 14:11:39 +0800672 if (pipe == INVALID_PIPE) {
673 DRM_DEBUG_KMS("no pipe for the port %c\n", port_name(port));
Takashi Iwai0bdf5a02015-11-30 18:19:39 +0100674 err = -ENODEV;
675 goto unlock;
Libin Yang4a21ef72015-09-02 14:11:39 +0800676 }
Takashi Iwai0bdf5a02015-11-30 18:19:39 +0100677
Libin Yang4a21ef72015-09-02 14:11:39 +0800678 DRM_DEBUG_KMS("pipe %c connects port %c\n",
679 pipe_name(pipe), port_name(port));
680 mode = &crtc->config->base.adjusted_mode;
681
Libin Yang7e8275c2015-09-25 09:36:12 +0800682 /* port must be valid now, otherwise the pipe will be invalid */
683 acomp->aud_sample_rate[port] = rate;
684
Libin Yang4a21ef72015-09-02 14:11:39 +0800685 /* 2. check whether to set the N/CTS/M manually or not */
686 if (!audio_rate_need_prog(crtc, mode)) {
687 tmp = I915_READ(HSW_AUD_CFG(pipe));
688 tmp &= ~AUD_CONFIG_N_PROG_ENABLE;
689 I915_WRITE(HSW_AUD_CFG(pipe), tmp);
Takashi Iwai0bdf5a02015-11-30 18:19:39 +0100690 goto unlock;
Libin Yang4a21ef72015-09-02 14:11:39 +0800691 }
692
693 n = audio_config_get_n(mode, rate);
694 if (n == 0) {
695 DRM_DEBUG_KMS("Using automatic mode for N value on port %c\n",
696 port_name(port));
697 tmp = I915_READ(HSW_AUD_CFG(pipe));
698 tmp &= ~AUD_CONFIG_N_PROG_ENABLE;
699 I915_WRITE(HSW_AUD_CFG(pipe), tmp);
Takashi Iwai0bdf5a02015-11-30 18:19:39 +0100700 goto unlock;
Libin Yang4a21ef72015-09-02 14:11:39 +0800701 }
Libin Yang4a21ef72015-09-02 14:11:39 +0800702
Libin Yang7e8275c2015-09-25 09:36:12 +0800703 /* 3. set the N/CTS/M */
Libin Yang4a21ef72015-09-02 14:11:39 +0800704 tmp = I915_READ(HSW_AUD_CFG(pipe));
Libin Yang7e8275c2015-09-25 09:36:12 +0800705 tmp = audio_config_setup_n_reg(n, tmp);
Libin Yang4a21ef72015-09-02 14:11:39 +0800706 I915_WRITE(HSW_AUD_CFG(pipe), tmp);
707
Takashi Iwai0bdf5a02015-11-30 18:19:39 +0100708 unlock:
Libin Yang4a21ef72015-09-02 14:11:39 +0800709 mutex_unlock(&dev_priv->av_mutex);
Takashi Iwai0bdf5a02015-11-30 18:19:39 +0100710 return err;
Libin Yang4a21ef72015-09-02 14:11:39 +0800711}
712
Takashi Iwaicae666c2015-11-12 15:23:41 +0100713static int i915_audio_component_get_eld(struct device *dev, int port,
714 bool *enabled,
715 unsigned char *buf, int max_bytes)
716{
717 struct drm_i915_private *dev_priv = dev_to_i915(dev);
Takashi Iwaicae666c2015-11-12 15:23:41 +0100718 struct intel_encoder *intel_encoder;
719 struct intel_digital_port *intel_dig_port;
720 const u8 *eld;
721 int ret = -EINVAL;
722
723 mutex_lock(&dev_priv->av_mutex);
Takashi Iwai0bdf5a02015-11-30 18:19:39 +0100724 intel_encoder = dev_priv->dig_port_map[port];
725 /* intel_encoder might be NULL for DP MST */
726 if (intel_encoder) {
727 ret = 0;
Takashi Iwaicae666c2015-11-12 15:23:41 +0100728 intel_dig_port = enc_to_dig_port(&intel_encoder->base);
Takashi Iwai0bdf5a02015-11-30 18:19:39 +0100729 *enabled = intel_dig_port->audio_connector != NULL;
730 if (*enabled) {
Takashi Iwaicae666c2015-11-12 15:23:41 +0100731 eld = intel_dig_port->audio_connector->eld;
732 ret = drm_eld_size(eld);
733 memcpy(buf, eld, min(max_bytes, ret));
Takashi Iwaicae666c2015-11-12 15:23:41 +0100734 }
735 }
736
737 mutex_unlock(&dev_priv->av_mutex);
738 return ret;
Imre Deak58fddc22015-01-08 17:54:14 +0200739}
740
741static const struct i915_audio_component_ops i915_audio_component_ops = {
742 .owner = THIS_MODULE,
743 .get_power = i915_audio_component_get_power,
744 .put_power = i915_audio_component_put_power,
Lu, Han632f3ab2015-05-05 09:05:47 +0800745 .codec_wake_override = i915_audio_component_codec_wake_override,
Imre Deak58fddc22015-01-08 17:54:14 +0200746 .get_cdclk_freq = i915_audio_component_get_cdclk_freq,
Libin Yang4a21ef72015-09-02 14:11:39 +0800747 .sync_audio_rate = i915_audio_component_sync_audio_rate,
Takashi Iwaicae666c2015-11-12 15:23:41 +0100748 .get_eld = i915_audio_component_get_eld,
Imre Deak58fddc22015-01-08 17:54:14 +0200749};
750
751static int i915_audio_component_bind(struct device *i915_dev,
752 struct device *hda_dev, void *data)
753{
754 struct i915_audio_component *acomp = data;
David Henningsson51e1d832015-08-19 10:48:56 +0200755 struct drm_i915_private *dev_priv = dev_to_i915(i915_dev);
Libin Yang7e8275c2015-09-25 09:36:12 +0800756 int i;
Imre Deak58fddc22015-01-08 17:54:14 +0200757
758 if (WARN_ON(acomp->ops || acomp->dev))
759 return -EEXIST;
760
David Henningssond5f362a2015-09-03 11:51:35 +0200761 drm_modeset_lock_all(dev_priv->dev);
Imre Deak58fddc22015-01-08 17:54:14 +0200762 acomp->ops = &i915_audio_component_ops;
763 acomp->dev = i915_dev;
Libin Yang7e8275c2015-09-25 09:36:12 +0800764 BUILD_BUG_ON(MAX_PORTS != I915_MAX_PORTS);
765 for (i = 0; i < ARRAY_SIZE(acomp->aud_sample_rate); i++)
766 acomp->aud_sample_rate[i] = 0;
David Henningsson51e1d832015-08-19 10:48:56 +0200767 dev_priv->audio_component = acomp;
David Henningssond5f362a2015-09-03 11:51:35 +0200768 drm_modeset_unlock_all(dev_priv->dev);
Imre Deak58fddc22015-01-08 17:54:14 +0200769
770 return 0;
771}
772
773static void i915_audio_component_unbind(struct device *i915_dev,
774 struct device *hda_dev, void *data)
775{
776 struct i915_audio_component *acomp = data;
David Henningsson51e1d832015-08-19 10:48:56 +0200777 struct drm_i915_private *dev_priv = dev_to_i915(i915_dev);
Imre Deak58fddc22015-01-08 17:54:14 +0200778
David Henningssond5f362a2015-09-03 11:51:35 +0200779 drm_modeset_lock_all(dev_priv->dev);
Imre Deak58fddc22015-01-08 17:54:14 +0200780 acomp->ops = NULL;
781 acomp->dev = NULL;
David Henningsson51e1d832015-08-19 10:48:56 +0200782 dev_priv->audio_component = NULL;
David Henningssond5f362a2015-09-03 11:51:35 +0200783 drm_modeset_unlock_all(dev_priv->dev);
Imre Deak58fddc22015-01-08 17:54:14 +0200784}
785
786static const struct component_ops i915_audio_component_bind_ops = {
787 .bind = i915_audio_component_bind,
788 .unbind = i915_audio_component_unbind,
789};
790
791/**
792 * i915_audio_component_init - initialize and register the audio component
793 * @dev_priv: i915 device instance
794 *
795 * This will register with the component framework a child component which
796 * will bind dynamically to the snd_hda_intel driver's corresponding master
797 * component when the latter is registered. During binding the child
798 * initializes an instance of struct i915_audio_component which it receives
799 * from the master. The master can then start to use the interface defined by
800 * this struct. Each side can break the binding at any point by deregistering
801 * its own component after which each side's component unbind callback is
802 * called.
803 *
804 * We ignore any error during registration and continue with reduced
805 * functionality (i.e. without HDMI audio).
806 */
807void i915_audio_component_init(struct drm_i915_private *dev_priv)
808{
809 int ret;
810
811 ret = component_add(dev_priv->dev->dev, &i915_audio_component_bind_ops);
812 if (ret < 0) {
813 DRM_ERROR("failed to add audio component (%d)\n", ret);
814 /* continue with reduced functionality */
815 return;
816 }
817
818 dev_priv->audio_component_registered = true;
819}
820
821/**
822 * i915_audio_component_cleanup - deregister the audio component
823 * @dev_priv: i915 device instance
824 *
825 * Deregisters the audio component, breaking any existing binding to the
826 * corresponding snd_hda_intel driver's master component.
827 */
828void i915_audio_component_cleanup(struct drm_i915_private *dev_priv)
829{
830 if (!dev_priv->audio_component_registered)
831 return;
832
833 component_del(dev_priv->dev->dev, &i915_audio_component_bind_ops);
834 dev_priv->audio_component_registered = false;
835}