1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
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/drm_edid.h>
31#include "i915_drv.h"
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61#define LC_810M 810000
62#define LC_540M 540000
63#define LC_270M 270000
64#define LC_162M 162000
65
66struct dp_aud_n_m {
67 int sample_rate;
68 int clock;
69 u16 m;
70 u16 n;
71};
72
73
74static 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 { 32000, LC_810M, 1024, 50625 },
103 { 44100, LC_810M, 784, 28125 },
104 { 48000, LC_810M, 512, 16875 },
105 { 64000, LC_810M, 2048, 50625 },
106 { 88200, LC_810M, 1568, 28125 },
107 { 96000, LC_810M, 1024, 16875 },
108 { 128000, LC_810M, 4096, 50625 },
109 { 176400, LC_810M, 3136, 28125 },
110 { 192000, LC_810M, 2048, 16875 },
111};
112
113static const struct dp_aud_n_m *
114audio_config_dp_get_n_m(const struct intel_crtc_state *crtc_state, int rate)
115{
116 int i;
117
118 for (i = 0; i < ARRAY_SIZE(dp_aud_n_m); i++) {
119 if (rate == dp_aud_n_m[i].sample_rate &&
120 crtc_state->port_clock == dp_aud_n_m[i].clock)
121 return &dp_aud_n_m[i];
122 }
123
124 return NULL;
125}
126
127static const struct {
128 int clock;
129 u32 config;
130} hdmi_audio_clock[] = {
131 { 25175, AUD_CONFIG_PIXEL_CLOCK_HDMI_25175 },
132 { 25200, AUD_CONFIG_PIXEL_CLOCK_HDMI_25200 },
133 { 27000, AUD_CONFIG_PIXEL_CLOCK_HDMI_27000 },
134 { 27027, AUD_CONFIG_PIXEL_CLOCK_HDMI_27027 },
135 { 54000, AUD_CONFIG_PIXEL_CLOCK_HDMI_54000 },
136 { 54054, AUD_CONFIG_PIXEL_CLOCK_HDMI_54054 },
137 { 74176, AUD_CONFIG_PIXEL_CLOCK_HDMI_74176 },
138 { 74250, AUD_CONFIG_PIXEL_CLOCK_HDMI_74250 },
139 { 148352, AUD_CONFIG_PIXEL_CLOCK_HDMI_148352 },
140 { 148500, AUD_CONFIG_PIXEL_CLOCK_HDMI_148500 },
141};
142
143
144#define TMDS_297M 297000
145#define TMDS_296M 296703
146#define TMDS_594M 594000
147#define TMDS_593M 593407
148
149static const struct {
150 int sample_rate;
151 int clock;
152 int n;
153 int cts;
154} hdmi_aud_ncts[] = {
155 { 32000, TMDS_296M, 5824, 421875 },
156 { 32000, TMDS_297M, 3072, 222750 },
157 { 32000, TMDS_593M, 5824, 843750 },
158 { 32000, TMDS_594M, 3072, 445500 },
159 { 44100, TMDS_296M, 4459, 234375 },
160 { 44100, TMDS_297M, 4704, 247500 },
161 { 44100, TMDS_593M, 8918, 937500 },
162 { 44100, TMDS_594M, 9408, 990000 },
163 { 88200, TMDS_296M, 8918, 234375 },
164 { 88200, TMDS_297M, 9408, 247500 },
165 { 88200, TMDS_593M, 17836, 937500 },
166 { 88200, TMDS_594M, 18816, 990000 },
167 { 176400, TMDS_296M, 17836, 234375 },
168 { 176400, TMDS_297M, 18816, 247500 },
169 { 176400, TMDS_593M, 35672, 937500 },
170 { 176400, TMDS_594M, 37632, 990000 },
171 { 48000, TMDS_296M, 5824, 281250 },
172 { 48000, TMDS_297M, 5120, 247500 },
173 { 48000, TMDS_593M, 5824, 562500 },
174 { 48000, TMDS_594M, 6144, 594000 },
175 { 96000, TMDS_296M, 11648, 281250 },
176 { 96000, TMDS_297M, 10240, 247500 },
177 { 96000, TMDS_593M, 11648, 562500 },
178 { 96000, TMDS_594M, 12288, 594000 },
179 { 192000, TMDS_296M, 23296, 281250 },
180 { 192000, TMDS_297M, 20480, 247500 },
181 { 192000, TMDS_593M, 23296, 562500 },
182 { 192000, TMDS_594M, 24576, 594000 },
183};
184
185
186static u32 audio_config_hdmi_pixel_clock(const struct intel_crtc_state *crtc_state)
187{
188 const struct drm_display_mode *adjusted_mode =
189 &crtc_state->base.adjusted_mode;
190 int i;
191
192 for (i = 0; i < ARRAY_SIZE(hdmi_audio_clock); i++) {
193 if (adjusted_mode->crtc_clock == hdmi_audio_clock[i].clock)
194 break;
195 }
196
197 if (i == ARRAY_SIZE(hdmi_audio_clock)) {
198 DRM_DEBUG_KMS("HDMI audio pixel clock setting for %d not found, falling back to defaults\n",
199 adjusted_mode->crtc_clock);
200 i = 1;
201 }
202
203 DRM_DEBUG_KMS("Configuring HDMI audio for pixel clock %d (0x%08x)\n",
204 hdmi_audio_clock[i].clock,
205 hdmi_audio_clock[i].config);
206
207 return hdmi_audio_clock[i].config;
208}
209
210static int audio_config_hdmi_get_n(const struct intel_crtc_state *crtc_state,
211 int rate)
212{
213 const struct drm_display_mode *adjusted_mode =
214 &crtc_state->base.adjusted_mode;
215 int i;
216
217 for (i = 0; i < ARRAY_SIZE(hdmi_aud_ncts); i++) {
218 if (rate == hdmi_aud_ncts[i].sample_rate &&
219 adjusted_mode->crtc_clock == hdmi_aud_ncts[i].clock) {
220 return hdmi_aud_ncts[i].n;
221 }
222 }
223 return 0;
224}
225
226static bool intel_eld_uptodate(struct drm_connector *connector,
227 i915_reg_t reg_eldv, u32 bits_eldv,
228 i915_reg_t reg_elda, u32 bits_elda,
229 i915_reg_t reg_edid)
230{
231 struct drm_i915_private *dev_priv = to_i915(connector->dev);
232 const u8 *eld = connector->eld;
233 u32 tmp;
234 int i;
235
236 tmp = I915_READ(reg_eldv);
237 tmp &= bits_eldv;
238
239 if (!tmp)
240 return false;
241
242 tmp = I915_READ(reg_elda);
243 tmp &= ~bits_elda;
244 I915_WRITE(reg_elda, tmp);
245
246 for (i = 0; i < drm_eld_size(eld) / 4; i++)
247 if (I915_READ(reg_edid) != *((const u32 *)eld + i))
248 return false;
249
250 return true;
251}
252
253static void g4x_audio_codec_disable(struct intel_encoder *encoder,
254 const struct intel_crtc_state *old_crtc_state,
255 const struct drm_connector_state *old_conn_state)
256{
257 struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
258 u32 eldv, tmp;
259
260 DRM_DEBUG_KMS("Disable audio codec\n");
261
262 tmp = I915_READ(G4X_AUD_VID_DID);
263 if (tmp == INTEL_AUDIO_DEVBLC || tmp == INTEL_AUDIO_DEVCL)
264 eldv = G4X_ELDV_DEVCL_DEVBLC;
265 else
266 eldv = G4X_ELDV_DEVCTG;
267
268
269 tmp = I915_READ(G4X_AUD_CNTL_ST);
270 tmp &= ~eldv;
271 I915_WRITE(G4X_AUD_CNTL_ST, tmp);
272}
273
274static void g4x_audio_codec_enable(struct intel_encoder *encoder,
275 const struct intel_crtc_state *crtc_state,
276 const struct drm_connector_state *conn_state)
277{
278 struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
279 struct drm_connector *connector = conn_state->connector;
280 const u8 *eld = connector->eld;
281 u32 eldv;
282 u32 tmp;
283 int len, i;
284
285 DRM_DEBUG_KMS("Enable audio codec, %u bytes ELD\n", drm_eld_size(eld));
286
287 tmp = I915_READ(G4X_AUD_VID_DID);
288 if (tmp == INTEL_AUDIO_DEVBLC || tmp == INTEL_AUDIO_DEVCL)
289 eldv = G4X_ELDV_DEVCL_DEVBLC;
290 else
291 eldv = G4X_ELDV_DEVCTG;
292
293 if (intel_eld_uptodate(connector,
294 G4X_AUD_CNTL_ST, eldv,
295 G4X_AUD_CNTL_ST, G4X_ELD_ADDR_MASK,
296 G4X_HDMIW_HDMIEDID))
297 return;
298
299 tmp = I915_READ(G4X_AUD_CNTL_ST);
300 tmp &= ~(eldv | G4X_ELD_ADDR_MASK);
301 len = (tmp >> 9) & 0x1f;
302 I915_WRITE(G4X_AUD_CNTL_ST, tmp);
303
304 len = min(drm_eld_size(eld) / 4, len);
305 DRM_DEBUG_DRIVER("ELD size %d\n", len);
306 for (i = 0; i < len; i++)
307 I915_WRITE(G4X_HDMIW_HDMIEDID, *((const u32 *)eld + i));
308
309 tmp = I915_READ(G4X_AUD_CNTL_ST);
310 tmp |= eldv;
311 I915_WRITE(G4X_AUD_CNTL_ST, tmp);
312}
313
314static void
315hsw_dp_audio_config_update(struct intel_encoder *encoder,
316 const struct intel_crtc_state *crtc_state)
317{
318 struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
319 struct i915_audio_component *acomp = dev_priv->audio_component;
320 struct intel_crtc *crtc = to_intel_crtc(crtc_state->base.crtc);
321 enum port port = encoder->port;
322 enum pipe pipe = crtc->pipe;
323 const struct dp_aud_n_m *nm;
324 int rate;
325 u32 tmp;
326
327 rate = acomp ? acomp->aud_sample_rate[port] : 0;
328 nm = audio_config_dp_get_n_m(crtc_state, rate);
329 if (nm)
330 DRM_DEBUG_KMS("using Maud %u, Naud %u\n", nm->m, nm->n);
331 else
332 DRM_DEBUG_KMS("using automatic Maud, Naud\n");
333
334 tmp = I915_READ(HSW_AUD_CFG(pipe));
335 tmp &= ~AUD_CONFIG_N_VALUE_INDEX;
336 tmp &= ~AUD_CONFIG_PIXEL_CLOCK_HDMI_MASK;
337 tmp &= ~AUD_CONFIG_N_PROG_ENABLE;
338 tmp |= AUD_CONFIG_N_VALUE_INDEX;
339
340 if (nm) {
341 tmp &= ~AUD_CONFIG_N_MASK;
342 tmp |= AUD_CONFIG_N(nm->n);
343 tmp |= AUD_CONFIG_N_PROG_ENABLE;
344 }
345
346 I915_WRITE(HSW_AUD_CFG(pipe), tmp);
347
348 tmp = I915_READ(HSW_AUD_M_CTS_ENABLE(pipe));
349 tmp &= ~AUD_CONFIG_M_MASK;
350 tmp &= ~AUD_M_CTS_M_VALUE_INDEX;
351 tmp &= ~AUD_M_CTS_M_PROG_ENABLE;
352
353 if (nm) {
354 tmp |= nm->m;
355 tmp |= AUD_M_CTS_M_VALUE_INDEX;
356 tmp |= AUD_M_CTS_M_PROG_ENABLE;
357 }
358
359 I915_WRITE(HSW_AUD_M_CTS_ENABLE(pipe), tmp);
360}
361
362static void
363hsw_hdmi_audio_config_update(struct intel_encoder *encoder,
364 const struct intel_crtc_state *crtc_state)
365{
366 struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
367 struct i915_audio_component *acomp = dev_priv->audio_component;
368 struct intel_crtc *crtc = to_intel_crtc(crtc_state->base.crtc);
369 enum port port = encoder->port;
370 enum pipe pipe = crtc->pipe;
371 int n, rate;
372 u32 tmp;
373
374 rate = acomp ? acomp->aud_sample_rate[port] : 0;
375
376 tmp = I915_READ(HSW_AUD_CFG(pipe));
377 tmp &= ~AUD_CONFIG_N_VALUE_INDEX;
378 tmp &= ~AUD_CONFIG_PIXEL_CLOCK_HDMI_MASK;
379 tmp &= ~AUD_CONFIG_N_PROG_ENABLE;
380 tmp |= audio_config_hdmi_pixel_clock(crtc_state);
381
382 n = audio_config_hdmi_get_n(crtc_state, rate);
383 if (n != 0) {
384 DRM_DEBUG_KMS("using N %d\n", n);
385
386 tmp &= ~AUD_CONFIG_N_MASK;
387 tmp |= AUD_CONFIG_N(n);
388 tmp |= AUD_CONFIG_N_PROG_ENABLE;
389 } else {
390 DRM_DEBUG_KMS("using automatic N\n");
391 }
392
393 I915_WRITE(HSW_AUD_CFG(pipe), tmp);
394
395
396
397
398
399 tmp = I915_READ(HSW_AUD_M_CTS_ENABLE(pipe));
400 tmp &= ~AUD_M_CTS_M_PROG_ENABLE;
401 tmp &= ~AUD_M_CTS_M_VALUE_INDEX;
402 I915_WRITE(HSW_AUD_M_CTS_ENABLE(pipe), tmp);
403}
404
405static void
406hsw_audio_config_update(struct intel_encoder *encoder,
407 const struct intel_crtc_state *crtc_state)
408{
409 if (intel_crtc_has_dp_encoder(crtc_state))
410 hsw_dp_audio_config_update(encoder, crtc_state);
411 else
412 hsw_hdmi_audio_config_update(encoder, crtc_state);
413}
414
415static void hsw_audio_codec_disable(struct intel_encoder *encoder,
416 const struct intel_crtc_state *old_crtc_state,
417 const struct drm_connector_state *old_conn_state)
418{
419 struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
420 struct intel_crtc *crtc = to_intel_crtc(old_crtc_state->base.crtc);
421 enum pipe pipe = crtc->pipe;
422 u32 tmp;
423
424 DRM_DEBUG_KMS("Disable audio codec on pipe %c\n", pipe_name(pipe));
425
426 mutex_lock(&dev_priv->av_mutex);
427
428
429 tmp = I915_READ(HSW_AUD_CFG(pipe));
430 tmp &= ~AUD_CONFIG_N_VALUE_INDEX;
431 tmp |= AUD_CONFIG_N_PROG_ENABLE;
432 tmp &= ~AUD_CONFIG_UPPER_N_MASK;
433 tmp &= ~AUD_CONFIG_LOWER_N_MASK;
434 if (intel_crtc_has_dp_encoder(old_crtc_state))
435 tmp |= AUD_CONFIG_N_VALUE_INDEX;
436 I915_WRITE(HSW_AUD_CFG(pipe), tmp);
437
438
439 tmp = I915_READ(HSW_AUD_PIN_ELD_CP_VLD);
440 tmp &= ~AUDIO_ELD_VALID(pipe);
441 tmp &= ~AUDIO_OUTPUT_ENABLE(pipe);
442 I915_WRITE(HSW_AUD_PIN_ELD_CP_VLD, tmp);
443
444 mutex_unlock(&dev_priv->av_mutex);
445}
446
447static void hsw_audio_codec_enable(struct intel_encoder *encoder,
448 const struct intel_crtc_state *crtc_state,
449 const struct drm_connector_state *conn_state)
450{
451 struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
452 struct intel_crtc *crtc = to_intel_crtc(crtc_state->base.crtc);
453 struct drm_connector *connector = conn_state->connector;
454 enum pipe pipe = crtc->pipe;
455 const u8 *eld = connector->eld;
456 u32 tmp;
457 int len, i;
458
459 DRM_DEBUG_KMS("Enable audio codec on pipe %c, %u bytes ELD\n",
460 pipe_name(pipe), drm_eld_size(eld));
461
462 mutex_lock(&dev_priv->av_mutex);
463
464
465 tmp = I915_READ(HSW_AUD_PIN_ELD_CP_VLD);
466 tmp |= AUDIO_OUTPUT_ENABLE(pipe);
467 tmp &= ~AUDIO_ELD_VALID(pipe);
468 I915_WRITE(HSW_AUD_PIN_ELD_CP_VLD, tmp);
469
470
471
472
473
474
475
476
477
478 tmp = I915_READ(HSW_AUD_DIP_ELD_CTRL(pipe));
479 tmp &= ~IBX_ELD_ADDRESS_MASK;
480 I915_WRITE(HSW_AUD_DIP_ELD_CTRL(pipe), tmp);
481
482
483 len = min(drm_eld_size(eld), 84);
484 for (i = 0; i < len / 4; i++)
485 I915_WRITE(HSW_AUD_EDID_DATA(pipe), *((const u32 *)eld + i));
486
487
488 tmp = I915_READ(HSW_AUD_PIN_ELD_CP_VLD);
489 tmp |= AUDIO_ELD_VALID(pipe);
490 I915_WRITE(HSW_AUD_PIN_ELD_CP_VLD, tmp);
491
492
493 hsw_audio_config_update(encoder, crtc_state);
494
495 mutex_unlock(&dev_priv->av_mutex);
496}
497
498static void ilk_audio_codec_disable(struct intel_encoder *encoder,
499 const struct intel_crtc_state *old_crtc_state,
500 const struct drm_connector_state *old_conn_state)
501{
502 struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
503 struct intel_crtc *crtc = to_intel_crtc(old_crtc_state->base.crtc);
504 enum pipe pipe = crtc->pipe;
505 enum port port = encoder->port;
506 u32 tmp, eldv;
507 i915_reg_t aud_config, aud_cntrl_st2;
508
509 DRM_DEBUG_KMS("Disable audio codec on port %c, pipe %c\n",
510 port_name(port), pipe_name(pipe));
511
512 if (WARN_ON(port == PORT_A))
513 return;
514
515 if (HAS_PCH_IBX(dev_priv)) {
516 aud_config = IBX_AUD_CFG(pipe);
517 aud_cntrl_st2 = IBX_AUD_CNTL_ST2;
518 } else if (IS_VALLEYVIEW(dev_priv) || IS_CHERRYVIEW(dev_priv)) {
519 aud_config = VLV_AUD_CFG(pipe);
520 aud_cntrl_st2 = VLV_AUD_CNTL_ST2;
521 } else {
522 aud_config = CPT_AUD_CFG(pipe);
523 aud_cntrl_st2 = CPT_AUD_CNTRL_ST2;
524 }
525
526
527 tmp = I915_READ(aud_config);
528 tmp &= ~AUD_CONFIG_N_VALUE_INDEX;
529 tmp |= AUD_CONFIG_N_PROG_ENABLE;
530 tmp &= ~AUD_CONFIG_UPPER_N_MASK;
531 tmp &= ~AUD_CONFIG_LOWER_N_MASK;
532 if (intel_crtc_has_dp_encoder(old_crtc_state))
533 tmp |= AUD_CONFIG_N_VALUE_INDEX;
534 I915_WRITE(aud_config, tmp);
535
536 eldv = IBX_ELD_VALID(port);
537
538
539 tmp = I915_READ(aud_cntrl_st2);
540 tmp &= ~eldv;
541 I915_WRITE(aud_cntrl_st2, tmp);
542}
543
544static void ilk_audio_codec_enable(struct intel_encoder *encoder,
545 const struct intel_crtc_state *crtc_state,
546 const struct drm_connector_state *conn_state)
547{
548 struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
549 struct intel_crtc *crtc = to_intel_crtc(crtc_state->base.crtc);
550 struct drm_connector *connector = conn_state->connector;
551 enum pipe pipe = crtc->pipe;
552 enum port port = encoder->port;
553 const u8 *eld = connector->eld;
554 u32 tmp, eldv;
555 int len, i;
556 i915_reg_t hdmiw_hdmiedid, aud_config, aud_cntl_st, aud_cntrl_st2;
557
558 DRM_DEBUG_KMS("Enable audio codec on port %c, pipe %c, %u bytes ELD\n",
559 port_name(port), pipe_name(pipe), drm_eld_size(eld));
560
561 if (WARN_ON(port == PORT_A))
562 return;
563
564
565
566
567
568
569
570
571 if (HAS_PCH_IBX(dev_priv)) {
572 hdmiw_hdmiedid = IBX_HDMIW_HDMIEDID(pipe);
573 aud_config = IBX_AUD_CFG(pipe);
574 aud_cntl_st = IBX_AUD_CNTL_ST(pipe);
575 aud_cntrl_st2 = IBX_AUD_CNTL_ST2;
576 } else if (IS_VALLEYVIEW(dev_priv) ||
577 IS_CHERRYVIEW(dev_priv)) {
578 hdmiw_hdmiedid = VLV_HDMIW_HDMIEDID(pipe);
579 aud_config = VLV_AUD_CFG(pipe);
580 aud_cntl_st = VLV_AUD_CNTL_ST(pipe);
581 aud_cntrl_st2 = VLV_AUD_CNTL_ST2;
582 } else {
583 hdmiw_hdmiedid = CPT_HDMIW_HDMIEDID(pipe);
584 aud_config = CPT_AUD_CFG(pipe);
585 aud_cntl_st = CPT_AUD_CNTL_ST(pipe);
586 aud_cntrl_st2 = CPT_AUD_CNTRL_ST2;
587 }
588
589 eldv = IBX_ELD_VALID(port);
590
591
592 tmp = I915_READ(aud_cntrl_st2);
593 tmp &= ~eldv;
594 I915_WRITE(aud_cntrl_st2, tmp);
595
596
597 tmp = I915_READ(aud_cntl_st);
598 tmp &= ~IBX_ELD_ADDRESS_MASK;
599 I915_WRITE(aud_cntl_st, tmp);
600
601
602 len = min(drm_eld_size(eld), 84);
603 for (i = 0; i < len / 4; i++)
604 I915_WRITE(hdmiw_hdmiedid, *((const u32 *)eld + i));
605
606
607 tmp = I915_READ(aud_cntrl_st2);
608 tmp |= eldv;
609 I915_WRITE(aud_cntrl_st2, tmp);
610
611
612 tmp = I915_READ(aud_config);
613 tmp &= ~AUD_CONFIG_N_VALUE_INDEX;
614 tmp &= ~AUD_CONFIG_N_PROG_ENABLE;
615 tmp &= ~AUD_CONFIG_PIXEL_CLOCK_HDMI_MASK;
616 if (intel_crtc_has_dp_encoder(crtc_state))
617 tmp |= AUD_CONFIG_N_VALUE_INDEX;
618 else
619 tmp |= audio_config_hdmi_pixel_clock(crtc_state);
620 I915_WRITE(aud_config, tmp);
621}
622
623
624
625
626
627
628
629
630
631
632void intel_audio_codec_enable(struct intel_encoder *encoder,
633 const struct intel_crtc_state *crtc_state,
634 const struct drm_connector_state *conn_state)
635{
636 struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
637 struct i915_audio_component *acomp = dev_priv->audio_component;
638 struct intel_crtc *crtc = to_intel_crtc(crtc_state->base.crtc);
639 struct drm_connector *connector = conn_state->connector;
640 const struct drm_display_mode *adjusted_mode =
641 &crtc_state->base.adjusted_mode;
642 enum port port = encoder->port;
643 enum pipe pipe = crtc->pipe;
644
645 if (!connector->eld[0])
646 return;
647
648 DRM_DEBUG_DRIVER("ELD on [CONNECTOR:%d:%s], [ENCODER:%d:%s]\n",
649 connector->base.id,
650 connector->name,
651 connector->encoder->base.id,
652 connector->encoder->name);
653
654 connector->eld[6] = drm_av_sync_delay(connector, adjusted_mode) / 2;
655
656 if (dev_priv->display.audio_codec_enable)
657 dev_priv->display.audio_codec_enable(encoder,
658 crtc_state,
659 conn_state);
660
661 mutex_lock(&dev_priv->av_mutex);
662 encoder->audio_connector = connector;
663
664
665 dev_priv->av_enc_map[pipe] = encoder;
666 mutex_unlock(&dev_priv->av_mutex);
667
668 if (acomp && acomp->base.audio_ops &&
669 acomp->base.audio_ops->pin_eld_notify) {
670
671 if (!intel_crtc_has_type(crtc_state, INTEL_OUTPUT_DP_MST))
672 pipe = -1;
673 acomp->base.audio_ops->pin_eld_notify(acomp->base.audio_ops->audio_ptr,
674 (int) port, (int) pipe);
675 }
676
677 intel_lpe_audio_notify(dev_priv, pipe, port, connector->eld,
678 crtc_state->port_clock,
679 intel_crtc_has_dp_encoder(crtc_state));
680}
681
682
683
684
685
686
687
688
689
690
691void intel_audio_codec_disable(struct intel_encoder *encoder,
692 const struct intel_crtc_state *old_crtc_state,
693 const struct drm_connector_state *old_conn_state)
694{
695 struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
696 struct i915_audio_component *acomp = dev_priv->audio_component;
697 struct intel_crtc *crtc = to_intel_crtc(old_crtc_state->base.crtc);
698 enum port port = encoder->port;
699 enum pipe pipe = crtc->pipe;
700
701 if (dev_priv->display.audio_codec_disable)
702 dev_priv->display.audio_codec_disable(encoder,
703 old_crtc_state,
704 old_conn_state);
705
706 mutex_lock(&dev_priv->av_mutex);
707 encoder->audio_connector = NULL;
708 dev_priv->av_enc_map[pipe] = NULL;
709 mutex_unlock(&dev_priv->av_mutex);
710
711 if (acomp && acomp->base.audio_ops &&
712 acomp->base.audio_ops->pin_eld_notify) {
713
714 if (!intel_crtc_has_type(old_crtc_state, INTEL_OUTPUT_DP_MST))
715 pipe = -1;
716 acomp->base.audio_ops->pin_eld_notify(acomp->base.audio_ops->audio_ptr,
717 (int) port, (int) pipe);
718 }
719
720 intel_lpe_audio_notify(dev_priv, pipe, port, NULL, 0, false);
721}
722
723
724
725
726
727void intel_init_audio_hooks(struct drm_i915_private *dev_priv)
728{
729 if (IS_G4X(dev_priv)) {
730 dev_priv->display.audio_codec_enable = g4x_audio_codec_enable;
731 dev_priv->display.audio_codec_disable = g4x_audio_codec_disable;
732 } else if (IS_VALLEYVIEW(dev_priv) || IS_CHERRYVIEW(dev_priv)) {
733 dev_priv->display.audio_codec_enable = ilk_audio_codec_enable;
734 dev_priv->display.audio_codec_disable = ilk_audio_codec_disable;
735 } else if (IS_HASWELL(dev_priv) || INTEL_GEN(dev_priv) >= 8) {
736 dev_priv->display.audio_codec_enable = hsw_audio_codec_enable;
737 dev_priv->display.audio_codec_disable = hsw_audio_codec_disable;
738 } else if (HAS_PCH_SPLIT(dev_priv)) {
739 dev_priv->display.audio_codec_enable = ilk_audio_codec_enable;
740 dev_priv->display.audio_codec_disable = ilk_audio_codec_disable;
741 }
742}
743
744static void i915_audio_component_get_power(struct device *kdev)
745{
746 intel_display_power_get(kdev_to_i915(kdev), POWER_DOMAIN_AUDIO);
747}
748
749static void i915_audio_component_put_power(struct device *kdev)
750{
751 intel_display_power_put_unchecked(kdev_to_i915(kdev),
752 POWER_DOMAIN_AUDIO);
753}
754
755static void i915_audio_component_codec_wake_override(struct device *kdev,
756 bool enable)
757{
758 struct drm_i915_private *dev_priv = kdev_to_i915(kdev);
759 u32 tmp;
760
761 if (!IS_GEN(dev_priv, 9))
762 return;
763
764 i915_audio_component_get_power(kdev);
765
766
767
768
769
770 tmp = I915_READ(HSW_AUD_CHICKENBIT);
771 tmp &= ~SKL_AUD_CODEC_WAKE_SIGNAL;
772 I915_WRITE(HSW_AUD_CHICKENBIT, tmp);
773 usleep_range(1000, 1500);
774
775 if (enable) {
776 tmp = I915_READ(HSW_AUD_CHICKENBIT);
777 tmp |= SKL_AUD_CODEC_WAKE_SIGNAL;
778 I915_WRITE(HSW_AUD_CHICKENBIT, tmp);
779 usleep_range(1000, 1500);
780 }
781
782 i915_audio_component_put_power(kdev);
783}
784
785
786static int i915_audio_component_get_cdclk_freq(struct device *kdev)
787{
788 struct drm_i915_private *dev_priv = kdev_to_i915(kdev);
789
790 if (WARN_ON_ONCE(!HAS_DDI(dev_priv)))
791 return -ENODEV;
792
793 return dev_priv->cdclk.hw.cdclk;
794}
795
796
797
798
799
800
801
802
803
804
805
806static struct intel_encoder *get_saved_enc(struct drm_i915_private *dev_priv,
807 int port, int pipe)
808{
809 struct intel_encoder *encoder;
810
811
812 if (pipe >= 0) {
813 if (WARN_ON(pipe >= ARRAY_SIZE(dev_priv->av_enc_map)))
814 return NULL;
815
816 encoder = dev_priv->av_enc_map[pipe];
817
818
819
820
821
822 if (encoder != NULL && encoder->port == port &&
823 encoder->type == INTEL_OUTPUT_DP_MST)
824 return encoder;
825 }
826
827
828 if (pipe > 0)
829 return NULL;
830
831 for_each_pipe(dev_priv, pipe) {
832 encoder = dev_priv->av_enc_map[pipe];
833 if (encoder == NULL)
834 continue;
835
836 if (encoder->type == INTEL_OUTPUT_DP_MST)
837 continue;
838
839 if (port == encoder->port)
840 return encoder;
841 }
842
843 return NULL;
844}
845
846static int i915_audio_component_sync_audio_rate(struct device *kdev, int port,
847 int pipe, int rate)
848{
849 struct drm_i915_private *dev_priv = kdev_to_i915(kdev);
850 struct i915_audio_component *acomp = dev_priv->audio_component;
851 struct intel_encoder *encoder;
852 struct intel_crtc *crtc;
853 int err = 0;
854
855 if (!HAS_DDI(dev_priv))
856 return 0;
857
858 i915_audio_component_get_power(kdev);
859 mutex_lock(&dev_priv->av_mutex);
860
861
862 encoder = get_saved_enc(dev_priv, port, pipe);
863 if (!encoder || !encoder->base.crtc) {
864 DRM_DEBUG_KMS("Not valid for port %c\n", port_name(port));
865 err = -ENODEV;
866 goto unlock;
867 }
868
869 crtc = to_intel_crtc(encoder->base.crtc);
870
871
872 acomp->aud_sample_rate[port] = rate;
873
874 hsw_audio_config_update(encoder, crtc->config);
875
876 unlock:
877 mutex_unlock(&dev_priv->av_mutex);
878 i915_audio_component_put_power(kdev);
879 return err;
880}
881
882static int i915_audio_component_get_eld(struct device *kdev, int port,
883 int pipe, bool *enabled,
884 unsigned char *buf, int max_bytes)
885{
886 struct drm_i915_private *dev_priv = kdev_to_i915(kdev);
887 struct intel_encoder *intel_encoder;
888 const u8 *eld;
889 int ret = -EINVAL;
890
891 mutex_lock(&dev_priv->av_mutex);
892
893 intel_encoder = get_saved_enc(dev_priv, port, pipe);
894 if (!intel_encoder) {
895 DRM_DEBUG_KMS("Not valid for port %c\n", port_name(port));
896 mutex_unlock(&dev_priv->av_mutex);
897 return ret;
898 }
899
900 ret = 0;
901 *enabled = intel_encoder->audio_connector != NULL;
902 if (*enabled) {
903 eld = intel_encoder->audio_connector->eld;
904 ret = drm_eld_size(eld);
905 memcpy(buf, eld, min(max_bytes, ret));
906 }
907
908 mutex_unlock(&dev_priv->av_mutex);
909 return ret;
910}
911
912static const struct drm_audio_component_ops i915_audio_component_ops = {
913 .owner = THIS_MODULE,
914 .get_power = i915_audio_component_get_power,
915 .put_power = i915_audio_component_put_power,
916 .codec_wake_override = i915_audio_component_codec_wake_override,
917 .get_cdclk_freq = i915_audio_component_get_cdclk_freq,
918 .sync_audio_rate = i915_audio_component_sync_audio_rate,
919 .get_eld = i915_audio_component_get_eld,
920};
921
922static int i915_audio_component_bind(struct device *i915_kdev,
923 struct device *hda_kdev, void *data)
924{
925 struct i915_audio_component *acomp = data;
926 struct drm_i915_private *dev_priv = kdev_to_i915(i915_kdev);
927 int i;
928
929 if (WARN_ON(acomp->base.ops || acomp->base.dev))
930 return -EEXIST;
931
932 if (WARN_ON(!device_link_add(hda_kdev, i915_kdev, DL_FLAG_STATELESS)))
933 return -ENOMEM;
934
935 drm_modeset_lock_all(&dev_priv->drm);
936 acomp->base.ops = &i915_audio_component_ops;
937 acomp->base.dev = i915_kdev;
938 BUILD_BUG_ON(MAX_PORTS != I915_MAX_PORTS);
939 for (i = 0; i < ARRAY_SIZE(acomp->aud_sample_rate); i++)
940 acomp->aud_sample_rate[i] = 0;
941 dev_priv->audio_component = acomp;
942 drm_modeset_unlock_all(&dev_priv->drm);
943
944 return 0;
945}
946
947static void i915_audio_component_unbind(struct device *i915_kdev,
948 struct device *hda_kdev, void *data)
949{
950 struct i915_audio_component *acomp = data;
951 struct drm_i915_private *dev_priv = kdev_to_i915(i915_kdev);
952
953 drm_modeset_lock_all(&dev_priv->drm);
954 acomp->base.ops = NULL;
955 acomp->base.dev = NULL;
956 dev_priv->audio_component = NULL;
957 drm_modeset_unlock_all(&dev_priv->drm);
958
959 device_link_remove(hda_kdev, i915_kdev);
960}
961
962static const struct component_ops i915_audio_component_bind_ops = {
963 .bind = i915_audio_component_bind,
964 .unbind = i915_audio_component_unbind,
965};
966
967
968
969
970
971
972
973
974
975
976
977
978
979
980
981
982
983void i915_audio_component_init(struct drm_i915_private *dev_priv)
984{
985 int ret;
986
987 ret = component_add_typed(dev_priv->drm.dev,
988 &i915_audio_component_bind_ops,
989 I915_COMPONENT_AUDIO);
990 if (ret < 0) {
991 DRM_ERROR("failed to add audio component (%d)\n", ret);
992
993 return;
994 }
995
996 dev_priv->audio_component_registered = true;
997}
998
999
1000
1001
1002
1003
1004
1005
1006void i915_audio_component_cleanup(struct drm_i915_private *dev_priv)
1007{
1008 if (!dev_priv->audio_component_registered)
1009 return;
1010
1011 component_del(dev_priv->drm.dev, &i915_audio_component_bind_ops);
1012 dev_priv->audio_component_registered = false;
1013}
1014
1015
1016
1017
1018
1019
1020
1021void intel_audio_init(struct drm_i915_private *dev_priv)
1022{
1023 if (intel_lpe_audio_init(dev_priv) < 0)
1024 i915_audio_component_init(dev_priv);
1025}
1026
1027
1028
1029
1030
1031
1032void intel_audio_deinit(struct drm_i915_private *dev_priv)
1033{
1034 if ((dev_priv)->lpe_audio.platdev != NULL)
1035 intel_lpe_audio_teardown(dev_priv);
1036 else
1037 i915_audio_component_cleanup(dev_priv);
1038}
1039