Commit | Line | Data |
---|---|---|
7c10a2b5 JN |
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 | ||
26 | #include <drm/drmP.h> | |
27 | #include <drm/drm_edid.h> | |
28 | #include "intel_drv.h" | |
29 | #include "i915_drv.h" | |
30 | ||
87fcb2ad | 31 | static const struct { |
7c10a2b5 JN |
32 | int clock; |
33 | u32 config; | |
34 | } hdmi_audio_clock[] = { | |
35 | { DIV_ROUND_UP(25200 * 1000, 1001), AUD_CONFIG_PIXEL_CLOCK_HDMI_25175 }, | |
36 | { 25200, AUD_CONFIG_PIXEL_CLOCK_HDMI_25200 }, /* default per bspec */ | |
37 | { 27000, AUD_CONFIG_PIXEL_CLOCK_HDMI_27000 }, | |
38 | { 27000 * 1001 / 1000, AUD_CONFIG_PIXEL_CLOCK_HDMI_27027 }, | |
39 | { 54000, AUD_CONFIG_PIXEL_CLOCK_HDMI_54000 }, | |
40 | { 54000 * 1001 / 1000, AUD_CONFIG_PIXEL_CLOCK_HDMI_54054 }, | |
41 | { DIV_ROUND_UP(74250 * 1000, 1001), AUD_CONFIG_PIXEL_CLOCK_HDMI_74176 }, | |
42 | { 74250, AUD_CONFIG_PIXEL_CLOCK_HDMI_74250 }, | |
43 | { DIV_ROUND_UP(148500 * 1000, 1001), AUD_CONFIG_PIXEL_CLOCK_HDMI_148352 }, | |
44 | { 148500, AUD_CONFIG_PIXEL_CLOCK_HDMI_148500 }, | |
45 | }; | |
46 | ||
47 | /* get AUD_CONFIG_PIXEL_CLOCK_HDMI_* value for mode */ | |
48 | static u32 audio_config_hdmi_pixel_clock(struct drm_display_mode *mode) | |
49 | { | |
50 | int i; | |
51 | ||
52 | for (i = 0; i < ARRAY_SIZE(hdmi_audio_clock); i++) { | |
53 | if (mode->clock == hdmi_audio_clock[i].clock) | |
54 | break; | |
55 | } | |
56 | ||
57 | if (i == ARRAY_SIZE(hdmi_audio_clock)) { | |
58 | DRM_DEBUG_KMS("HDMI audio pixel clock setting for %d not found, falling back to defaults\n", mode->clock); | |
59 | i = 1; | |
60 | } | |
61 | ||
62 | DRM_DEBUG_KMS("Configuring HDMI audio for pixel clock %d (0x%08x)\n", | |
63 | hdmi_audio_clock[i].clock, | |
64 | hdmi_audio_clock[i].config); | |
65 | ||
66 | return hdmi_audio_clock[i].config; | |
67 | } | |
68 | ||
69 | static bool intel_eld_uptodate(struct drm_connector *connector, | |
70 | int reg_eldv, uint32_t bits_eldv, | |
71 | int reg_elda, uint32_t bits_elda, | |
72 | int reg_edid) | |
73 | { | |
74 | struct drm_i915_private *dev_priv = connector->dev->dev_private; | |
75 | uint8_t *eld = connector->eld; | |
f9f682ae JN |
76 | uint32_t tmp; |
77 | int i; | |
7c10a2b5 | 78 | |
f9f682ae JN |
79 | tmp = I915_READ(reg_eldv); |
80 | tmp &= bits_eldv; | |
7c10a2b5 JN |
81 | |
82 | if (!eld[0]) | |
f9f682ae | 83 | return !tmp; |
7c10a2b5 | 84 | |
f9f682ae | 85 | if (!tmp) |
7c10a2b5 JN |
86 | return false; |
87 | ||
f9f682ae JN |
88 | tmp = I915_READ(reg_elda); |
89 | tmp &= ~bits_elda; | |
90 | I915_WRITE(reg_elda, tmp); | |
7c10a2b5 JN |
91 | |
92 | for (i = 0; i < eld[2]; i++) | |
93 | if (I915_READ(reg_edid) != *((uint32_t *)eld + i)) | |
94 | return false; | |
95 | ||
96 | return true; | |
97 | } | |
98 | ||
99 | static void g4x_write_eld(struct drm_connector *connector, | |
100 | struct drm_crtc *crtc, | |
101 | struct drm_display_mode *mode) | |
102 | { | |
103 | struct drm_i915_private *dev_priv = connector->dev->dev_private; | |
104 | uint8_t *eld = connector->eld; | |
105 | uint32_t eldv; | |
f9f682ae JN |
106 | uint32_t tmp; |
107 | int len, i; | |
7c10a2b5 | 108 | |
f9f682ae JN |
109 | tmp = I915_READ(G4X_AUD_VID_DID); |
110 | if (tmp == INTEL_AUDIO_DEVBLC || tmp == INTEL_AUDIO_DEVCL) | |
7c10a2b5 JN |
111 | eldv = G4X_ELDV_DEVCL_DEVBLC; |
112 | else | |
113 | eldv = G4X_ELDV_DEVCTG; | |
114 | ||
115 | if (intel_eld_uptodate(connector, | |
116 | G4X_AUD_CNTL_ST, eldv, | |
117 | G4X_AUD_CNTL_ST, G4X_ELD_ADDR, | |
118 | G4X_HDMIW_HDMIEDID)) | |
119 | return; | |
120 | ||
f9f682ae JN |
121 | tmp = I915_READ(G4X_AUD_CNTL_ST); |
122 | tmp &= ~(eldv | G4X_ELD_ADDR); | |
123 | len = (tmp >> 9) & 0x1f; /* ELD buffer size */ | |
124 | I915_WRITE(G4X_AUD_CNTL_ST, tmp); | |
7c10a2b5 JN |
125 | |
126 | if (!eld[0]) | |
127 | return; | |
128 | ||
f9f682ae | 129 | len = min_t(int, eld[2], len); |
7c10a2b5 JN |
130 | DRM_DEBUG_DRIVER("ELD size %d\n", len); |
131 | for (i = 0; i < len; i++) | |
132 | I915_WRITE(G4X_HDMIW_HDMIEDID, *((uint32_t *)eld + i)); | |
133 | ||
f9f682ae JN |
134 | tmp = I915_READ(G4X_AUD_CNTL_ST); |
135 | tmp |= eldv; | |
136 | I915_WRITE(G4X_AUD_CNTL_ST, tmp); | |
7c10a2b5 JN |
137 | } |
138 | ||
139 | static void haswell_write_eld(struct drm_connector *connector, | |
140 | struct drm_crtc *crtc, | |
141 | struct drm_display_mode *mode) | |
142 | { | |
143 | struct drm_i915_private *dev_priv = connector->dev->dev_private; | |
144 | struct intel_crtc *intel_crtc = to_intel_crtc(crtc); | |
145 | uint8_t *eld = connector->eld; | |
146 | uint32_t eldv; | |
f9f682ae JN |
147 | uint32_t tmp; |
148 | int len, i; | |
149 | enum pipe pipe = to_intel_crtc(crtc)->pipe; | |
150 | enum port port; | |
7c10a2b5 JN |
151 | int hdmiw_hdmiedid = HSW_AUD_EDID_DATA(pipe); |
152 | int aud_cntl_st = HSW_AUD_DIP_ELD_CTRL(pipe); | |
153 | int aud_config = HSW_AUD_CFG(pipe); | |
154 | int aud_cntrl_st2 = HSW_AUD_PIN_ELD_CP_VLD; | |
155 | ||
156 | /* Audio output enable */ | |
157 | DRM_DEBUG_DRIVER("HDMI audio: enable codec\n"); | |
158 | tmp = I915_READ(aud_cntrl_st2); | |
159 | tmp |= (AUDIO_OUTPUT_ENABLE_A << (pipe * 4)); | |
160 | I915_WRITE(aud_cntrl_st2, tmp); | |
161 | POSTING_READ(aud_cntrl_st2); | |
162 | ||
163 | assert_pipe_disabled(dev_priv, to_intel_crtc(crtc)->pipe); | |
164 | ||
165 | /* Set ELD valid state */ | |
166 | tmp = I915_READ(aud_cntrl_st2); | |
167 | DRM_DEBUG_DRIVER("HDMI audio: pin eld vld status=0x%08x\n", tmp); | |
168 | tmp |= (AUDIO_ELD_VALID_A << (pipe * 4)); | |
169 | I915_WRITE(aud_cntrl_st2, tmp); | |
170 | tmp = I915_READ(aud_cntrl_st2); | |
171 | DRM_DEBUG_DRIVER("HDMI audio: eld vld status=0x%08x\n", tmp); | |
172 | ||
173 | /* Enable HDMI mode */ | |
174 | tmp = I915_READ(aud_config); | |
175 | DRM_DEBUG_DRIVER("HDMI audio: audio conf: 0x%08x\n", tmp); | |
176 | /* clear N_programing_enable and N_value_index */ | |
177 | tmp &= ~(AUD_CONFIG_N_VALUE_INDEX | AUD_CONFIG_N_PROG_ENABLE); | |
178 | I915_WRITE(aud_config, tmp); | |
179 | ||
180 | DRM_DEBUG_DRIVER("ELD on pipe %c\n", pipe_name(pipe)); | |
181 | ||
182 | eldv = AUDIO_ELD_VALID_A << (pipe * 4); | |
183 | ||
184 | if (intel_pipe_has_type(intel_crtc, INTEL_OUTPUT_DISPLAYPORT)) { | |
185 | DRM_DEBUG_DRIVER("ELD: DisplayPort detected\n"); | |
186 | eld[5] |= (1 << 2); /* Conn_Type, 0x1 = DisplayPort */ | |
187 | I915_WRITE(aud_config, AUD_CONFIG_N_VALUE_INDEX); /* 0x1 = DP */ | |
188 | } else { | |
189 | I915_WRITE(aud_config, audio_config_hdmi_pixel_clock(mode)); | |
190 | } | |
191 | ||
192 | if (intel_eld_uptodate(connector, | |
193 | aud_cntrl_st2, eldv, | |
194 | aud_cntl_st, IBX_ELD_ADDRESS, | |
195 | hdmiw_hdmiedid)) | |
196 | return; | |
197 | ||
f9f682ae JN |
198 | tmp = I915_READ(aud_cntrl_st2); |
199 | tmp &= ~eldv; | |
200 | I915_WRITE(aud_cntrl_st2, tmp); | |
7c10a2b5 JN |
201 | |
202 | if (!eld[0]) | |
203 | return; | |
204 | ||
f9f682ae JN |
205 | tmp = I915_READ(aud_cntl_st); |
206 | tmp &= ~IBX_ELD_ADDRESS; | |
207 | I915_WRITE(aud_cntl_st, tmp); | |
208 | port = (tmp >> 29) & DIP_PORT_SEL_MASK; /* DIP_Port_Select, 0x1 = PortB */ | |
209 | DRM_DEBUG_DRIVER("port num:%d\n", port); | |
7c10a2b5 | 210 | |
f9f682ae | 211 | len = min_t(int, eld[2], 21); /* 84 bytes of hw ELD buffer */ |
7c10a2b5 JN |
212 | DRM_DEBUG_DRIVER("ELD size %d\n", len); |
213 | for (i = 0; i < len; i++) | |
214 | I915_WRITE(hdmiw_hdmiedid, *((uint32_t *)eld + i)); | |
215 | ||
f9f682ae JN |
216 | tmp = I915_READ(aud_cntrl_st2); |
217 | tmp |= eldv; | |
218 | I915_WRITE(aud_cntrl_st2, tmp); | |
7c10a2b5 JN |
219 | } |
220 | ||
221 | static void ironlake_write_eld(struct drm_connector *connector, | |
222 | struct drm_crtc *crtc, | |
223 | struct drm_display_mode *mode) | |
224 | { | |
225 | struct drm_i915_private *dev_priv = connector->dev->dev_private; | |
226 | struct intel_crtc *intel_crtc = to_intel_crtc(crtc); | |
227 | uint8_t *eld = connector->eld; | |
228 | uint32_t eldv; | |
f9f682ae JN |
229 | uint32_t tmp; |
230 | int len, i; | |
7c10a2b5 JN |
231 | int hdmiw_hdmiedid; |
232 | int aud_config; | |
233 | int aud_cntl_st; | |
234 | int aud_cntrl_st2; | |
f9f682ae JN |
235 | enum pipe pipe = to_intel_crtc(crtc)->pipe; |
236 | enum port port; | |
7c10a2b5 JN |
237 | |
238 | if (HAS_PCH_IBX(connector->dev)) { | |
239 | hdmiw_hdmiedid = IBX_HDMIW_HDMIEDID(pipe); | |
240 | aud_config = IBX_AUD_CFG(pipe); | |
241 | aud_cntl_st = IBX_AUD_CNTL_ST(pipe); | |
242 | aud_cntrl_st2 = IBX_AUD_CNTL_ST2; | |
243 | } else if (IS_VALLEYVIEW(connector->dev)) { | |
244 | hdmiw_hdmiedid = VLV_HDMIW_HDMIEDID(pipe); | |
245 | aud_config = VLV_AUD_CFG(pipe); | |
246 | aud_cntl_st = VLV_AUD_CNTL_ST(pipe); | |
247 | aud_cntrl_st2 = VLV_AUD_CNTL_ST2; | |
248 | } else { | |
249 | hdmiw_hdmiedid = CPT_HDMIW_HDMIEDID(pipe); | |
250 | aud_config = CPT_AUD_CFG(pipe); | |
251 | aud_cntl_st = CPT_AUD_CNTL_ST(pipe); | |
252 | aud_cntrl_st2 = CPT_AUD_CNTRL_ST2; | |
253 | } | |
254 | ||
255 | DRM_DEBUG_DRIVER("ELD on pipe %c\n", pipe_name(pipe)); | |
256 | ||
257 | if (IS_VALLEYVIEW(connector->dev)) { | |
258 | struct intel_encoder *intel_encoder; | |
259 | struct intel_digital_port *intel_dig_port; | |
260 | ||
261 | intel_encoder = intel_attached_encoder(connector); | |
262 | intel_dig_port = enc_to_dig_port(&intel_encoder->base); | |
f9f682ae | 263 | port = intel_dig_port->port; |
7c10a2b5 | 264 | } else { |
f9f682ae JN |
265 | tmp = I915_READ(aud_cntl_st); |
266 | port = (tmp >> 29) & DIP_PORT_SEL_MASK; | |
7c10a2b5 JN |
267 | /* DIP_Port_Select, 0x1 = PortB */ |
268 | } | |
269 | ||
f9f682ae | 270 | if (!port) { |
7c10a2b5 JN |
271 | DRM_DEBUG_DRIVER("Audio directed to unknown port\n"); |
272 | /* operate blindly on all ports */ | |
273 | eldv = IBX_ELD_VALIDB; | |
274 | eldv |= IBX_ELD_VALIDB << 4; | |
275 | eldv |= IBX_ELD_VALIDB << 8; | |
276 | } else { | |
f9f682ae JN |
277 | DRM_DEBUG_DRIVER("ELD on port %c\n", port_name(port)); |
278 | eldv = IBX_ELD_VALIDB << ((port - 1) * 4); | |
7c10a2b5 JN |
279 | } |
280 | ||
281 | if (intel_pipe_has_type(intel_crtc, INTEL_OUTPUT_DISPLAYPORT)) { | |
282 | DRM_DEBUG_DRIVER("ELD: DisplayPort detected\n"); | |
283 | eld[5] |= (1 << 2); /* Conn_Type, 0x1 = DisplayPort */ | |
284 | I915_WRITE(aud_config, AUD_CONFIG_N_VALUE_INDEX); /* 0x1 = DP */ | |
285 | } else { | |
286 | I915_WRITE(aud_config, audio_config_hdmi_pixel_clock(mode)); | |
287 | } | |
288 | ||
289 | if (intel_eld_uptodate(connector, | |
290 | aud_cntrl_st2, eldv, | |
291 | aud_cntl_st, IBX_ELD_ADDRESS, | |
292 | hdmiw_hdmiedid)) | |
293 | return; | |
294 | ||
f9f682ae JN |
295 | tmp = I915_READ(aud_cntrl_st2); |
296 | tmp &= ~eldv; | |
297 | I915_WRITE(aud_cntrl_st2, tmp); | |
7c10a2b5 JN |
298 | |
299 | if (!eld[0]) | |
300 | return; | |
301 | ||
f9f682ae JN |
302 | tmp = I915_READ(aud_cntl_st); |
303 | tmp &= ~IBX_ELD_ADDRESS; | |
304 | I915_WRITE(aud_cntl_st, tmp); | |
7c10a2b5 | 305 | |
f9f682ae | 306 | len = min_t(int, eld[2], 21); /* 84 bytes of hw ELD buffer */ |
7c10a2b5 JN |
307 | DRM_DEBUG_DRIVER("ELD size %d\n", len); |
308 | for (i = 0; i < len; i++) | |
309 | I915_WRITE(hdmiw_hdmiedid, *((uint32_t *)eld + i)); | |
310 | ||
f9f682ae JN |
311 | tmp = I915_READ(aud_cntrl_st2); |
312 | tmp |= eldv; | |
313 | I915_WRITE(aud_cntrl_st2, tmp); | |
7c10a2b5 JN |
314 | } |
315 | ||
316 | void intel_write_eld(struct drm_encoder *encoder, | |
317 | struct drm_display_mode *mode) | |
318 | { | |
319 | struct drm_crtc *crtc = encoder->crtc; | |
320 | struct drm_connector *connector; | |
321 | struct drm_device *dev = encoder->dev; | |
322 | struct drm_i915_private *dev_priv = dev->dev_private; | |
323 | ||
324 | connector = drm_select_eld(encoder, mode); | |
325 | if (!connector) | |
326 | return; | |
327 | ||
328 | DRM_DEBUG_DRIVER("ELD on [CONNECTOR:%d:%s], [ENCODER:%d:%s]\n", | |
329 | connector->base.id, | |
330 | connector->name, | |
331 | connector->encoder->base.id, | |
332 | connector->encoder->name); | |
333 | ||
334 | connector->eld[6] = drm_av_sync_delay(connector, mode) / 2; | |
335 | ||
336 | if (dev_priv->display.write_eld) | |
337 | dev_priv->display.write_eld(connector, crtc, mode); | |
338 | } | |
339 | ||
340 | /** | |
341 | * intel_init_audio - Set up chip specific audio functions | |
342 | * @dev: drm device | |
343 | */ | |
344 | void intel_init_audio(struct drm_device *dev) | |
345 | { | |
346 | struct drm_i915_private *dev_priv = dev->dev_private; | |
347 | ||
348 | if (IS_G4X(dev)) | |
349 | dev_priv->display.write_eld = g4x_write_eld; | |
350 | else if (IS_VALLEYVIEW(dev)) | |
351 | dev_priv->display.write_eld = ironlake_write_eld; | |
352 | else if (IS_HASWELL(dev) || INTEL_INFO(dev)->gen >= 8) | |
353 | dev_priv->display.write_eld = haswell_write_eld; | |
354 | else if (HAS_PCH_SPLIT(dev)) | |
355 | dev_priv->display.write_eld = ironlake_write_eld; | |
356 | } |