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 "intel_drv.h"
28
29#include <drm/drmP.h>
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
60static const struct {
61 int clock;
62 u32 config;
63} hdmi_audio_clock[] = {
64 { 25175, AUD_CONFIG_PIXEL_CLOCK_HDMI_25175 },
65 { 25200, AUD_CONFIG_PIXEL_CLOCK_HDMI_25200 },
66 { 27000, AUD_CONFIG_PIXEL_CLOCK_HDMI_27000 },
67 { 27027, AUD_CONFIG_PIXEL_CLOCK_HDMI_27027 },
68 { 54000, AUD_CONFIG_PIXEL_CLOCK_HDMI_54000 },
69 { 54054, AUD_CONFIG_PIXEL_CLOCK_HDMI_54054 },
70 { 74176, AUD_CONFIG_PIXEL_CLOCK_HDMI_74176 },
71 { 74250, AUD_CONFIG_PIXEL_CLOCK_HDMI_74250 },
72 { 148352, AUD_CONFIG_PIXEL_CLOCK_HDMI_148352 },
73 { 148500, AUD_CONFIG_PIXEL_CLOCK_HDMI_148500 },
74};
75
76
77#define TMDS_297M 297000
78#define TMDS_296M 296703
79static 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
101
102static u32 audio_config_hdmi_pixel_clock(const struct drm_display_mode *adjusted_mode)
103{
104 int i;
105
106 for (i = 0; i < ARRAY_SIZE(hdmi_audio_clock); i++) {
107 if (adjusted_mode->crtc_clock == hdmi_audio_clock[i].clock)
108 break;
109 }
110
111 if (i == ARRAY_SIZE(hdmi_audio_clock)) {
112 DRM_DEBUG_KMS("HDMI audio pixel clock setting for %d not found, falling back to defaults\n",
113 adjusted_mode->crtc_clock);
114 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
124static 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
137static 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
151
152static bool audio_rate_need_prog(struct intel_crtc *crtc,
153 const struct drm_display_mode *mode)
154{
155 if (((mode->clock == TMDS_297M) ||
156 (mode->clock == TMDS_296M)) &&
157 intel_crtc_has_type(crtc->config, INTEL_OUTPUT_HDMI))
158 return true;
159 else
160 return false;
161}
162
163static bool intel_eld_uptodate(struct drm_connector *connector,
164 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)
167{
168 struct drm_i915_private *dev_priv = to_i915(connector->dev);
169 uint8_t *eld = connector->eld;
170 uint32_t tmp;
171 int i;
172
173 tmp = I915_READ(reg_eldv);
174 tmp &= bits_eldv;
175
176 if (!tmp)
177 return false;
178
179 tmp = I915_READ(reg_elda);
180 tmp &= ~bits_elda;
181 I915_WRITE(reg_elda, tmp);
182
183 for (i = 0; i < drm_eld_size(eld) / 4; i++)
184 if (I915_READ(reg_edid) != *((uint32_t *)eld + i))
185 return false;
186
187 return true;
188}
189
190static void g4x_audio_codec_disable(struct intel_encoder *encoder)
191{
192 struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
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
204 tmp = I915_READ(G4X_AUD_CNTL_ST);
205 tmp &= ~eldv;
206 I915_WRITE(G4X_AUD_CNTL_ST, tmp);
207}
208
209static void g4x_audio_codec_enable(struct drm_connector *connector,
210 struct intel_encoder *encoder,
211 const struct drm_display_mode *adjusted_mode)
212{
213 struct drm_i915_private *dev_priv = to_i915(connector->dev);
214 uint8_t *eld = connector->eld;
215 uint32_t eldv;
216 uint32_t tmp;
217 int len, i;
218
219 DRM_DEBUG_KMS("Enable audio codec, %u bytes ELD\n", eld[2]);
220
221 tmp = I915_READ(G4X_AUD_VID_DID);
222 if (tmp == INTEL_AUDIO_DEVBLC || tmp == INTEL_AUDIO_DEVCL)
223 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,
229 G4X_AUD_CNTL_ST, G4X_ELD_ADDR_MASK,
230 G4X_HDMIW_HDMIEDID))
231 return;
232
233 tmp = I915_READ(G4X_AUD_CNTL_ST);
234 tmp &= ~(eldv | G4X_ELD_ADDR_MASK);
235 len = (tmp >> 9) & 0x1f;
236 I915_WRITE(G4X_AUD_CNTL_ST, tmp);
237
238 len = min(drm_eld_size(eld) / 4, len);
239 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
243 tmp = I915_READ(G4X_AUD_CNTL_ST);
244 tmp |= eldv;
245 I915_WRITE(G4X_AUD_CNTL_ST, tmp);
246}
247
248static void hsw_audio_codec_disable(struct intel_encoder *encoder)
249{
250 struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
251 struct intel_crtc *intel_crtc = to_intel_crtc(encoder->base.crtc);
252 enum pipe pipe = intel_crtc->pipe;
253 uint32_t tmp;
254
255 DRM_DEBUG_KMS("Disable audio codec on pipe %c\n", pipe_name(pipe));
256
257 mutex_lock(&dev_priv->av_mutex);
258
259
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;
265 if (intel_crtc_has_dp_encoder(intel_crtc->config))
266 tmp |= AUD_CONFIG_N_VALUE_INDEX;
267 I915_WRITE(HSW_AUD_CFG(pipe), tmp);
268
269
270 tmp = I915_READ(HSW_AUD_PIN_ELD_CP_VLD);
271 tmp &= ~AUDIO_ELD_VALID(pipe);
272 tmp &= ~AUDIO_OUTPUT_ENABLE(pipe);
273 I915_WRITE(HSW_AUD_PIN_ELD_CP_VLD, tmp);
274
275 mutex_unlock(&dev_priv->av_mutex);
276}
277
278static void hsw_audio_codec_enable(struct drm_connector *connector,
279 struct intel_encoder *encoder,
280 const struct drm_display_mode *adjusted_mode)
281{
282 struct drm_i915_private *dev_priv = to_i915(connector->dev);
283 struct intel_crtc *intel_crtc = to_intel_crtc(encoder->base.crtc);
284 enum pipe pipe = intel_crtc->pipe;
285 struct i915_audio_component *acomp = dev_priv->audio_component;
286 const uint8_t *eld = connector->eld;
287 struct intel_digital_port *intel_dig_port =
288 enc_to_dig_port(&encoder->base);
289 enum port port = intel_dig_port->port;
290 uint32_t tmp;
291 int len, i;
292 int n, rate;
293
294 DRM_DEBUG_KMS("Enable audio codec on pipe %c, %u bytes ELD\n",
295 pipe_name(pipe), drm_eld_size(eld));
296
297 mutex_lock(&dev_priv->av_mutex);
298
299
300 tmp = I915_READ(HSW_AUD_PIN_ELD_CP_VLD);
301 tmp |= AUDIO_OUTPUT_ENABLE(pipe);
302 tmp &= ~AUDIO_ELD_VALID(pipe);
303 I915_WRITE(HSW_AUD_PIN_ELD_CP_VLD, tmp);
304
305
306
307
308
309
310
311
312
313 tmp = I915_READ(HSW_AUD_DIP_ELD_CTRL(pipe));
314 tmp &= ~IBX_ELD_ADDRESS_MASK;
315 I915_WRITE(HSW_AUD_DIP_ELD_CTRL(pipe), tmp);
316
317
318 len = min(drm_eld_size(eld), 84);
319 for (i = 0; i < len / 4; i++)
320 I915_WRITE(HSW_AUD_EDID_DATA(pipe), *((uint32_t *)eld + i));
321
322
323 tmp = I915_READ(HSW_AUD_PIN_ELD_CP_VLD);
324 tmp |= AUDIO_ELD_VALID(pipe);
325 I915_WRITE(HSW_AUD_PIN_ELD_CP_VLD, tmp);
326
327
328 tmp = I915_READ(HSW_AUD_CFG(pipe));
329 tmp &= ~AUD_CONFIG_N_VALUE_INDEX;
330 tmp &= ~AUD_CONFIG_PIXEL_CLOCK_HDMI_MASK;
331 if (intel_crtc_has_dp_encoder(intel_crtc->config))
332 tmp |= AUD_CONFIG_N_VALUE_INDEX;
333 else
334 tmp |= audio_config_hdmi_pixel_clock(adjusted_mode);
335
336 tmp &= ~AUD_CONFIG_N_PROG_ENABLE;
337 if (audio_rate_need_prog(intel_crtc, adjusted_mode)) {
338 if (!acomp)
339 rate = 0;
340 else if (port >= PORT_A && port <= PORT_E)
341 rate = acomp->aud_sample_rate[port];
342 else {
343 DRM_ERROR("invalid port: %d\n", port);
344 rate = 0;
345 }
346 n = audio_config_get_n(adjusted_mode, rate);
347 if (n != 0)
348 tmp = audio_config_setup_n_reg(n, tmp);
349 else
350 DRM_DEBUG_KMS("no suitable N value is found\n");
351 }
352
353 I915_WRITE(HSW_AUD_CFG(pipe), tmp);
354
355 mutex_unlock(&dev_priv->av_mutex);
356}
357
358static void ilk_audio_codec_disable(struct intel_encoder *encoder)
359{
360 struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
361 struct intel_crtc *intel_crtc = to_intel_crtc(encoder->base.crtc);
362 struct intel_digital_port *intel_dig_port =
363 enc_to_dig_port(&encoder->base);
364 enum port port = intel_dig_port->port;
365 enum pipe pipe = intel_crtc->pipe;
366 uint32_t tmp, eldv;
367 i915_reg_t aud_config, aud_cntrl_st2;
368
369 DRM_DEBUG_KMS("Disable audio codec on port %c, pipe %c\n",
370 port_name(port), pipe_name(pipe));
371
372 if (WARN_ON(port == PORT_A))
373 return;
374
375 if (HAS_PCH_IBX(dev_priv)) {
376 aud_config = IBX_AUD_CFG(pipe);
377 aud_cntrl_st2 = IBX_AUD_CNTL_ST2;
378 } else if (IS_VALLEYVIEW(dev_priv) || IS_CHERRYVIEW(dev_priv)) {
379 aud_config = VLV_AUD_CFG(pipe);
380 aud_cntrl_st2 = VLV_AUD_CNTL_ST2;
381 } else {
382 aud_config = CPT_AUD_CFG(pipe);
383 aud_cntrl_st2 = CPT_AUD_CNTRL_ST2;
384 }
385
386
387 tmp = I915_READ(aud_config);
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(aud_config, tmp);
395
396 eldv = IBX_ELD_VALID(port);
397
398
399 tmp = I915_READ(aud_cntrl_st2);
400 tmp &= ~eldv;
401 I915_WRITE(aud_cntrl_st2, tmp);
402}
403
404static void ilk_audio_codec_enable(struct drm_connector *connector,
405 struct intel_encoder *encoder,
406 const struct drm_display_mode *adjusted_mode)
407{
408 struct drm_i915_private *dev_priv = to_i915(connector->dev);
409 struct intel_crtc *intel_crtc = to_intel_crtc(encoder->base.crtc);
410 struct intel_digital_port *intel_dig_port =
411 enc_to_dig_port(&encoder->base);
412 enum port port = intel_dig_port->port;
413 enum pipe pipe = intel_crtc->pipe;
414 uint8_t *eld = connector->eld;
415 uint32_t eldv;
416 uint32_t tmp;
417 int len, i;
418 i915_reg_t hdmiw_hdmiedid, aud_config, aud_cntl_st, aud_cntrl_st2;
419
420 DRM_DEBUG_KMS("Enable audio codec on port %c, pipe %c, %u bytes ELD\n",
421 port_name(port), pipe_name(pipe), drm_eld_size(eld));
422
423 if (WARN_ON(port == PORT_A))
424 return;
425
426
427
428
429
430
431
432
433 if (HAS_PCH_IBX(connector->dev)) {
434 hdmiw_hdmiedid = IBX_HDMIW_HDMIEDID(pipe);
435 aud_config = IBX_AUD_CFG(pipe);
436 aud_cntl_st = IBX_AUD_CNTL_ST(pipe);
437 aud_cntrl_st2 = IBX_AUD_CNTL_ST2;
438 } else if (IS_VALLEYVIEW(connector->dev) ||
439 IS_CHERRYVIEW(connector->dev)) {
440 hdmiw_hdmiedid = VLV_HDMIW_HDMIEDID(pipe);
441 aud_config = VLV_AUD_CFG(pipe);
442 aud_cntl_st = VLV_AUD_CNTL_ST(pipe);
443 aud_cntrl_st2 = VLV_AUD_CNTL_ST2;
444 } else {
445 hdmiw_hdmiedid = CPT_HDMIW_HDMIEDID(pipe);
446 aud_config = CPT_AUD_CFG(pipe);
447 aud_cntl_st = CPT_AUD_CNTL_ST(pipe);
448 aud_cntrl_st2 = CPT_AUD_CNTRL_ST2;
449 }
450
451 eldv = IBX_ELD_VALID(port);
452
453
454 tmp = I915_READ(aud_cntrl_st2);
455 tmp &= ~eldv;
456 I915_WRITE(aud_cntrl_st2, tmp);
457
458
459 tmp = I915_READ(aud_cntl_st);
460 tmp &= ~IBX_ELD_ADDRESS_MASK;
461 I915_WRITE(aud_cntl_st, tmp);
462
463
464 len = min(drm_eld_size(eld), 84);
465 for (i = 0; i < len / 4; i++)
466 I915_WRITE(hdmiw_hdmiedid, *((uint32_t *)eld + i));
467
468
469 tmp = I915_READ(aud_cntrl_st2);
470 tmp |= eldv;
471 I915_WRITE(aud_cntrl_st2, tmp);
472
473
474 tmp = I915_READ(aud_config);
475 tmp &= ~AUD_CONFIG_N_VALUE_INDEX;
476 tmp &= ~AUD_CONFIG_N_PROG_ENABLE;
477 tmp &= ~AUD_CONFIG_PIXEL_CLOCK_HDMI_MASK;
478 if (intel_crtc_has_dp_encoder(intel_crtc->config))
479 tmp |= AUD_CONFIG_N_VALUE_INDEX;
480 else
481 tmp |= audio_config_hdmi_pixel_clock(adjusted_mode);
482 I915_WRITE(aud_config, tmp);
483}
484
485
486
487
488
489
490
491
492void intel_audio_codec_enable(struct intel_encoder *intel_encoder)
493{
494 struct drm_encoder *encoder = &intel_encoder->base;
495 struct intel_crtc *crtc = to_intel_crtc(encoder->crtc);
496 const struct drm_display_mode *adjusted_mode = &crtc->config->base.adjusted_mode;
497 struct drm_connector *connector;
498 struct drm_device *dev = encoder->dev;
499 struct drm_i915_private *dev_priv = to_i915(dev);
500 struct i915_audio_component *acomp = dev_priv->audio_component;
501 struct intel_digital_port *intel_dig_port = enc_to_dig_port(encoder);
502 enum port port = intel_dig_port->port;
503
504 connector = drm_select_eld(encoder);
505 if (!connector)
506 return;
507
508 DRM_DEBUG_DRIVER("ELD on [CONNECTOR:%d:%s], [ENCODER:%d:%s]\n",
509 connector->base.id,
510 connector->name,
511 connector->encoder->base.id,
512 connector->encoder->name);
513
514
515 connector->eld[5] &= ~(3 << 2);
516 if (intel_crtc_has_dp_encoder(crtc->config))
517 connector->eld[5] |= (1 << 2);
518
519 connector->eld[6] = drm_av_sync_delay(connector, adjusted_mode) / 2;
520
521 if (dev_priv->display.audio_codec_enable)
522 dev_priv->display.audio_codec_enable(connector, intel_encoder,
523 adjusted_mode);
524
525 mutex_lock(&dev_priv->av_mutex);
526 intel_dig_port->audio_connector = connector;
527
528 dev_priv->dig_port_map[port] = intel_encoder;
529 mutex_unlock(&dev_priv->av_mutex);
530
531 if (acomp && acomp->audio_ops && acomp->audio_ops->pin_eld_notify)
532 acomp->audio_ops->pin_eld_notify(acomp->audio_ops->audio_ptr, (int) port);
533}
534
535
536
537
538
539
540
541
542void intel_audio_codec_disable(struct intel_encoder *intel_encoder)
543{
544 struct drm_encoder *encoder = &intel_encoder->base;
545 struct drm_device *dev = encoder->dev;
546 struct drm_i915_private *dev_priv = to_i915(dev);
547 struct i915_audio_component *acomp = dev_priv->audio_component;
548 struct intel_digital_port *intel_dig_port = enc_to_dig_port(encoder);
549 enum port port = intel_dig_port->port;
550
551 if (dev_priv->display.audio_codec_disable)
552 dev_priv->display.audio_codec_disable(intel_encoder);
553
554 mutex_lock(&dev_priv->av_mutex);
555 intel_dig_port->audio_connector = NULL;
556 dev_priv->dig_port_map[port] = NULL;
557 mutex_unlock(&dev_priv->av_mutex);
558
559 if (acomp && acomp->audio_ops && acomp->audio_ops->pin_eld_notify)
560 acomp->audio_ops->pin_eld_notify(acomp->audio_ops->audio_ptr, (int) port);
561}
562
563
564
565
566
567void intel_init_audio_hooks(struct drm_i915_private *dev_priv)
568{
569 if (IS_G4X(dev_priv)) {
570 dev_priv->display.audio_codec_enable = g4x_audio_codec_enable;
571 dev_priv->display.audio_codec_disable = g4x_audio_codec_disable;
572 } else if (IS_VALLEYVIEW(dev_priv) || IS_CHERRYVIEW(dev_priv)) {
573 dev_priv->display.audio_codec_enable = ilk_audio_codec_enable;
574 dev_priv->display.audio_codec_disable = ilk_audio_codec_disable;
575 } else if (IS_HASWELL(dev_priv) || INTEL_INFO(dev_priv)->gen >= 8) {
576 dev_priv->display.audio_codec_enable = hsw_audio_codec_enable;
577 dev_priv->display.audio_codec_disable = hsw_audio_codec_disable;
578 } else if (HAS_PCH_SPLIT(dev_priv)) {
579 dev_priv->display.audio_codec_enable = ilk_audio_codec_enable;
580 dev_priv->display.audio_codec_disable = ilk_audio_codec_disable;
581 }
582}
583
584static void i915_audio_component_get_power(struct device *dev)
585{
586 intel_display_power_get(dev_to_i915(dev), POWER_DOMAIN_AUDIO);
587}
588
589static void i915_audio_component_put_power(struct device *dev)
590{
591 intel_display_power_put(dev_to_i915(dev), POWER_DOMAIN_AUDIO);
592}
593
594static void i915_audio_component_codec_wake_override(struct device *dev,
595 bool enable)
596{
597 struct drm_i915_private *dev_priv = dev_to_i915(dev);
598 u32 tmp;
599
600 if (!IS_SKYLAKE(dev_priv) && !IS_KABYLAKE(dev_priv))
601 return;
602
603 i915_audio_component_get_power(dev);
604
605
606
607
608
609 tmp = I915_READ(HSW_AUD_CHICKENBIT);
610 tmp &= ~SKL_AUD_CODEC_WAKE_SIGNAL;
611 I915_WRITE(HSW_AUD_CHICKENBIT, tmp);
612 usleep_range(1000, 1500);
613
614 if (enable) {
615 tmp = I915_READ(HSW_AUD_CHICKENBIT);
616 tmp |= SKL_AUD_CODEC_WAKE_SIGNAL;
617 I915_WRITE(HSW_AUD_CHICKENBIT, tmp);
618 usleep_range(1000, 1500);
619 }
620
621 i915_audio_component_put_power(dev);
622}
623
624
625static int i915_audio_component_get_cdclk_freq(struct device *dev)
626{
627 struct drm_i915_private *dev_priv = dev_to_i915(dev);
628
629 if (WARN_ON_ONCE(!HAS_DDI(dev_priv)))
630 return -ENODEV;
631
632 return dev_priv->cdclk_freq;
633}
634
635static int i915_audio_component_sync_audio_rate(struct device *dev,
636 int port, int rate)
637{
638 struct drm_i915_private *dev_priv = dev_to_i915(dev);
639 struct intel_encoder *intel_encoder;
640 struct intel_crtc *crtc;
641 struct drm_display_mode *mode;
642 struct i915_audio_component *acomp = dev_priv->audio_component;
643 enum pipe pipe = INVALID_PIPE;
644 u32 tmp;
645 int n;
646 int err = 0;
647
648
649 if (!IS_SKYLAKE(dev_priv) &&
650 !IS_KABYLAKE(dev_priv) &&
651 !IS_BROADWELL(dev_priv) &&
652 !IS_HASWELL(dev_priv))
653 return 0;
654
655 i915_audio_component_get_power(dev);
656 mutex_lock(&dev_priv->av_mutex);
657
658 intel_encoder = dev_priv->dig_port_map[port];
659
660 if (!intel_encoder || !intel_encoder->base.crtc ||
661 intel_encoder->type != INTEL_OUTPUT_HDMI) {
662 DRM_DEBUG_KMS("no valid port %c\n", port_name(port));
663 err = -ENODEV;
664 goto unlock;
665 }
666 crtc = to_intel_crtc(intel_encoder->base.crtc);
667 pipe = crtc->pipe;
668 if (pipe == INVALID_PIPE) {
669 DRM_DEBUG_KMS("no pipe for the port %c\n", port_name(port));
670 err = -ENODEV;
671 goto unlock;
672 }
673
674 DRM_DEBUG_KMS("pipe %c connects port %c\n",
675 pipe_name(pipe), port_name(port));
676 mode = &crtc->config->base.adjusted_mode;
677
678
679 acomp->aud_sample_rate[port] = rate;
680
681
682 if (!audio_rate_need_prog(crtc, mode)) {
683 tmp = I915_READ(HSW_AUD_CFG(pipe));
684 tmp &= ~AUD_CONFIG_N_PROG_ENABLE;
685 I915_WRITE(HSW_AUD_CFG(pipe), tmp);
686 goto unlock;
687 }
688
689 n = audio_config_get_n(mode, rate);
690 if (n == 0) {
691 DRM_DEBUG_KMS("Using automatic mode for N value on port %c\n",
692 port_name(port));
693 tmp = I915_READ(HSW_AUD_CFG(pipe));
694 tmp &= ~AUD_CONFIG_N_PROG_ENABLE;
695 I915_WRITE(HSW_AUD_CFG(pipe), tmp);
696 goto unlock;
697 }
698
699
700 tmp = I915_READ(HSW_AUD_CFG(pipe));
701 tmp = audio_config_setup_n_reg(n, tmp);
702 I915_WRITE(HSW_AUD_CFG(pipe), tmp);
703
704 unlock:
705 mutex_unlock(&dev_priv->av_mutex);
706 i915_audio_component_put_power(dev);
707 return err;
708}
709
710static int i915_audio_component_get_eld(struct device *dev, int port,
711 bool *enabled,
712 unsigned char *buf, int max_bytes)
713{
714 struct drm_i915_private *dev_priv = dev_to_i915(dev);
715 struct intel_encoder *intel_encoder;
716 struct intel_digital_port *intel_dig_port;
717 const u8 *eld;
718 int ret = -EINVAL;
719
720 mutex_lock(&dev_priv->av_mutex);
721 intel_encoder = dev_priv->dig_port_map[port];
722
723 if (intel_encoder) {
724 ret = 0;
725 intel_dig_port = enc_to_dig_port(&intel_encoder->base);
726 *enabled = intel_dig_port->audio_connector != NULL;
727 if (*enabled) {
728 eld = intel_dig_port->audio_connector->eld;
729 ret = drm_eld_size(eld);
730 memcpy(buf, eld, min(max_bytes, ret));
731 }
732 }
733
734 mutex_unlock(&dev_priv->av_mutex);
735 return ret;
736}
737
738static const struct i915_audio_component_ops i915_audio_component_ops = {
739 .owner = THIS_MODULE,
740 .get_power = i915_audio_component_get_power,
741 .put_power = i915_audio_component_put_power,
742 .codec_wake_override = i915_audio_component_codec_wake_override,
743 .get_cdclk_freq = i915_audio_component_get_cdclk_freq,
744 .sync_audio_rate = i915_audio_component_sync_audio_rate,
745 .get_eld = i915_audio_component_get_eld,
746};
747
748static int i915_audio_component_bind(struct device *i915_dev,
749 struct device *hda_dev, void *data)
750{
751 struct i915_audio_component *acomp = data;
752 struct drm_i915_private *dev_priv = dev_to_i915(i915_dev);
753 int i;
754
755 if (WARN_ON(acomp->ops || acomp->dev))
756 return -EEXIST;
757
758 drm_modeset_lock_all(&dev_priv->drm);
759 acomp->ops = &i915_audio_component_ops;
760 acomp->dev = i915_dev;
761 BUILD_BUG_ON(MAX_PORTS != I915_MAX_PORTS);
762 for (i = 0; i < ARRAY_SIZE(acomp->aud_sample_rate); i++)
763 acomp->aud_sample_rate[i] = 0;
764 dev_priv->audio_component = acomp;
765 drm_modeset_unlock_all(&dev_priv->drm);
766
767 return 0;
768}
769
770static void i915_audio_component_unbind(struct device *i915_dev,
771 struct device *hda_dev, void *data)
772{
773 struct i915_audio_component *acomp = data;
774 struct drm_i915_private *dev_priv = dev_to_i915(i915_dev);
775
776 drm_modeset_lock_all(&dev_priv->drm);
777 acomp->ops = NULL;
778 acomp->dev = NULL;
779 dev_priv->audio_component = NULL;
780 drm_modeset_unlock_all(&dev_priv->drm);
781}
782
783static const struct component_ops i915_audio_component_bind_ops = {
784 .bind = i915_audio_component_bind,
785 .unbind = i915_audio_component_unbind,
786};
787
788
789
790
791
792
793
794
795
796
797
798
799
800
801
802
803
804void i915_audio_component_init(struct drm_i915_private *dev_priv)
805{
806 int ret;
807
808 ret = component_add(dev_priv->drm.dev, &i915_audio_component_bind_ops);
809 if (ret < 0) {
810 DRM_ERROR("failed to add audio component (%d)\n", ret);
811
812 return;
813 }
814
815 dev_priv->audio_component_registered = true;
816}
817
818
819
820
821
822
823
824
825void i915_audio_component_cleanup(struct drm_i915_private *dev_priv)
826{
827 if (!dev_priv->audio_component_registered)
828 return;
829
830 component_del(dev_priv->drm.dev, &i915_audio_component_bind_ops);
831 dev_priv->audio_component_registered = false;
832}
833