1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26#include <drm/drmP.h>
27#include <drm/drm_crtc_helper.h>
28#include <drm/amdgpu_drm.h>
29#include "amdgpu.h"
30#include "amdgpu_connectors.h"
31#include "atom.h"
32#include "atombios_encoders.h"
33#include "atombios_dp.h"
34#include <linux/backlight.h>
35#include "bif/bif_4_1_d.h"
36
37static u8
38amdgpu_atombios_encoder_get_backlight_level_from_reg(struct amdgpu_device *adev)
39{
40 u8 backlight_level;
41 u32 bios_2_scratch;
42
43 bios_2_scratch = RREG32(mmBIOS_SCRATCH_2);
44
45 backlight_level = ((bios_2_scratch & ATOM_S2_CURRENT_BL_LEVEL_MASK) >>
46 ATOM_S2_CURRENT_BL_LEVEL_SHIFT);
47
48 return backlight_level;
49}
50
51static void
52amdgpu_atombios_encoder_set_backlight_level_to_reg(struct amdgpu_device *adev,
53 u8 backlight_level)
54{
55 u32 bios_2_scratch;
56
57 bios_2_scratch = RREG32(mmBIOS_SCRATCH_2);
58
59 bios_2_scratch &= ~ATOM_S2_CURRENT_BL_LEVEL_MASK;
60 bios_2_scratch |= ((backlight_level << ATOM_S2_CURRENT_BL_LEVEL_SHIFT) &
61 ATOM_S2_CURRENT_BL_LEVEL_MASK);
62
63 WREG32(mmBIOS_SCRATCH_2, bios_2_scratch);
64}
65
66u8
67amdgpu_atombios_encoder_get_backlight_level(struct amdgpu_encoder *amdgpu_encoder)
68{
69 struct drm_device *dev = amdgpu_encoder->base.dev;
70 struct amdgpu_device *adev = dev->dev_private;
71
72 if (!(adev->mode_info.firmware_flags & ATOM_BIOS_INFO_BL_CONTROLLED_BY_GPU))
73 return 0;
74
75 return amdgpu_atombios_encoder_get_backlight_level_from_reg(adev);
76}
77
78void
79amdgpu_atombios_encoder_set_backlight_level(struct amdgpu_encoder *amdgpu_encoder,
80 u8 level)
81{
82 struct drm_encoder *encoder = &amdgpu_encoder->base;
83 struct drm_device *dev = amdgpu_encoder->base.dev;
84 struct amdgpu_device *adev = dev->dev_private;
85 struct amdgpu_encoder_atom_dig *dig;
86
87 if (!(adev->mode_info.firmware_flags & ATOM_BIOS_INFO_BL_CONTROLLED_BY_GPU))
88 return;
89
90 if ((amdgpu_encoder->devices & (ATOM_DEVICE_LCD_SUPPORT)) &&
91 amdgpu_encoder->enc_priv) {
92 dig = amdgpu_encoder->enc_priv;
93 dig->backlight_level = level;
94 amdgpu_atombios_encoder_set_backlight_level_to_reg(adev, dig->backlight_level);
95
96 switch (amdgpu_encoder->encoder_id) {
97 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY:
98 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_LVTMA:
99 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY1:
100 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY2:
101 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY3:
102 if (dig->backlight_level == 0)
103 amdgpu_atombios_encoder_setup_dig_transmitter(encoder,
104 ATOM_TRANSMITTER_ACTION_LCD_BLOFF, 0, 0);
105 else {
106 amdgpu_atombios_encoder_setup_dig_transmitter(encoder,
107 ATOM_TRANSMITTER_ACTION_BL_BRIGHTNESS_CONTROL, 0, 0);
108 amdgpu_atombios_encoder_setup_dig_transmitter(encoder,
109 ATOM_TRANSMITTER_ACTION_LCD_BLON, 0, 0);
110 }
111 break;
112 default:
113 break;
114 }
115 }
116}
117
118#if defined(CONFIG_BACKLIGHT_CLASS_DEVICE) || defined(CONFIG_BACKLIGHT_CLASS_DEVICE_MODULE)
119
120static u8 amdgpu_atombios_encoder_backlight_level(struct backlight_device *bd)
121{
122 u8 level;
123
124
125 if (bd->props.brightness < 0)
126 level = 0;
127 else if (bd->props.brightness > AMDGPU_MAX_BL_LEVEL)
128 level = AMDGPU_MAX_BL_LEVEL;
129 else
130 level = bd->props.brightness;
131
132 return level;
133}
134
135static int amdgpu_atombios_encoder_update_backlight_status(struct backlight_device *bd)
136{
137 struct amdgpu_backlight_privdata *pdata = bl_get_data(bd);
138 struct amdgpu_encoder *amdgpu_encoder = pdata->encoder;
139
140 amdgpu_atombios_encoder_set_backlight_level(amdgpu_encoder,
141 amdgpu_atombios_encoder_backlight_level(bd));
142
143 return 0;
144}
145
146static int
147amdgpu_atombios_encoder_get_backlight_brightness(struct backlight_device *bd)
148{
149 struct amdgpu_backlight_privdata *pdata = bl_get_data(bd);
150 struct amdgpu_encoder *amdgpu_encoder = pdata->encoder;
151 struct drm_device *dev = amdgpu_encoder->base.dev;
152 struct amdgpu_device *adev = dev->dev_private;
153
154 return amdgpu_atombios_encoder_get_backlight_level_from_reg(adev);
155}
156
157static const struct backlight_ops amdgpu_atombios_encoder_backlight_ops = {
158 .get_brightness = amdgpu_atombios_encoder_get_backlight_brightness,
159 .update_status = amdgpu_atombios_encoder_update_backlight_status,
160};
161
162void amdgpu_atombios_encoder_init_backlight(struct amdgpu_encoder *amdgpu_encoder,
163 struct drm_connector *drm_connector)
164{
165 struct drm_device *dev = amdgpu_encoder->base.dev;
166 struct amdgpu_device *adev = dev->dev_private;
167 struct backlight_device *bd;
168 struct backlight_properties props;
169 struct amdgpu_backlight_privdata *pdata;
170 struct amdgpu_encoder_atom_dig *dig;
171 u8 backlight_level;
172 char bl_name[16];
173
174
175
176
177 if ((adev->pdev->subsystem_vendor == PCI_VENDOR_ID_APPLE) &&
178 (adev->pdev->device == 0x6741))
179 return;
180
181 if (!amdgpu_encoder->enc_priv)
182 return;
183
184 if (!(adev->mode_info.firmware_flags & ATOM_BIOS_INFO_BL_CONTROLLED_BY_GPU))
185 return;
186
187 pdata = kmalloc(sizeof(struct amdgpu_backlight_privdata), GFP_KERNEL);
188 if (!pdata) {
189 DRM_ERROR("Memory allocation failed\n");
190 goto error;
191 }
192
193 memset(&props, 0, sizeof(props));
194 props.max_brightness = AMDGPU_MAX_BL_LEVEL;
195 props.type = BACKLIGHT_RAW;
196 snprintf(bl_name, sizeof(bl_name),
197 "amdgpu_bl%d", dev->primary->index);
198 bd = backlight_device_register(bl_name, drm_connector->kdev,
199 pdata, &amdgpu_atombios_encoder_backlight_ops, &props);
200 if (IS_ERR(bd)) {
201 DRM_ERROR("Backlight registration failed\n");
202 goto error;
203 }
204
205 pdata->encoder = amdgpu_encoder;
206
207 backlight_level = amdgpu_atombios_encoder_get_backlight_level_from_reg(adev);
208
209 dig = amdgpu_encoder->enc_priv;
210 dig->bl_dev = bd;
211
212 bd->props.brightness = amdgpu_atombios_encoder_get_backlight_brightness(bd);
213 bd->props.power = FB_BLANK_UNBLANK;
214 backlight_update_status(bd);
215
216 DRM_INFO("amdgpu atom DIG backlight initialized\n");
217
218 return;
219
220error:
221 kfree(pdata);
222 return;
223}
224
225void
226amdgpu_atombios_encoder_fini_backlight(struct amdgpu_encoder *amdgpu_encoder)
227{
228 struct drm_device *dev = amdgpu_encoder->base.dev;
229 struct amdgpu_device *adev = dev->dev_private;
230 struct backlight_device *bd = NULL;
231 struct amdgpu_encoder_atom_dig *dig;
232
233 if (!amdgpu_encoder->enc_priv)
234 return;
235
236 if (!(adev->mode_info.firmware_flags & ATOM_BIOS_INFO_BL_CONTROLLED_BY_GPU))
237 return;
238
239 dig = amdgpu_encoder->enc_priv;
240 bd = dig->bl_dev;
241 dig->bl_dev = NULL;
242
243 if (bd) {
244 struct amdgpu_legacy_backlight_privdata *pdata;
245
246 pdata = bl_get_data(bd);
247 backlight_device_unregister(bd);
248 kfree(pdata);
249
250 DRM_INFO("amdgpu atom LVDS backlight unloaded\n");
251 }
252}
253
254#else
255
256void amdgpu_atombios_encoder_init_backlight(struct amdgpu_encoder *encoder)
257{
258}
259
260void amdgpu_atombios_encoder_fini_backlight(struct amdgpu_encoder *encoder)
261{
262}
263
264#endif
265
266bool amdgpu_atombios_encoder_is_digital(struct drm_encoder *encoder)
267{
268 struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
269 switch (amdgpu_encoder->encoder_id) {
270 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DVO1:
271 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY:
272 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY1:
273 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY2:
274 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY3:
275 return true;
276 default:
277 return false;
278 }
279}
280
281bool amdgpu_atombios_encoder_mode_fixup(struct drm_encoder *encoder,
282 const struct drm_display_mode *mode,
283 struct drm_display_mode *adjusted_mode)
284{
285 struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
286
287
288 amdgpu_encoder_set_active_device(encoder);
289 drm_mode_set_crtcinfo(adjusted_mode, 0);
290
291
292 if ((mode->flags & DRM_MODE_FLAG_INTERLACE)
293 && (mode->crtc_vsync_start < (mode->crtc_vdisplay + 2)))
294 adjusted_mode->crtc_vsync_start = adjusted_mode->crtc_vdisplay + 2;
295
296
297 if (mode->crtc_vsync_start == mode->crtc_vdisplay)
298 adjusted_mode->crtc_vsync_start++;
299
300
301 if (amdgpu_encoder->active_device & (ATOM_DEVICE_LCD_SUPPORT))
302 amdgpu_panel_mode_fixup(encoder, adjusted_mode);
303 else if (amdgpu_encoder->rmx_type != RMX_OFF)
304 amdgpu_panel_mode_fixup(encoder, adjusted_mode);
305
306 if ((amdgpu_encoder->active_device & (ATOM_DEVICE_DFP_SUPPORT | ATOM_DEVICE_LCD_SUPPORT)) ||
307 (amdgpu_encoder_get_dp_bridge_encoder_id(encoder) != ENCODER_OBJECT_ID_NONE)) {
308 struct drm_connector *connector = amdgpu_get_connector_for_encoder(encoder);
309 amdgpu_atombios_dp_set_link_config(connector, adjusted_mode);
310 }
311
312 return true;
313}
314
315static void
316amdgpu_atombios_encoder_setup_dac(struct drm_encoder *encoder, int action)
317{
318 struct drm_device *dev = encoder->dev;
319 struct amdgpu_device *adev = dev->dev_private;
320 struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
321 DAC_ENCODER_CONTROL_PS_ALLOCATION args;
322 int index = 0;
323
324 memset(&args, 0, sizeof(args));
325
326 switch (amdgpu_encoder->encoder_id) {
327 case ENCODER_OBJECT_ID_INTERNAL_DAC1:
328 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DAC1:
329 index = GetIndexIntoMasterTable(COMMAND, DAC1EncoderControl);
330 break;
331 case ENCODER_OBJECT_ID_INTERNAL_DAC2:
332 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DAC2:
333 index = GetIndexIntoMasterTable(COMMAND, DAC2EncoderControl);
334 break;
335 }
336
337 args.ucAction = action;
338 args.ucDacStandard = ATOM_DAC1_PS2;
339 args.usPixelClock = cpu_to_le16(amdgpu_encoder->pixel_clock / 10);
340
341 amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
342
343}
344
345static u8 amdgpu_atombios_encoder_get_bpc(struct drm_encoder *encoder)
346{
347 int bpc = 8;
348
349 if (encoder->crtc) {
350 struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(encoder->crtc);
351 bpc = amdgpu_crtc->bpc;
352 }
353
354 switch (bpc) {
355 case 0:
356 return PANEL_BPC_UNDEFINE;
357 case 6:
358 return PANEL_6BIT_PER_COLOR;
359 case 8:
360 default:
361 return PANEL_8BIT_PER_COLOR;
362 case 10:
363 return PANEL_10BIT_PER_COLOR;
364 case 12:
365 return PANEL_12BIT_PER_COLOR;
366 case 16:
367 return PANEL_16BIT_PER_COLOR;
368 }
369}
370
371union dvo_encoder_control {
372 ENABLE_EXTERNAL_TMDS_ENCODER_PS_ALLOCATION ext_tmds;
373 DVO_ENCODER_CONTROL_PS_ALLOCATION dvo;
374 DVO_ENCODER_CONTROL_PS_ALLOCATION_V3 dvo_v3;
375 DVO_ENCODER_CONTROL_PS_ALLOCATION_V1_4 dvo_v4;
376};
377
378static void
379amdgpu_atombios_encoder_setup_dvo(struct drm_encoder *encoder, int action)
380{
381 struct drm_device *dev = encoder->dev;
382 struct amdgpu_device *adev = dev->dev_private;
383 struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
384 union dvo_encoder_control args;
385 int index = GetIndexIntoMasterTable(COMMAND, DVOEncoderControl);
386 uint8_t frev, crev;
387
388 memset(&args, 0, sizeof(args));
389
390 if (!amdgpu_atom_parse_cmd_header(adev->mode_info.atom_context, index, &frev, &crev))
391 return;
392
393 switch (frev) {
394 case 1:
395 switch (crev) {
396 case 1:
397
398 args.ext_tmds.sXTmdsEncoder.ucEnable = action;
399
400 if (amdgpu_dig_monitor_is_duallink(encoder, amdgpu_encoder->pixel_clock))
401 args.ext_tmds.sXTmdsEncoder.ucMisc |= PANEL_ENCODER_MISC_DUAL;
402
403 args.ext_tmds.sXTmdsEncoder.ucMisc |= ATOM_PANEL_MISC_888RGB;
404 break;
405 case 2:
406
407 args.dvo.sDVOEncoder.ucAction = action;
408 args.dvo.sDVOEncoder.usPixelClock = cpu_to_le16(amdgpu_encoder->pixel_clock / 10);
409
410 args.dvo.sDVOEncoder.ucDeviceType = ATOM_DEVICE_DFP1_INDEX;
411
412 if (amdgpu_dig_monitor_is_duallink(encoder, amdgpu_encoder->pixel_clock))
413 args.dvo.sDVOEncoder.usDevAttr.sDigAttrib.ucAttribute |= PANEL_ENCODER_MISC_DUAL;
414 break;
415 case 3:
416
417 args.dvo_v3.ucAction = action;
418 args.dvo_v3.usPixelClock = cpu_to_le16(amdgpu_encoder->pixel_clock / 10);
419 args.dvo_v3.ucDVOConfig = 0;
420 break;
421 case 4:
422
423 args.dvo_v4.ucAction = action;
424 args.dvo_v4.usPixelClock = cpu_to_le16(amdgpu_encoder->pixel_clock / 10);
425 args.dvo_v4.ucDVOConfig = 0;
426 args.dvo_v4.ucBitPerColor = amdgpu_atombios_encoder_get_bpc(encoder);
427 break;
428 default:
429 DRM_ERROR("Unknown table version %d, %d\n", frev, crev);
430 break;
431 }
432 break;
433 default:
434 DRM_ERROR("Unknown table version %d, %d\n", frev, crev);
435 break;
436 }
437
438 amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
439}
440
441int amdgpu_atombios_encoder_get_encoder_mode(struct drm_encoder *encoder)
442{
443 struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
444 struct drm_connector *connector;
445 struct amdgpu_connector *amdgpu_connector;
446 struct amdgpu_connector_atom_dig *dig_connector;
447
448
449 if (amdgpu_encoder_get_dp_bridge_encoder_id(encoder) != ENCODER_OBJECT_ID_NONE)
450 return ATOM_ENCODER_MODE_DP;
451
452
453 if ((amdgpu_encoder->encoder_id == ENCODER_OBJECT_ID_INTERNAL_DVO1) ||
454 (amdgpu_encoder->encoder_id == ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DVO1))
455 return ATOM_ENCODER_MODE_DVO;
456
457 connector = amdgpu_get_connector_for_encoder(encoder);
458
459
460
461 if (!connector)
462 connector = amdgpu_get_connector_for_encoder_init(encoder);
463 amdgpu_connector = to_amdgpu_connector(connector);
464
465 switch (connector->connector_type) {
466 case DRM_MODE_CONNECTOR_DVII:
467 case DRM_MODE_CONNECTOR_HDMIB:
468 if (amdgpu_audio != 0) {
469 if (amdgpu_connector->use_digital &&
470 (amdgpu_connector->audio == AMDGPU_AUDIO_ENABLE))
471 return ATOM_ENCODER_MODE_HDMI;
472 else if (drm_detect_hdmi_monitor(amdgpu_connector_edid(connector)) &&
473 (amdgpu_connector->audio == AMDGPU_AUDIO_AUTO))
474 return ATOM_ENCODER_MODE_HDMI;
475 else if (amdgpu_connector->use_digital)
476 return ATOM_ENCODER_MODE_DVI;
477 else
478 return ATOM_ENCODER_MODE_CRT;
479 } else if (amdgpu_connector->use_digital) {
480 return ATOM_ENCODER_MODE_DVI;
481 } else {
482 return ATOM_ENCODER_MODE_CRT;
483 }
484 break;
485 case DRM_MODE_CONNECTOR_DVID:
486 case DRM_MODE_CONNECTOR_HDMIA:
487 default:
488 if (amdgpu_audio != 0) {
489 if (amdgpu_connector->audio == AMDGPU_AUDIO_ENABLE)
490 return ATOM_ENCODER_MODE_HDMI;
491 else if (drm_detect_hdmi_monitor(amdgpu_connector_edid(connector)) &&
492 (amdgpu_connector->audio == AMDGPU_AUDIO_AUTO))
493 return ATOM_ENCODER_MODE_HDMI;
494 else
495 return ATOM_ENCODER_MODE_DVI;
496 } else {
497 return ATOM_ENCODER_MODE_DVI;
498 }
499 break;
500 case DRM_MODE_CONNECTOR_LVDS:
501 return ATOM_ENCODER_MODE_LVDS;
502 break;
503 case DRM_MODE_CONNECTOR_DisplayPort:
504 dig_connector = amdgpu_connector->con_priv;
505 if ((dig_connector->dp_sink_type == CONNECTOR_OBJECT_ID_DISPLAYPORT) ||
506 (dig_connector->dp_sink_type == CONNECTOR_OBJECT_ID_eDP)) {
507 return ATOM_ENCODER_MODE_DP;
508 } else if (amdgpu_audio != 0) {
509 if (amdgpu_connector->audio == AMDGPU_AUDIO_ENABLE)
510 return ATOM_ENCODER_MODE_HDMI;
511 else if (drm_detect_hdmi_monitor(amdgpu_connector_edid(connector)) &&
512 (amdgpu_connector->audio == AMDGPU_AUDIO_AUTO))
513 return ATOM_ENCODER_MODE_HDMI;
514 else
515 return ATOM_ENCODER_MODE_DVI;
516 } else {
517 return ATOM_ENCODER_MODE_DVI;
518 }
519 break;
520 case DRM_MODE_CONNECTOR_eDP:
521 return ATOM_ENCODER_MODE_DP;
522 case DRM_MODE_CONNECTOR_DVIA:
523 case DRM_MODE_CONNECTOR_VGA:
524 return ATOM_ENCODER_MODE_CRT;
525 break;
526 case DRM_MODE_CONNECTOR_Composite:
527 case DRM_MODE_CONNECTOR_SVIDEO:
528 case DRM_MODE_CONNECTOR_9PinDIN:
529
530 return ATOM_ENCODER_MODE_TV;
531
532 break;
533 }
534}
535
536
537
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560union dig_encoder_control {
561 DIG_ENCODER_CONTROL_PS_ALLOCATION v1;
562 DIG_ENCODER_CONTROL_PARAMETERS_V2 v2;
563 DIG_ENCODER_CONTROL_PARAMETERS_V3 v3;
564 DIG_ENCODER_CONTROL_PARAMETERS_V4 v4;
565 DIG_ENCODER_CONTROL_PARAMETERS_V5 v5;
566};
567
568void
569amdgpu_atombios_encoder_setup_dig_encoder(struct drm_encoder *encoder,
570 int action, int panel_mode)
571{
572 struct drm_device *dev = encoder->dev;
573 struct amdgpu_device *adev = dev->dev_private;
574 struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
575 struct amdgpu_encoder_atom_dig *dig = amdgpu_encoder->enc_priv;
576 struct drm_connector *connector = amdgpu_get_connector_for_encoder(encoder);
577 union dig_encoder_control args;
578 int index = GetIndexIntoMasterTable(COMMAND, DIGxEncoderControl);
579 uint8_t frev, crev;
580 int dp_clock = 0;
581 int dp_lane_count = 0;
582 int hpd_id = AMDGPU_HPD_NONE;
583
584 if (connector) {
585 struct amdgpu_connector *amdgpu_connector = to_amdgpu_connector(connector);
586 struct amdgpu_connector_atom_dig *dig_connector =
587 amdgpu_connector->con_priv;
588
589 dp_clock = dig_connector->dp_clock;
590 dp_lane_count = dig_connector->dp_lane_count;
591 hpd_id = amdgpu_connector->hpd.hpd;
592 }
593
594
595 if (dig->dig_encoder == -1)
596 return;
597
598 memset(&args, 0, sizeof(args));
599
600 if (!amdgpu_atom_parse_cmd_header(adev->mode_info.atom_context, index, &frev, &crev))
601 return;
602
603 switch (frev) {
604 case 1:
605 switch (crev) {
606 case 1:
607 args.v1.ucAction = action;
608 args.v1.usPixelClock = cpu_to_le16(amdgpu_encoder->pixel_clock / 10);
609 if (action == ATOM_ENCODER_CMD_SETUP_PANEL_MODE)
610 args.v3.ucPanelMode = panel_mode;
611 else
612 args.v1.ucEncoderMode = amdgpu_atombios_encoder_get_encoder_mode(encoder);
613
614 if (ENCODER_MODE_IS_DP(args.v1.ucEncoderMode))
615 args.v1.ucLaneNum = dp_lane_count;
616 else if (amdgpu_dig_monitor_is_duallink(encoder, amdgpu_encoder->pixel_clock))
617 args.v1.ucLaneNum = 8;
618 else
619 args.v1.ucLaneNum = 4;
620
621 if (ENCODER_MODE_IS_DP(args.v1.ucEncoderMode) && (dp_clock == 270000))
622 args.v1.ucConfig |= ATOM_ENCODER_CONFIG_DPLINKRATE_2_70GHZ;
623 switch (amdgpu_encoder->encoder_id) {
624 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY:
625 args.v1.ucConfig = ATOM_ENCODER_CONFIG_V2_TRANSMITTER1;
626 break;
627 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY1:
628 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_LVTMA:
629 args.v1.ucConfig = ATOM_ENCODER_CONFIG_V2_TRANSMITTER2;
630 break;
631 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY2:
632 args.v1.ucConfig = ATOM_ENCODER_CONFIG_V2_TRANSMITTER3;
633 break;
634 }
635 if (dig->linkb)
636 args.v1.ucConfig |= ATOM_ENCODER_CONFIG_LINKB;
637 else
638 args.v1.ucConfig |= ATOM_ENCODER_CONFIG_LINKA;
639 break;
640 case 2:
641 case 3:
642 args.v3.ucAction = action;
643 args.v3.usPixelClock = cpu_to_le16(amdgpu_encoder->pixel_clock / 10);
644 if (action == ATOM_ENCODER_CMD_SETUP_PANEL_MODE)
645 args.v3.ucPanelMode = panel_mode;
646 else
647 args.v3.ucEncoderMode = amdgpu_atombios_encoder_get_encoder_mode(encoder);
648
649 if (ENCODER_MODE_IS_DP(args.v3.ucEncoderMode))
650 args.v3.ucLaneNum = dp_lane_count;
651 else if (amdgpu_dig_monitor_is_duallink(encoder, amdgpu_encoder->pixel_clock))
652 args.v3.ucLaneNum = 8;
653 else
654 args.v3.ucLaneNum = 4;
655
656 if (ENCODER_MODE_IS_DP(args.v3.ucEncoderMode) && (dp_clock == 270000))
657 args.v1.ucConfig |= ATOM_ENCODER_CONFIG_V3_DPLINKRATE_2_70GHZ;
658 args.v3.acConfig.ucDigSel = dig->dig_encoder;
659 args.v3.ucBitPerColor = amdgpu_atombios_encoder_get_bpc(encoder);
660 break;
661 case 4:
662 args.v4.ucAction = action;
663 args.v4.usPixelClock = cpu_to_le16(amdgpu_encoder->pixel_clock / 10);
664 if (action == ATOM_ENCODER_CMD_SETUP_PANEL_MODE)
665 args.v4.ucPanelMode = panel_mode;
666 else
667 args.v4.ucEncoderMode = amdgpu_atombios_encoder_get_encoder_mode(encoder);
668
669 if (ENCODER_MODE_IS_DP(args.v4.ucEncoderMode))
670 args.v4.ucLaneNum = dp_lane_count;
671 else if (amdgpu_dig_monitor_is_duallink(encoder, amdgpu_encoder->pixel_clock))
672 args.v4.ucLaneNum = 8;
673 else
674 args.v4.ucLaneNum = 4;
675
676 if (ENCODER_MODE_IS_DP(args.v4.ucEncoderMode)) {
677 if (dp_clock == 540000)
678 args.v1.ucConfig |= ATOM_ENCODER_CONFIG_V4_DPLINKRATE_5_40GHZ;
679 else if (dp_clock == 324000)
680 args.v1.ucConfig |= ATOM_ENCODER_CONFIG_V4_DPLINKRATE_3_24GHZ;
681 else if (dp_clock == 270000)
682 args.v1.ucConfig |= ATOM_ENCODER_CONFIG_V4_DPLINKRATE_2_70GHZ;
683 else
684 args.v1.ucConfig |= ATOM_ENCODER_CONFIG_V4_DPLINKRATE_1_62GHZ;
685 }
686 args.v4.acConfig.ucDigSel = dig->dig_encoder;
687 args.v4.ucBitPerColor = amdgpu_atombios_encoder_get_bpc(encoder);
688 if (hpd_id == AMDGPU_HPD_NONE)
689 args.v4.ucHPD_ID = 0;
690 else
691 args.v4.ucHPD_ID = hpd_id + 1;
692 break;
693 case 5:
694 switch (action) {
695 case ATOM_ENCODER_CMD_SETUP_PANEL_MODE:
696 args.v5.asDPPanelModeParam.ucAction = action;
697 args.v5.asDPPanelModeParam.ucPanelMode = panel_mode;
698 args.v5.asDPPanelModeParam.ucDigId = dig->dig_encoder;
699 break;
700 case ATOM_ENCODER_CMD_STREAM_SETUP:
701 args.v5.asStreamParam.ucAction = action;
702 args.v5.asStreamParam.ucDigId = dig->dig_encoder;
703 args.v5.asStreamParam.ucDigMode =
704 amdgpu_atombios_encoder_get_encoder_mode(encoder);
705 if (ENCODER_MODE_IS_DP(args.v5.asStreamParam.ucDigMode))
706 args.v5.asStreamParam.ucLaneNum = dp_lane_count;
707 else if (amdgpu_dig_monitor_is_duallink(encoder,
708 amdgpu_encoder->pixel_clock))
709 args.v5.asStreamParam.ucLaneNum = 8;
710 else
711 args.v5.asStreamParam.ucLaneNum = 4;
712 args.v5.asStreamParam.ulPixelClock =
713 cpu_to_le32(amdgpu_encoder->pixel_clock / 10);
714 args.v5.asStreamParam.ucBitPerColor =
715 amdgpu_atombios_encoder_get_bpc(encoder);
716 args.v5.asStreamParam.ucLinkRateIn270Mhz = dp_clock / 27000;
717 break;
718 case ATOM_ENCODER_CMD_DP_LINK_TRAINING_START:
719 case ATOM_ENCODER_CMD_DP_LINK_TRAINING_PATTERN1:
720 case ATOM_ENCODER_CMD_DP_LINK_TRAINING_PATTERN2:
721 case ATOM_ENCODER_CMD_DP_LINK_TRAINING_PATTERN3:
722 case ATOM_ENCODER_CMD_DP_LINK_TRAINING_PATTERN4:
723 case ATOM_ENCODER_CMD_DP_LINK_TRAINING_COMPLETE:
724 case ATOM_ENCODER_CMD_DP_VIDEO_OFF:
725 case ATOM_ENCODER_CMD_DP_VIDEO_ON:
726 args.v5.asCmdParam.ucAction = action;
727 args.v5.asCmdParam.ucDigId = dig->dig_encoder;
728 break;
729 default:
730 DRM_ERROR("Unsupported action 0x%x\n", action);
731 break;
732 }
733 break;
734 default:
735 DRM_ERROR("Unknown table version %d, %d\n", frev, crev);
736 break;
737 }
738 break;
739 default:
740 DRM_ERROR("Unknown table version %d, %d\n", frev, crev);
741 break;
742 }
743
744 amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
745
746}
747
748union dig_transmitter_control {
749 DIG_TRANSMITTER_CONTROL_PS_ALLOCATION v1;
750 DIG_TRANSMITTER_CONTROL_PARAMETERS_V2 v2;
751 DIG_TRANSMITTER_CONTROL_PARAMETERS_V3 v3;
752 DIG_TRANSMITTER_CONTROL_PARAMETERS_V4 v4;
753 DIG_TRANSMITTER_CONTROL_PARAMETERS_V1_5 v5;
754 DIG_TRANSMITTER_CONTROL_PARAMETERS_V1_6 v6;
755};
756
757void
758amdgpu_atombios_encoder_setup_dig_transmitter(struct drm_encoder *encoder, int action,
759 uint8_t lane_num, uint8_t lane_set)
760{
761 struct drm_device *dev = encoder->dev;
762 struct amdgpu_device *adev = dev->dev_private;
763 struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
764 struct amdgpu_encoder_atom_dig *dig = amdgpu_encoder->enc_priv;
765 struct drm_connector *connector;
766 union dig_transmitter_control args;
767 int index = 0;
768 uint8_t frev, crev;
769 bool is_dp = false;
770 int pll_id = 0;
771 int dp_clock = 0;
772 int dp_lane_count = 0;
773 int connector_object_id = 0;
774 int igp_lane_info = 0;
775 int dig_encoder = dig->dig_encoder;
776 int hpd_id = AMDGPU_HPD_NONE;
777
778 if (action == ATOM_TRANSMITTER_ACTION_INIT) {
779 connector = amdgpu_get_connector_for_encoder_init(encoder);
780
781
782
783 dig_encoder = 0;
784 } else
785 connector = amdgpu_get_connector_for_encoder(encoder);
786
787 if (connector) {
788 struct amdgpu_connector *amdgpu_connector = to_amdgpu_connector(connector);
789 struct amdgpu_connector_atom_dig *dig_connector =
790 amdgpu_connector->con_priv;
791
792 hpd_id = amdgpu_connector->hpd.hpd;
793 dp_clock = dig_connector->dp_clock;
794 dp_lane_count = dig_connector->dp_lane_count;
795 connector_object_id =
796 (amdgpu_connector->connector_object_id & OBJECT_ID_MASK) >> OBJECT_ID_SHIFT;
797 }
798
799 if (encoder->crtc) {
800 struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(encoder->crtc);
801 pll_id = amdgpu_crtc->pll_id;
802 }
803
804
805 if (dig_encoder == -1)
806 return;
807
808 if (ENCODER_MODE_IS_DP(amdgpu_atombios_encoder_get_encoder_mode(encoder)))
809 is_dp = true;
810
811 memset(&args, 0, sizeof(args));
812
813 switch (amdgpu_encoder->encoder_id) {
814 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DVO1:
815 index = GetIndexIntoMasterTable(COMMAND, DVOOutputControl);
816 break;
817 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY:
818 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY1:
819 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY2:
820 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY3:
821 index = GetIndexIntoMasterTable(COMMAND, UNIPHYTransmitterControl);
822 break;
823 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_LVTMA:
824 index = GetIndexIntoMasterTable(COMMAND, LVTMATransmitterControl);
825 break;
826 }
827
828 if (!amdgpu_atom_parse_cmd_header(adev->mode_info.atom_context, index, &frev, &crev))
829 return;
830
831 switch (frev) {
832 case 1:
833 switch (crev) {
834 case 1:
835 args.v1.ucAction = action;
836 if (action == ATOM_TRANSMITTER_ACTION_INIT) {
837 args.v1.usInitInfo = cpu_to_le16(connector_object_id);
838 } else if (action == ATOM_TRANSMITTER_ACTION_SETUP_VSEMPH) {
839 args.v1.asMode.ucLaneSel = lane_num;
840 args.v1.asMode.ucLaneSet = lane_set;
841 } else {
842 if (is_dp)
843 args.v1.usPixelClock = cpu_to_le16(dp_clock / 10);
844 else if (amdgpu_dig_monitor_is_duallink(encoder, amdgpu_encoder->pixel_clock))
845 args.v1.usPixelClock = cpu_to_le16((amdgpu_encoder->pixel_clock / 2) / 10);
846 else
847 args.v1.usPixelClock = cpu_to_le16(amdgpu_encoder->pixel_clock / 10);
848 }
849
850 args.v1.ucConfig = ATOM_TRANSMITTER_CONFIG_CLKSRC_PPLL;
851
852 if (dig_encoder)
853 args.v1.ucConfig |= ATOM_TRANSMITTER_CONFIG_DIG2_ENCODER;
854 else
855 args.v1.ucConfig |= ATOM_TRANSMITTER_CONFIG_DIG1_ENCODER;
856
857 if ((adev->flags & AMD_IS_APU) &&
858 (amdgpu_encoder->encoder_id == ENCODER_OBJECT_ID_INTERNAL_UNIPHY)) {
859 if (is_dp ||
860 !amdgpu_dig_monitor_is_duallink(encoder, amdgpu_encoder->pixel_clock)) {
861 if (igp_lane_info & 0x1)
862 args.v1.ucConfig |= ATOM_TRANSMITTER_CONFIG_LANE_0_3;
863 else if (igp_lane_info & 0x2)
864 args.v1.ucConfig |= ATOM_TRANSMITTER_CONFIG_LANE_4_7;
865 else if (igp_lane_info & 0x4)
866 args.v1.ucConfig |= ATOM_TRANSMITTER_CONFIG_LANE_8_11;
867 else if (igp_lane_info & 0x8)
868 args.v1.ucConfig |= ATOM_TRANSMITTER_CONFIG_LANE_12_15;
869 } else {
870 if (igp_lane_info & 0x3)
871 args.v1.ucConfig |= ATOM_TRANSMITTER_CONFIG_LANE_0_7;
872 else if (igp_lane_info & 0xc)
873 args.v1.ucConfig |= ATOM_TRANSMITTER_CONFIG_LANE_8_15;
874 }
875 }
876
877 if (dig->linkb)
878 args.v1.ucConfig |= ATOM_TRANSMITTER_CONFIG_LINKB;
879 else
880 args.v1.ucConfig |= ATOM_TRANSMITTER_CONFIG_LINKA;
881
882 if (is_dp)
883 args.v1.ucConfig |= ATOM_TRANSMITTER_CONFIG_COHERENT;
884 else if (amdgpu_encoder->devices & (ATOM_DEVICE_DFP_SUPPORT)) {
885 if (dig->coherent_mode)
886 args.v1.ucConfig |= ATOM_TRANSMITTER_CONFIG_COHERENT;
887 if (amdgpu_dig_monitor_is_duallink(encoder, amdgpu_encoder->pixel_clock))
888 args.v1.ucConfig |= ATOM_TRANSMITTER_CONFIG_8LANE_LINK;
889 }
890 break;
891 case 2:
892 args.v2.ucAction = action;
893 if (action == ATOM_TRANSMITTER_ACTION_INIT) {
894 args.v2.usInitInfo = cpu_to_le16(connector_object_id);
895 } else if (action == ATOM_TRANSMITTER_ACTION_SETUP_VSEMPH) {
896 args.v2.asMode.ucLaneSel = lane_num;
897 args.v2.asMode.ucLaneSet = lane_set;
898 } else {
899 if (is_dp)
900 args.v2.usPixelClock = cpu_to_le16(dp_clock / 10);
901 else if (amdgpu_dig_monitor_is_duallink(encoder, amdgpu_encoder->pixel_clock))
902 args.v2.usPixelClock = cpu_to_le16((amdgpu_encoder->pixel_clock / 2) / 10);
903 else
904 args.v2.usPixelClock = cpu_to_le16(amdgpu_encoder->pixel_clock / 10);
905 }
906
907 args.v2.acConfig.ucEncoderSel = dig_encoder;
908 if (dig->linkb)
909 args.v2.acConfig.ucLinkSel = 1;
910
911 switch (amdgpu_encoder->encoder_id) {
912 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY:
913 args.v2.acConfig.ucTransmitterSel = 0;
914 break;
915 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY1:
916 args.v2.acConfig.ucTransmitterSel = 1;
917 break;
918 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY2:
919 args.v2.acConfig.ucTransmitterSel = 2;
920 break;
921 }
922
923 if (is_dp) {
924 args.v2.acConfig.fCoherentMode = 1;
925 args.v2.acConfig.fDPConnector = 1;
926 } else if (amdgpu_encoder->devices & (ATOM_DEVICE_DFP_SUPPORT)) {
927 if (dig->coherent_mode)
928 args.v2.acConfig.fCoherentMode = 1;
929 if (amdgpu_dig_monitor_is_duallink(encoder, amdgpu_encoder->pixel_clock))
930 args.v2.acConfig.fDualLinkConnector = 1;
931 }
932 break;
933 case 3:
934 args.v3.ucAction = action;
935 if (action == ATOM_TRANSMITTER_ACTION_INIT) {
936 args.v3.usInitInfo = cpu_to_le16(connector_object_id);
937 } else if (action == ATOM_TRANSMITTER_ACTION_SETUP_VSEMPH) {
938 args.v3.asMode.ucLaneSel = lane_num;
939 args.v3.asMode.ucLaneSet = lane_set;
940 } else {
941 if (is_dp)
942 args.v3.usPixelClock = cpu_to_le16(dp_clock / 10);
943 else if (amdgpu_dig_monitor_is_duallink(encoder, amdgpu_encoder->pixel_clock))
944 args.v3.usPixelClock = cpu_to_le16((amdgpu_encoder->pixel_clock / 2) / 10);
945 else
946 args.v3.usPixelClock = cpu_to_le16(amdgpu_encoder->pixel_clock / 10);
947 }
948
949 if (is_dp)
950 args.v3.ucLaneNum = dp_lane_count;
951 else if (amdgpu_dig_monitor_is_duallink(encoder, amdgpu_encoder->pixel_clock))
952 args.v3.ucLaneNum = 8;
953 else
954 args.v3.ucLaneNum = 4;
955
956 if (dig->linkb)
957 args.v3.acConfig.ucLinkSel = 1;
958 if (dig_encoder & 1)
959 args.v3.acConfig.ucEncoderSel = 1;
960
961
962
963
964
965
966 if (is_dp && adev->clock.dp_extclk)
967 args.v3.acConfig.ucRefClkSource = 2;
968 else
969 args.v3.acConfig.ucRefClkSource = pll_id;
970
971 switch (amdgpu_encoder->encoder_id) {
972 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY:
973 args.v3.acConfig.ucTransmitterSel = 0;
974 break;
975 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY1:
976 args.v3.acConfig.ucTransmitterSel = 1;
977 break;
978 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY2:
979 args.v3.acConfig.ucTransmitterSel = 2;
980 break;
981 }
982
983 if (is_dp)
984 args.v3.acConfig.fCoherentMode = 1;
985 else if (amdgpu_encoder->devices & (ATOM_DEVICE_DFP_SUPPORT)) {
986 if (dig->coherent_mode)
987 args.v3.acConfig.fCoherentMode = 1;
988 if (amdgpu_dig_monitor_is_duallink(encoder, amdgpu_encoder->pixel_clock))
989 args.v3.acConfig.fDualLinkConnector = 1;
990 }
991 break;
992 case 4:
993 args.v4.ucAction = action;
994 if (action == ATOM_TRANSMITTER_ACTION_INIT) {
995 args.v4.usInitInfo = cpu_to_le16(connector_object_id);
996 } else if (action == ATOM_TRANSMITTER_ACTION_SETUP_VSEMPH) {
997 args.v4.asMode.ucLaneSel = lane_num;
998 args.v4.asMode.ucLaneSet = lane_set;
999 } else {
1000 if (is_dp)
1001 args.v4.usPixelClock = cpu_to_le16(dp_clock / 10);
1002 else if (amdgpu_dig_monitor_is_duallink(encoder, amdgpu_encoder->pixel_clock))
1003 args.v4.usPixelClock = cpu_to_le16((amdgpu_encoder->pixel_clock / 2) / 10);
1004 else
1005 args.v4.usPixelClock = cpu_to_le16(amdgpu_encoder->pixel_clock / 10);
1006 }
1007
1008 if (is_dp)
1009 args.v4.ucLaneNum = dp_lane_count;
1010 else if (amdgpu_dig_monitor_is_duallink(encoder, amdgpu_encoder->pixel_clock))
1011 args.v4.ucLaneNum = 8;
1012 else
1013 args.v4.ucLaneNum = 4;
1014
1015 if (dig->linkb)
1016 args.v4.acConfig.ucLinkSel = 1;
1017 if (dig_encoder & 1)
1018 args.v4.acConfig.ucEncoderSel = 1;
1019
1020
1021
1022
1023
1024
1025 if (is_dp) {
1026 if (adev->clock.dp_extclk)
1027 args.v4.acConfig.ucRefClkSource = ENCODER_REFCLK_SRC_EXTCLK;
1028 else
1029 args.v4.acConfig.ucRefClkSource = ENCODER_REFCLK_SRC_DCPLL;
1030 } else
1031 args.v4.acConfig.ucRefClkSource = pll_id;
1032
1033 switch (amdgpu_encoder->encoder_id) {
1034 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY:
1035 args.v4.acConfig.ucTransmitterSel = 0;
1036 break;
1037 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY1:
1038 args.v4.acConfig.ucTransmitterSel = 1;
1039 break;
1040 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY2:
1041 args.v4.acConfig.ucTransmitterSel = 2;
1042 break;
1043 }
1044
1045 if (is_dp)
1046 args.v4.acConfig.fCoherentMode = 1;
1047 else if (amdgpu_encoder->devices & (ATOM_DEVICE_DFP_SUPPORT)) {
1048 if (dig->coherent_mode)
1049 args.v4.acConfig.fCoherentMode = 1;
1050 if (amdgpu_dig_monitor_is_duallink(encoder, amdgpu_encoder->pixel_clock))
1051 args.v4.acConfig.fDualLinkConnector = 1;
1052 }
1053 break;
1054 case 5:
1055 args.v5.ucAction = action;
1056 if (is_dp)
1057 args.v5.usSymClock = cpu_to_le16(dp_clock / 10);
1058 else
1059 args.v5.usSymClock = cpu_to_le16(amdgpu_encoder->pixel_clock / 10);
1060
1061 switch (amdgpu_encoder->encoder_id) {
1062 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY:
1063 if (dig->linkb)
1064 args.v5.ucPhyId = ATOM_PHY_ID_UNIPHYB;
1065 else
1066 args.v5.ucPhyId = ATOM_PHY_ID_UNIPHYA;
1067 break;
1068 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY1:
1069 if (dig->linkb)
1070 args.v5.ucPhyId = ATOM_PHY_ID_UNIPHYD;
1071 else
1072 args.v5.ucPhyId = ATOM_PHY_ID_UNIPHYC;
1073 break;
1074 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY2:
1075 if (dig->linkb)
1076 args.v5.ucPhyId = ATOM_PHY_ID_UNIPHYF;
1077 else
1078 args.v5.ucPhyId = ATOM_PHY_ID_UNIPHYE;
1079 break;
1080 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY3:
1081 args.v5.ucPhyId = ATOM_PHY_ID_UNIPHYG;
1082 break;
1083 }
1084 if (is_dp)
1085 args.v5.ucLaneNum = dp_lane_count;
1086 else if (amdgpu_dig_monitor_is_duallink(encoder, amdgpu_encoder->pixel_clock))
1087 args.v5.ucLaneNum = 8;
1088 else
1089 args.v5.ucLaneNum = 4;
1090 args.v5.ucConnObjId = connector_object_id;
1091 args.v5.ucDigMode = amdgpu_atombios_encoder_get_encoder_mode(encoder);
1092
1093 if (is_dp && adev->clock.dp_extclk)
1094 args.v5.asConfig.ucPhyClkSrcId = ENCODER_REFCLK_SRC_EXTCLK;
1095 else
1096 args.v5.asConfig.ucPhyClkSrcId = pll_id;
1097
1098 if (is_dp)
1099 args.v5.asConfig.ucCoherentMode = 1;
1100 else if (amdgpu_encoder->devices & (ATOM_DEVICE_DFP_SUPPORT)) {
1101 if (dig->coherent_mode)
1102 args.v5.asConfig.ucCoherentMode = 1;
1103 }
1104 if (hpd_id == AMDGPU_HPD_NONE)
1105 args.v5.asConfig.ucHPDSel = 0;
1106 else
1107 args.v5.asConfig.ucHPDSel = hpd_id + 1;
1108 args.v5.ucDigEncoderSel = 1 << dig_encoder;
1109 args.v5.ucDPLaneSet = lane_set;
1110 break;
1111 case 6:
1112 args.v6.ucAction = action;
1113 if (is_dp)
1114 args.v6.ulSymClock = cpu_to_le32(dp_clock / 10);
1115 else
1116 args.v6.ulSymClock = cpu_to_le32(amdgpu_encoder->pixel_clock / 10);
1117
1118 switch (amdgpu_encoder->encoder_id) {
1119 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY:
1120 if (dig->linkb)
1121 args.v6.ucPhyId = ATOM_PHY_ID_UNIPHYB;
1122 else
1123 args.v6.ucPhyId = ATOM_PHY_ID_UNIPHYA;
1124 break;
1125 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY1:
1126 if (dig->linkb)
1127 args.v6.ucPhyId = ATOM_PHY_ID_UNIPHYD;
1128 else
1129 args.v6.ucPhyId = ATOM_PHY_ID_UNIPHYC;
1130 break;
1131 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY2:
1132 if (dig->linkb)
1133 args.v6.ucPhyId = ATOM_PHY_ID_UNIPHYF;
1134 else
1135 args.v6.ucPhyId = ATOM_PHY_ID_UNIPHYE;
1136 break;
1137 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY3:
1138 args.v6.ucPhyId = ATOM_PHY_ID_UNIPHYG;
1139 break;
1140 }
1141 if (is_dp)
1142 args.v6.ucLaneNum = dp_lane_count;
1143 else if (amdgpu_dig_monitor_is_duallink(encoder, amdgpu_encoder->pixel_clock))
1144 args.v6.ucLaneNum = 8;
1145 else
1146 args.v6.ucLaneNum = 4;
1147 args.v6.ucConnObjId = connector_object_id;
1148 if (action == ATOM_TRANSMITTER_ACTION_SETUP_VSEMPH)
1149 args.v6.ucDPLaneSet = lane_set;
1150 else
1151 args.v6.ucDigMode = amdgpu_atombios_encoder_get_encoder_mode(encoder);
1152
1153 if (hpd_id == AMDGPU_HPD_NONE)
1154 args.v6.ucHPDSel = 0;
1155 else
1156 args.v6.ucHPDSel = hpd_id + 1;
1157 args.v6.ucDigEncoderSel = 1 << dig_encoder;
1158 break;
1159 default:
1160 DRM_ERROR("Unknown table version %d, %d\n", frev, crev);
1161 break;
1162 }
1163 break;
1164 default:
1165 DRM_ERROR("Unknown table version %d, %d\n", frev, crev);
1166 break;
1167 }
1168
1169 amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
1170}
1171
1172bool
1173amdgpu_atombios_encoder_set_edp_panel_power(struct drm_connector *connector,
1174 int action)
1175{
1176 struct amdgpu_connector *amdgpu_connector = to_amdgpu_connector(connector);
1177 struct drm_device *dev = amdgpu_connector->base.dev;
1178 struct amdgpu_device *adev = dev->dev_private;
1179 union dig_transmitter_control args;
1180 int index = GetIndexIntoMasterTable(COMMAND, UNIPHYTransmitterControl);
1181 uint8_t frev, crev;
1182
1183 if (connector->connector_type != DRM_MODE_CONNECTOR_eDP)
1184 goto done;
1185
1186 if ((action != ATOM_TRANSMITTER_ACTION_POWER_ON) &&
1187 (action != ATOM_TRANSMITTER_ACTION_POWER_OFF))
1188 goto done;
1189
1190 if (!amdgpu_atom_parse_cmd_header(adev->mode_info.atom_context, index, &frev, &crev))
1191 goto done;
1192
1193 memset(&args, 0, sizeof(args));
1194
1195 args.v1.ucAction = action;
1196
1197 amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
1198
1199
1200 if (action == ATOM_TRANSMITTER_ACTION_POWER_ON) {
1201 int i;
1202
1203 for (i = 0; i < 300; i++) {
1204 if (amdgpu_display_hpd_sense(adev, amdgpu_connector->hpd.hpd))
1205 return true;
1206 mdelay(1);
1207 }
1208 return false;
1209 }
1210done:
1211 return true;
1212}
1213
1214union external_encoder_control {
1215 EXTERNAL_ENCODER_CONTROL_PS_ALLOCATION v1;
1216 EXTERNAL_ENCODER_CONTROL_PS_ALLOCATION_V3 v3;
1217};
1218
1219static void
1220amdgpu_atombios_encoder_setup_external_encoder(struct drm_encoder *encoder,
1221 struct drm_encoder *ext_encoder,
1222 int action)
1223{
1224 struct drm_device *dev = encoder->dev;
1225 struct amdgpu_device *adev = dev->dev_private;
1226 struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
1227 struct amdgpu_encoder *ext_amdgpu_encoder = to_amdgpu_encoder(ext_encoder);
1228 union external_encoder_control args;
1229 struct drm_connector *connector;
1230 int index = GetIndexIntoMasterTable(COMMAND, ExternalEncoderControl);
1231 u8 frev, crev;
1232 int dp_clock = 0;
1233 int dp_lane_count = 0;
1234 int connector_object_id = 0;
1235 u32 ext_enum = (ext_amdgpu_encoder->encoder_enum & ENUM_ID_MASK) >> ENUM_ID_SHIFT;
1236
1237 if (action == EXTERNAL_ENCODER_ACTION_V3_ENCODER_INIT)
1238 connector = amdgpu_get_connector_for_encoder_init(encoder);
1239 else
1240 connector = amdgpu_get_connector_for_encoder(encoder);
1241
1242 if (connector) {
1243 struct amdgpu_connector *amdgpu_connector = to_amdgpu_connector(connector);
1244 struct amdgpu_connector_atom_dig *dig_connector =
1245 amdgpu_connector->con_priv;
1246
1247 dp_clock = dig_connector->dp_clock;
1248 dp_lane_count = dig_connector->dp_lane_count;
1249 connector_object_id =
1250 (amdgpu_connector->connector_object_id & OBJECT_ID_MASK) >> OBJECT_ID_SHIFT;
1251 }
1252
1253 memset(&args, 0, sizeof(args));
1254
1255 if (!amdgpu_atom_parse_cmd_header(adev->mode_info.atom_context, index, &frev, &crev))
1256 return;
1257
1258 switch (frev) {
1259 case 1:
1260
1261 break;
1262 case 2:
1263 switch (crev) {
1264 case 1:
1265 case 2:
1266 args.v1.sDigEncoder.ucAction = action;
1267 args.v1.sDigEncoder.usPixelClock = cpu_to_le16(amdgpu_encoder->pixel_clock / 10);
1268 args.v1.sDigEncoder.ucEncoderMode =
1269 amdgpu_atombios_encoder_get_encoder_mode(encoder);
1270
1271 if (ENCODER_MODE_IS_DP(args.v1.sDigEncoder.ucEncoderMode)) {
1272 if (dp_clock == 270000)
1273 args.v1.sDigEncoder.ucConfig |= ATOM_ENCODER_CONFIG_DPLINKRATE_2_70GHZ;
1274 args.v1.sDigEncoder.ucLaneNum = dp_lane_count;
1275 } else if (amdgpu_dig_monitor_is_duallink(encoder, amdgpu_encoder->pixel_clock))
1276 args.v1.sDigEncoder.ucLaneNum = 8;
1277 else
1278 args.v1.sDigEncoder.ucLaneNum = 4;
1279 break;
1280 case 3:
1281 args.v3.sExtEncoder.ucAction = action;
1282 if (action == EXTERNAL_ENCODER_ACTION_V3_ENCODER_INIT)
1283 args.v3.sExtEncoder.usConnectorId = cpu_to_le16(connector_object_id);
1284 else
1285 args.v3.sExtEncoder.usPixelClock = cpu_to_le16(amdgpu_encoder->pixel_clock / 10);
1286 args.v3.sExtEncoder.ucEncoderMode =
1287 amdgpu_atombios_encoder_get_encoder_mode(encoder);
1288
1289 if (ENCODER_MODE_IS_DP(args.v3.sExtEncoder.ucEncoderMode)) {
1290 if (dp_clock == 270000)
1291 args.v3.sExtEncoder.ucConfig |= EXTERNAL_ENCODER_CONFIG_V3_DPLINKRATE_2_70GHZ;
1292 else if (dp_clock == 540000)
1293 args.v3.sExtEncoder.ucConfig |= EXTERNAL_ENCODER_CONFIG_V3_DPLINKRATE_5_40GHZ;
1294 args.v3.sExtEncoder.ucLaneNum = dp_lane_count;
1295 } else if (amdgpu_dig_monitor_is_duallink(encoder, amdgpu_encoder->pixel_clock))
1296 args.v3.sExtEncoder.ucLaneNum = 8;
1297 else
1298 args.v3.sExtEncoder.ucLaneNum = 4;
1299 switch (ext_enum) {
1300 case GRAPH_OBJECT_ENUM_ID1:
1301 args.v3.sExtEncoder.ucConfig |= EXTERNAL_ENCODER_CONFIG_V3_ENCODER1;
1302 break;
1303 case GRAPH_OBJECT_ENUM_ID2:
1304 args.v3.sExtEncoder.ucConfig |= EXTERNAL_ENCODER_CONFIG_V3_ENCODER2;
1305 break;
1306 case GRAPH_OBJECT_ENUM_ID3:
1307 args.v3.sExtEncoder.ucConfig |= EXTERNAL_ENCODER_CONFIG_V3_ENCODER3;
1308 break;
1309 }
1310 args.v3.sExtEncoder.ucBitPerColor = amdgpu_atombios_encoder_get_bpc(encoder);
1311 break;
1312 default:
1313 DRM_ERROR("Unknown table version: %d, %d\n", frev, crev);
1314 return;
1315 }
1316 break;
1317 default:
1318 DRM_ERROR("Unknown table version: %d, %d\n", frev, crev);
1319 return;
1320 }
1321 amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
1322}
1323
1324static void
1325amdgpu_atombios_encoder_setup_dig(struct drm_encoder *encoder, int action)
1326{
1327 struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
1328 struct drm_encoder *ext_encoder = amdgpu_get_external_encoder(encoder);
1329 struct amdgpu_encoder_atom_dig *dig = amdgpu_encoder->enc_priv;
1330 struct drm_connector *connector = amdgpu_get_connector_for_encoder(encoder);
1331 struct amdgpu_connector *amdgpu_connector = NULL;
1332 struct amdgpu_connector_atom_dig *amdgpu_dig_connector = NULL;
1333
1334 if (connector) {
1335 amdgpu_connector = to_amdgpu_connector(connector);
1336 amdgpu_dig_connector = amdgpu_connector->con_priv;
1337 }
1338
1339 if (action == ATOM_ENABLE) {
1340 if (!connector)
1341 dig->panel_mode = DP_PANEL_MODE_EXTERNAL_DP_MODE;
1342 else
1343 dig->panel_mode = amdgpu_atombios_dp_get_panel_mode(encoder, connector);
1344
1345
1346 amdgpu_atombios_encoder_setup_dig_encoder(encoder, ATOM_ENCODER_CMD_SETUP, 0);
1347 amdgpu_atombios_encoder_setup_dig_encoder(encoder,
1348 ATOM_ENCODER_CMD_SETUP_PANEL_MODE,
1349 dig->panel_mode);
1350 if (ext_encoder)
1351 amdgpu_atombios_encoder_setup_external_encoder(encoder, ext_encoder,
1352 EXTERNAL_ENCODER_ACTION_V3_ENCODER_SETUP);
1353 if (ENCODER_MODE_IS_DP(amdgpu_atombios_encoder_get_encoder_mode(encoder)) &&
1354 connector) {
1355 if (connector->connector_type == DRM_MODE_CONNECTOR_eDP) {
1356 amdgpu_atombios_encoder_set_edp_panel_power(connector,
1357 ATOM_TRANSMITTER_ACTION_POWER_ON);
1358 amdgpu_dig_connector->edp_on = true;
1359 }
1360 }
1361
1362 amdgpu_atombios_encoder_setup_dig_transmitter(encoder,
1363 ATOM_TRANSMITTER_ACTION_ENABLE,
1364 0, 0);
1365 if (ENCODER_MODE_IS_DP(amdgpu_atombios_encoder_get_encoder_mode(encoder)) &&
1366 connector) {
1367
1368 amdgpu_atombios_dp_link_train(encoder, connector);
1369 amdgpu_atombios_encoder_setup_dig_encoder(encoder, ATOM_ENCODER_CMD_DP_VIDEO_ON, 0);
1370 }
1371 if (amdgpu_encoder->devices & (ATOM_DEVICE_LCD_SUPPORT))
1372 amdgpu_atombios_encoder_set_backlight_level(amdgpu_encoder, dig->backlight_level);
1373 if (ext_encoder)
1374 amdgpu_atombios_encoder_setup_external_encoder(encoder, ext_encoder, ATOM_ENABLE);
1375 } else {
1376 if (ENCODER_MODE_IS_DP(amdgpu_atombios_encoder_get_encoder_mode(encoder)) &&
1377 connector)
1378 amdgpu_atombios_encoder_setup_dig_encoder(encoder,
1379 ATOM_ENCODER_CMD_DP_VIDEO_OFF, 0);
1380 if (ext_encoder)
1381 amdgpu_atombios_encoder_setup_external_encoder(encoder, ext_encoder, ATOM_DISABLE);
1382 if (amdgpu_encoder->devices & (ATOM_DEVICE_LCD_SUPPORT))
1383 amdgpu_atombios_encoder_setup_dig_transmitter(encoder,
1384 ATOM_TRANSMITTER_ACTION_LCD_BLOFF, 0, 0);
1385
1386 if (ENCODER_MODE_IS_DP(amdgpu_atombios_encoder_get_encoder_mode(encoder)) &&
1387 connector)
1388 amdgpu_atombios_dp_set_rx_power_state(connector, DP_SET_POWER_D3);
1389
1390 amdgpu_atombios_encoder_setup_dig_transmitter(encoder,
1391 ATOM_TRANSMITTER_ACTION_DISABLE, 0, 0);
1392 if (ENCODER_MODE_IS_DP(amdgpu_atombios_encoder_get_encoder_mode(encoder)) &&
1393 connector) {
1394 if (connector->connector_type == DRM_MODE_CONNECTOR_eDP) {
1395 amdgpu_atombios_encoder_set_edp_panel_power(connector,
1396 ATOM_TRANSMITTER_ACTION_POWER_OFF);
1397 amdgpu_dig_connector->edp_on = false;
1398 }
1399 }
1400 }
1401}
1402
1403void
1404amdgpu_atombios_encoder_dpms(struct drm_encoder *encoder, int mode)
1405{
1406 struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
1407
1408 DRM_DEBUG_KMS("encoder dpms %d to mode %d, devices %08x, active_devices %08x\n",
1409 amdgpu_encoder->encoder_id, mode, amdgpu_encoder->devices,
1410 amdgpu_encoder->active_device);
1411 switch (amdgpu_encoder->encoder_id) {
1412 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY:
1413 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY1:
1414 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY2:
1415 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY3:
1416 switch (mode) {
1417 case DRM_MODE_DPMS_ON:
1418 amdgpu_atombios_encoder_setup_dig(encoder, ATOM_ENABLE);
1419 break;
1420 case DRM_MODE_DPMS_STANDBY:
1421 case DRM_MODE_DPMS_SUSPEND:
1422 case DRM_MODE_DPMS_OFF:
1423 amdgpu_atombios_encoder_setup_dig(encoder, ATOM_DISABLE);
1424 break;
1425 }
1426 break;
1427 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DVO1:
1428 switch (mode) {
1429 case DRM_MODE_DPMS_ON:
1430 amdgpu_atombios_encoder_setup_dvo(encoder, ATOM_ENABLE);
1431 break;
1432 case DRM_MODE_DPMS_STANDBY:
1433 case DRM_MODE_DPMS_SUSPEND:
1434 case DRM_MODE_DPMS_OFF:
1435 amdgpu_atombios_encoder_setup_dvo(encoder, ATOM_DISABLE);
1436 break;
1437 }
1438 break;
1439 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DAC1:
1440 switch (mode) {
1441 case DRM_MODE_DPMS_ON:
1442 amdgpu_atombios_encoder_setup_dac(encoder, ATOM_ENABLE);
1443 break;
1444 case DRM_MODE_DPMS_STANDBY:
1445 case DRM_MODE_DPMS_SUSPEND:
1446 case DRM_MODE_DPMS_OFF:
1447 amdgpu_atombios_encoder_setup_dac(encoder, ATOM_DISABLE);
1448 break;
1449 }
1450 break;
1451 default:
1452 return;
1453 }
1454}
1455
1456union crtc_source_param {
1457 SELECT_CRTC_SOURCE_PS_ALLOCATION v1;
1458 SELECT_CRTC_SOURCE_PARAMETERS_V2 v2;
1459 SELECT_CRTC_SOURCE_PARAMETERS_V3 v3;
1460};
1461
1462void
1463amdgpu_atombios_encoder_set_crtc_source(struct drm_encoder *encoder)
1464{
1465 struct drm_device *dev = encoder->dev;
1466 struct amdgpu_device *adev = dev->dev_private;
1467 struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
1468 struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(encoder->crtc);
1469 union crtc_source_param args;
1470 int index = GetIndexIntoMasterTable(COMMAND, SelectCRTC_Source);
1471 uint8_t frev, crev;
1472 struct amdgpu_encoder_atom_dig *dig;
1473
1474 memset(&args, 0, sizeof(args));
1475
1476 if (!amdgpu_atom_parse_cmd_header(adev->mode_info.atom_context, index, &frev, &crev))
1477 return;
1478
1479 switch (frev) {
1480 case 1:
1481 switch (crev) {
1482 case 1:
1483 default:
1484 args.v1.ucCRTC = amdgpu_crtc->crtc_id;
1485 switch (amdgpu_encoder->encoder_id) {
1486 case ENCODER_OBJECT_ID_INTERNAL_TMDS1:
1487 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_TMDS1:
1488 args.v1.ucDevice = ATOM_DEVICE_DFP1_INDEX;
1489 break;
1490 case ENCODER_OBJECT_ID_INTERNAL_LVDS:
1491 case ENCODER_OBJECT_ID_INTERNAL_LVTM1:
1492 if (amdgpu_encoder->devices & ATOM_DEVICE_LCD1_SUPPORT)
1493 args.v1.ucDevice = ATOM_DEVICE_LCD1_INDEX;
1494 else
1495 args.v1.ucDevice = ATOM_DEVICE_DFP3_INDEX;
1496 break;
1497 case ENCODER_OBJECT_ID_INTERNAL_DVO1:
1498 case ENCODER_OBJECT_ID_INTERNAL_DDI:
1499 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DVO1:
1500 args.v1.ucDevice = ATOM_DEVICE_DFP2_INDEX;
1501 break;
1502 case ENCODER_OBJECT_ID_INTERNAL_DAC1:
1503 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DAC1:
1504 if (amdgpu_encoder->active_device & (ATOM_DEVICE_TV_SUPPORT))
1505 args.v1.ucDevice = ATOM_DEVICE_TV1_INDEX;
1506 else if (amdgpu_encoder->active_device & (ATOM_DEVICE_CV_SUPPORT))
1507 args.v1.ucDevice = ATOM_DEVICE_CV_INDEX;
1508 else
1509 args.v1.ucDevice = ATOM_DEVICE_CRT1_INDEX;
1510 break;
1511 case ENCODER_OBJECT_ID_INTERNAL_DAC2:
1512 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DAC2:
1513 if (amdgpu_encoder->active_device & (ATOM_DEVICE_TV_SUPPORT))
1514 args.v1.ucDevice = ATOM_DEVICE_TV1_INDEX;
1515 else if (amdgpu_encoder->active_device & (ATOM_DEVICE_CV_SUPPORT))
1516 args.v1.ucDevice = ATOM_DEVICE_CV_INDEX;
1517 else
1518 args.v1.ucDevice = ATOM_DEVICE_CRT2_INDEX;
1519 break;
1520 }
1521 break;
1522 case 2:
1523 args.v2.ucCRTC = amdgpu_crtc->crtc_id;
1524 if (amdgpu_encoder_get_dp_bridge_encoder_id(encoder) != ENCODER_OBJECT_ID_NONE) {
1525 struct drm_connector *connector = amdgpu_get_connector_for_encoder(encoder);
1526
1527 if (connector->connector_type == DRM_MODE_CONNECTOR_LVDS)
1528 args.v2.ucEncodeMode = ATOM_ENCODER_MODE_LVDS;
1529 else if (connector->connector_type == DRM_MODE_CONNECTOR_VGA)
1530 args.v2.ucEncodeMode = ATOM_ENCODER_MODE_CRT;
1531 else
1532 args.v2.ucEncodeMode = amdgpu_atombios_encoder_get_encoder_mode(encoder);
1533 } else if (amdgpu_encoder->devices & (ATOM_DEVICE_LCD_SUPPORT)) {
1534 args.v2.ucEncodeMode = ATOM_ENCODER_MODE_LVDS;
1535 } else {
1536 args.v2.ucEncodeMode = amdgpu_atombios_encoder_get_encoder_mode(encoder);
1537 }
1538 switch (amdgpu_encoder->encoder_id) {
1539 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY:
1540 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY1:
1541 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY2:
1542 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY3:
1543 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_LVTMA:
1544 dig = amdgpu_encoder->enc_priv;
1545 switch (dig->dig_encoder) {
1546 case 0:
1547 args.v2.ucEncoderID = ASIC_INT_DIG1_ENCODER_ID;
1548 break;
1549 case 1:
1550 args.v2.ucEncoderID = ASIC_INT_DIG2_ENCODER_ID;
1551 break;
1552 case 2:
1553 args.v2.ucEncoderID = ASIC_INT_DIG3_ENCODER_ID;
1554 break;
1555 case 3:
1556 args.v2.ucEncoderID = ASIC_INT_DIG4_ENCODER_ID;
1557 break;
1558 case 4:
1559 args.v2.ucEncoderID = ASIC_INT_DIG5_ENCODER_ID;
1560 break;
1561 case 5:
1562 args.v2.ucEncoderID = ASIC_INT_DIG6_ENCODER_ID;
1563 break;
1564 case 6:
1565 args.v2.ucEncoderID = ASIC_INT_DIG7_ENCODER_ID;
1566 break;
1567 }
1568 break;
1569 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DVO1:
1570 args.v2.ucEncoderID = ASIC_INT_DVO_ENCODER_ID;
1571 break;
1572 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DAC1:
1573 if (amdgpu_encoder->active_device & (ATOM_DEVICE_TV_SUPPORT))
1574 args.v2.ucEncoderID = ASIC_INT_TV_ENCODER_ID;
1575 else if (amdgpu_encoder->active_device & (ATOM_DEVICE_CV_SUPPORT))
1576 args.v2.ucEncoderID = ASIC_INT_TV_ENCODER_ID;
1577 else
1578 args.v2.ucEncoderID = ASIC_INT_DAC1_ENCODER_ID;
1579 break;
1580 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DAC2:
1581 if (amdgpu_encoder->active_device & (ATOM_DEVICE_TV_SUPPORT))
1582 args.v2.ucEncoderID = ASIC_INT_TV_ENCODER_ID;
1583 else if (amdgpu_encoder->active_device & (ATOM_DEVICE_CV_SUPPORT))
1584 args.v2.ucEncoderID = ASIC_INT_TV_ENCODER_ID;
1585 else
1586 args.v2.ucEncoderID = ASIC_INT_DAC2_ENCODER_ID;
1587 break;
1588 }
1589 break;
1590 case 3:
1591 args.v3.ucCRTC = amdgpu_crtc->crtc_id;
1592 if (amdgpu_encoder_get_dp_bridge_encoder_id(encoder) != ENCODER_OBJECT_ID_NONE) {
1593 struct drm_connector *connector = amdgpu_get_connector_for_encoder(encoder);
1594
1595 if (connector->connector_type == DRM_MODE_CONNECTOR_LVDS)
1596 args.v2.ucEncodeMode = ATOM_ENCODER_MODE_LVDS;
1597 else if (connector->connector_type == DRM_MODE_CONNECTOR_VGA)
1598 args.v2.ucEncodeMode = ATOM_ENCODER_MODE_CRT;
1599 else
1600 args.v2.ucEncodeMode = amdgpu_atombios_encoder_get_encoder_mode(encoder);
1601 } else if (amdgpu_encoder->devices & (ATOM_DEVICE_LCD_SUPPORT)) {
1602 args.v2.ucEncodeMode = ATOM_ENCODER_MODE_LVDS;
1603 } else {
1604 args.v2.ucEncodeMode = amdgpu_atombios_encoder_get_encoder_mode(encoder);
1605 }
1606 args.v3.ucDstBpc = amdgpu_atombios_encoder_get_bpc(encoder);
1607 switch (amdgpu_encoder->encoder_id) {
1608 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY:
1609 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY1:
1610 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY2:
1611 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY3:
1612 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_LVTMA:
1613 dig = amdgpu_encoder->enc_priv;
1614 switch (dig->dig_encoder) {
1615 case 0:
1616 args.v3.ucEncoderID = ASIC_INT_DIG1_ENCODER_ID;
1617 break;
1618 case 1:
1619 args.v3.ucEncoderID = ASIC_INT_DIG2_ENCODER_ID;
1620 break;
1621 case 2:
1622 args.v3.ucEncoderID = ASIC_INT_DIG3_ENCODER_ID;
1623 break;
1624 case 3:
1625 args.v3.ucEncoderID = ASIC_INT_DIG4_ENCODER_ID;
1626 break;
1627 case 4:
1628 args.v3.ucEncoderID = ASIC_INT_DIG5_ENCODER_ID;
1629 break;
1630 case 5:
1631 args.v3.ucEncoderID = ASIC_INT_DIG6_ENCODER_ID;
1632 break;
1633 case 6:
1634 args.v3.ucEncoderID = ASIC_INT_DIG7_ENCODER_ID;
1635 break;
1636 }
1637 break;
1638 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DVO1:
1639 args.v3.ucEncoderID = ASIC_INT_DVO_ENCODER_ID;
1640 break;
1641 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DAC1:
1642 if (amdgpu_encoder->active_device & (ATOM_DEVICE_TV_SUPPORT))
1643 args.v3.ucEncoderID = ASIC_INT_TV_ENCODER_ID;
1644 else if (amdgpu_encoder->active_device & (ATOM_DEVICE_CV_SUPPORT))
1645 args.v3.ucEncoderID = ASIC_INT_TV_ENCODER_ID;
1646 else
1647 args.v3.ucEncoderID = ASIC_INT_DAC1_ENCODER_ID;
1648 break;
1649 case ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DAC2:
1650 if (amdgpu_encoder->active_device & (ATOM_DEVICE_TV_SUPPORT))
1651 args.v3.ucEncoderID = ASIC_INT_TV_ENCODER_ID;
1652 else if (amdgpu_encoder->active_device & (ATOM_DEVICE_CV_SUPPORT))
1653 args.v3.ucEncoderID = ASIC_INT_TV_ENCODER_ID;
1654 else
1655 args.v3.ucEncoderID = ASIC_INT_DAC2_ENCODER_ID;
1656 break;
1657 }
1658 break;
1659 }
1660 break;
1661 default:
1662 DRM_ERROR("Unknown table version: %d, %d\n", frev, crev);
1663 return;
1664 }
1665
1666 amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
1667}
1668
1669
1670void
1671amdgpu_atombios_encoder_init_dig(struct amdgpu_device *adev)
1672{
1673 struct drm_device *dev = adev->ddev;
1674 struct drm_encoder *encoder;
1675
1676 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
1677 struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
1678 struct drm_encoder *ext_encoder = amdgpu_get_external_encoder(encoder);
1679
1680 switch (amdgpu_encoder->encoder_id) {
1681 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY:
1682 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY1:
1683 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY2:
1684 case ENCODER_OBJECT_ID_INTERNAL_UNIPHY3:
1685 amdgpu_atombios_encoder_setup_dig_transmitter(encoder, ATOM_TRANSMITTER_ACTION_INIT,
1686 0, 0);
1687 break;
1688 }
1689
1690 if (ext_encoder)
1691 amdgpu_atombios_encoder_setup_external_encoder(encoder, ext_encoder,
1692 EXTERNAL_ENCODER_ACTION_V3_ENCODER_INIT);
1693 }
1694}
1695
1696static bool
1697amdgpu_atombios_encoder_dac_load_detect(struct drm_encoder *encoder,
1698 struct drm_connector *connector)
1699{
1700 struct drm_device *dev = encoder->dev;
1701 struct amdgpu_device *adev = dev->dev_private;
1702 struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
1703 struct amdgpu_connector *amdgpu_connector = to_amdgpu_connector(connector);
1704
1705 if (amdgpu_encoder->devices & (ATOM_DEVICE_TV_SUPPORT |
1706 ATOM_DEVICE_CV_SUPPORT |
1707 ATOM_DEVICE_CRT_SUPPORT)) {
1708 DAC_LOAD_DETECTION_PS_ALLOCATION args;
1709 int index = GetIndexIntoMasterTable(COMMAND, DAC_LoadDetection);
1710 uint8_t frev, crev;
1711
1712 memset(&args, 0, sizeof(args));
1713
1714 if (!amdgpu_atom_parse_cmd_header(adev->mode_info.atom_context, index, &frev, &crev))
1715 return false;
1716
1717 args.sDacload.ucMisc = 0;
1718
1719 if ((amdgpu_encoder->encoder_id == ENCODER_OBJECT_ID_INTERNAL_DAC1) ||
1720 (amdgpu_encoder->encoder_id == ENCODER_OBJECT_ID_INTERNAL_KLDSCP_DAC1))
1721 args.sDacload.ucDacType = ATOM_DAC_A;
1722 else
1723 args.sDacload.ucDacType = ATOM_DAC_B;
1724
1725 if (amdgpu_connector->devices & ATOM_DEVICE_CRT1_SUPPORT)
1726 args.sDacload.usDeviceID = cpu_to_le16(ATOM_DEVICE_CRT1_SUPPORT);
1727 else if (amdgpu_connector->devices & ATOM_DEVICE_CRT2_SUPPORT)
1728 args.sDacload.usDeviceID = cpu_to_le16(ATOM_DEVICE_CRT2_SUPPORT);
1729 else if (amdgpu_connector->devices & ATOM_DEVICE_CV_SUPPORT) {
1730 args.sDacload.usDeviceID = cpu_to_le16(ATOM_DEVICE_CV_SUPPORT);
1731 if (crev >= 3)
1732 args.sDacload.ucMisc = DAC_LOAD_MISC_YPrPb;
1733 } else if (amdgpu_connector->devices & ATOM_DEVICE_TV1_SUPPORT) {
1734 args.sDacload.usDeviceID = cpu_to_le16(ATOM_DEVICE_TV1_SUPPORT);
1735 if (crev >= 3)
1736 args.sDacload.ucMisc = DAC_LOAD_MISC_YPrPb;
1737 }
1738
1739 amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
1740
1741 return true;
1742 } else
1743 return false;
1744}
1745
1746enum drm_connector_status
1747amdgpu_atombios_encoder_dac_detect(struct drm_encoder *encoder,
1748 struct drm_connector *connector)
1749{
1750 struct drm_device *dev = encoder->dev;
1751 struct amdgpu_device *adev = dev->dev_private;
1752 struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
1753 struct amdgpu_connector *amdgpu_connector = to_amdgpu_connector(connector);
1754 uint32_t bios_0_scratch;
1755
1756 if (!amdgpu_atombios_encoder_dac_load_detect(encoder, connector)) {
1757 DRM_DEBUG_KMS("detect returned false \n");
1758 return connector_status_unknown;
1759 }
1760
1761 bios_0_scratch = RREG32(mmBIOS_SCRATCH_0);
1762
1763 DRM_DEBUG_KMS("Bios 0 scratch %x %08x\n", bios_0_scratch, amdgpu_encoder->devices);
1764 if (amdgpu_connector->devices & ATOM_DEVICE_CRT1_SUPPORT) {
1765 if (bios_0_scratch & ATOM_S0_CRT1_MASK)
1766 return connector_status_connected;
1767 }
1768 if (amdgpu_connector->devices & ATOM_DEVICE_CRT2_SUPPORT) {
1769 if (bios_0_scratch & ATOM_S0_CRT2_MASK)
1770 return connector_status_connected;
1771 }
1772 if (amdgpu_connector->devices & ATOM_DEVICE_CV_SUPPORT) {
1773 if (bios_0_scratch & (ATOM_S0_CV_MASK|ATOM_S0_CV_MASK_A))
1774 return connector_status_connected;
1775 }
1776 if (amdgpu_connector->devices & ATOM_DEVICE_TV1_SUPPORT) {
1777 if (bios_0_scratch & (ATOM_S0_TV1_COMPOSITE | ATOM_S0_TV1_COMPOSITE_A))
1778 return connector_status_connected;
1779 else if (bios_0_scratch & (ATOM_S0_TV1_SVIDEO | ATOM_S0_TV1_SVIDEO_A))
1780 return connector_status_connected;
1781 }
1782 return connector_status_disconnected;
1783}
1784
1785enum drm_connector_status
1786amdgpu_atombios_encoder_dig_detect(struct drm_encoder *encoder,
1787 struct drm_connector *connector)
1788{
1789 struct drm_device *dev = encoder->dev;
1790 struct amdgpu_device *adev = dev->dev_private;
1791 struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
1792 struct amdgpu_connector *amdgpu_connector = to_amdgpu_connector(connector);
1793 struct drm_encoder *ext_encoder = amdgpu_get_external_encoder(encoder);
1794 u32 bios_0_scratch;
1795
1796 if (!ext_encoder)
1797 return connector_status_unknown;
1798
1799 if ((amdgpu_connector->devices & ATOM_DEVICE_CRT_SUPPORT) == 0)
1800 return connector_status_unknown;
1801
1802
1803 amdgpu_atombios_encoder_setup_external_encoder(encoder, ext_encoder,
1804 EXTERNAL_ENCODER_ACTION_V3_DACLOAD_DETECTION);
1805
1806 bios_0_scratch = RREG32(mmBIOS_SCRATCH_0);
1807
1808 DRM_DEBUG_KMS("Bios 0 scratch %x %08x\n", bios_0_scratch, amdgpu_encoder->devices);
1809 if (amdgpu_connector->devices & ATOM_DEVICE_CRT1_SUPPORT) {
1810 if (bios_0_scratch & ATOM_S0_CRT1_MASK)
1811 return connector_status_connected;
1812 }
1813 if (amdgpu_connector->devices & ATOM_DEVICE_CRT2_SUPPORT) {
1814 if (bios_0_scratch & ATOM_S0_CRT2_MASK)
1815 return connector_status_connected;
1816 }
1817 if (amdgpu_connector->devices & ATOM_DEVICE_CV_SUPPORT) {
1818 if (bios_0_scratch & (ATOM_S0_CV_MASK|ATOM_S0_CV_MASK_A))
1819 return connector_status_connected;
1820 }
1821 if (amdgpu_connector->devices & ATOM_DEVICE_TV1_SUPPORT) {
1822 if (bios_0_scratch & (ATOM_S0_TV1_COMPOSITE | ATOM_S0_TV1_COMPOSITE_A))
1823 return connector_status_connected;
1824 else if (bios_0_scratch & (ATOM_S0_TV1_SVIDEO | ATOM_S0_TV1_SVIDEO_A))
1825 return connector_status_connected;
1826 }
1827 return connector_status_disconnected;
1828}
1829
1830void
1831amdgpu_atombios_encoder_setup_ext_encoder_ddc(struct drm_encoder *encoder)
1832{
1833 struct drm_encoder *ext_encoder = amdgpu_get_external_encoder(encoder);
1834
1835 if (ext_encoder)
1836
1837 amdgpu_atombios_encoder_setup_external_encoder(encoder, ext_encoder,
1838 EXTERNAL_ENCODER_ACTION_V3_DDC_SETUP);
1839
1840}
1841
1842void
1843amdgpu_atombios_encoder_set_bios_scratch_regs(struct drm_connector *connector,
1844 struct drm_encoder *encoder,
1845 bool connected)
1846{
1847 struct drm_device *dev = connector->dev;
1848 struct amdgpu_device *adev = dev->dev_private;
1849 struct amdgpu_connector *amdgpu_connector =
1850 to_amdgpu_connector(connector);
1851 struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
1852 uint32_t bios_0_scratch, bios_3_scratch, bios_6_scratch;
1853
1854 bios_0_scratch = RREG32(mmBIOS_SCRATCH_0);
1855 bios_3_scratch = RREG32(mmBIOS_SCRATCH_3);
1856 bios_6_scratch = RREG32(mmBIOS_SCRATCH_6);
1857
1858 if ((amdgpu_encoder->devices & ATOM_DEVICE_LCD1_SUPPORT) &&
1859 (amdgpu_connector->devices & ATOM_DEVICE_LCD1_SUPPORT)) {
1860 if (connected) {
1861 DRM_DEBUG_KMS("LCD1 connected\n");
1862 bios_0_scratch |= ATOM_S0_LCD1;
1863 bios_3_scratch |= ATOM_S3_LCD1_ACTIVE;
1864 bios_6_scratch |= ATOM_S6_ACC_REQ_LCD1;
1865 } else {
1866 DRM_DEBUG_KMS("LCD1 disconnected\n");
1867 bios_0_scratch &= ~ATOM_S0_LCD1;
1868 bios_3_scratch &= ~ATOM_S3_LCD1_ACTIVE;
1869 bios_6_scratch &= ~ATOM_S6_ACC_REQ_LCD1;
1870 }
1871 }
1872 if ((amdgpu_encoder->devices & ATOM_DEVICE_CRT1_SUPPORT) &&
1873 (amdgpu_connector->devices & ATOM_DEVICE_CRT1_SUPPORT)) {
1874 if (connected) {
1875 DRM_DEBUG_KMS("CRT1 connected\n");
1876 bios_0_scratch |= ATOM_S0_CRT1_COLOR;
1877 bios_3_scratch |= ATOM_S3_CRT1_ACTIVE;
1878 bios_6_scratch |= ATOM_S6_ACC_REQ_CRT1;
1879 } else {
1880 DRM_DEBUG_KMS("CRT1 disconnected\n");
1881 bios_0_scratch &= ~ATOM_S0_CRT1_MASK;
1882 bios_3_scratch &= ~ATOM_S3_CRT1_ACTIVE;
1883 bios_6_scratch &= ~ATOM_S6_ACC_REQ_CRT1;
1884 }
1885 }
1886 if ((amdgpu_encoder->devices & ATOM_DEVICE_CRT2_SUPPORT) &&
1887 (amdgpu_connector->devices & ATOM_DEVICE_CRT2_SUPPORT)) {
1888 if (connected) {
1889 DRM_DEBUG_KMS("CRT2 connected\n");
1890 bios_0_scratch |= ATOM_S0_CRT2_COLOR;
1891 bios_3_scratch |= ATOM_S3_CRT2_ACTIVE;
1892 bios_6_scratch |= ATOM_S6_ACC_REQ_CRT2;
1893 } else {
1894 DRM_DEBUG_KMS("CRT2 disconnected\n");
1895 bios_0_scratch &= ~ATOM_S0_CRT2_MASK;
1896 bios_3_scratch &= ~ATOM_S3_CRT2_ACTIVE;
1897 bios_6_scratch &= ~ATOM_S6_ACC_REQ_CRT2;
1898 }
1899 }
1900 if ((amdgpu_encoder->devices & ATOM_DEVICE_DFP1_SUPPORT) &&
1901 (amdgpu_connector->devices & ATOM_DEVICE_DFP1_SUPPORT)) {
1902 if (connected) {
1903 DRM_DEBUG_KMS("DFP1 connected\n");
1904 bios_0_scratch |= ATOM_S0_DFP1;
1905 bios_3_scratch |= ATOM_S3_DFP1_ACTIVE;
1906 bios_6_scratch |= ATOM_S6_ACC_REQ_DFP1;
1907 } else {
1908 DRM_DEBUG_KMS("DFP1 disconnected\n");
1909 bios_0_scratch &= ~ATOM_S0_DFP1;
1910 bios_3_scratch &= ~ATOM_S3_DFP1_ACTIVE;
1911 bios_6_scratch &= ~ATOM_S6_ACC_REQ_DFP1;
1912 }
1913 }
1914 if ((amdgpu_encoder->devices & ATOM_DEVICE_DFP2_SUPPORT) &&
1915 (amdgpu_connector->devices & ATOM_DEVICE_DFP2_SUPPORT)) {
1916 if (connected) {
1917 DRM_DEBUG_KMS("DFP2 connected\n");
1918 bios_0_scratch |= ATOM_S0_DFP2;
1919 bios_3_scratch |= ATOM_S3_DFP2_ACTIVE;
1920 bios_6_scratch |= ATOM_S6_ACC_REQ_DFP2;
1921 } else {
1922 DRM_DEBUG_KMS("DFP2 disconnected\n");
1923 bios_0_scratch &= ~ATOM_S0_DFP2;
1924 bios_3_scratch &= ~ATOM_S3_DFP2_ACTIVE;
1925 bios_6_scratch &= ~ATOM_S6_ACC_REQ_DFP2;
1926 }
1927 }
1928 if ((amdgpu_encoder->devices & ATOM_DEVICE_DFP3_SUPPORT) &&
1929 (amdgpu_connector->devices & ATOM_DEVICE_DFP3_SUPPORT)) {
1930 if (connected) {
1931 DRM_DEBUG_KMS("DFP3 connected\n");
1932 bios_0_scratch |= ATOM_S0_DFP3;
1933 bios_3_scratch |= ATOM_S3_DFP3_ACTIVE;
1934 bios_6_scratch |= ATOM_S6_ACC_REQ_DFP3;
1935 } else {
1936 DRM_DEBUG_KMS("DFP3 disconnected\n");
1937 bios_0_scratch &= ~ATOM_S0_DFP3;
1938 bios_3_scratch &= ~ATOM_S3_DFP3_ACTIVE;
1939 bios_6_scratch &= ~ATOM_S6_ACC_REQ_DFP3;
1940 }
1941 }
1942 if ((amdgpu_encoder->devices & ATOM_DEVICE_DFP4_SUPPORT) &&
1943 (amdgpu_connector->devices & ATOM_DEVICE_DFP4_SUPPORT)) {
1944 if (connected) {
1945 DRM_DEBUG_KMS("DFP4 connected\n");
1946 bios_0_scratch |= ATOM_S0_DFP4;
1947 bios_3_scratch |= ATOM_S3_DFP4_ACTIVE;
1948 bios_6_scratch |= ATOM_S6_ACC_REQ_DFP4;
1949 } else {
1950 DRM_DEBUG_KMS("DFP4 disconnected\n");
1951 bios_0_scratch &= ~ATOM_S0_DFP4;
1952 bios_3_scratch &= ~ATOM_S3_DFP4_ACTIVE;
1953 bios_6_scratch &= ~ATOM_S6_ACC_REQ_DFP4;
1954 }
1955 }
1956 if ((amdgpu_encoder->devices & ATOM_DEVICE_DFP5_SUPPORT) &&
1957 (amdgpu_connector->devices & ATOM_DEVICE_DFP5_SUPPORT)) {
1958 if (connected) {
1959 DRM_DEBUG_KMS("DFP5 connected\n");
1960 bios_0_scratch |= ATOM_S0_DFP5;
1961 bios_3_scratch |= ATOM_S3_DFP5_ACTIVE;
1962 bios_6_scratch |= ATOM_S6_ACC_REQ_DFP5;
1963 } else {
1964 DRM_DEBUG_KMS("DFP5 disconnected\n");
1965 bios_0_scratch &= ~ATOM_S0_DFP5;
1966 bios_3_scratch &= ~ATOM_S3_DFP5_ACTIVE;
1967 bios_6_scratch &= ~ATOM_S6_ACC_REQ_DFP5;
1968 }
1969 }
1970 if ((amdgpu_encoder->devices & ATOM_DEVICE_DFP6_SUPPORT) &&
1971 (amdgpu_connector->devices & ATOM_DEVICE_DFP6_SUPPORT)) {
1972 if (connected) {
1973 DRM_DEBUG_KMS("DFP6 connected\n");
1974 bios_0_scratch |= ATOM_S0_DFP6;
1975 bios_3_scratch |= ATOM_S3_DFP6_ACTIVE;
1976 bios_6_scratch |= ATOM_S6_ACC_REQ_DFP6;
1977 } else {
1978 DRM_DEBUG_KMS("DFP6 disconnected\n");
1979 bios_0_scratch &= ~ATOM_S0_DFP6;
1980 bios_3_scratch &= ~ATOM_S3_DFP6_ACTIVE;
1981 bios_6_scratch &= ~ATOM_S6_ACC_REQ_DFP6;
1982 }
1983 }
1984
1985 WREG32(mmBIOS_SCRATCH_0, bios_0_scratch);
1986 WREG32(mmBIOS_SCRATCH_3, bios_3_scratch);
1987 WREG32(mmBIOS_SCRATCH_6, bios_6_scratch);
1988}
1989
1990union lvds_info {
1991 struct _ATOM_LVDS_INFO info;
1992 struct _ATOM_LVDS_INFO_V12 info_12;
1993};
1994
1995struct amdgpu_encoder_atom_dig *
1996amdgpu_atombios_encoder_get_lcd_info(struct amdgpu_encoder *encoder)
1997{
1998 struct drm_device *dev = encoder->base.dev;
1999 struct amdgpu_device *adev = dev->dev_private;
2000 struct amdgpu_mode_info *mode_info = &adev->mode_info;
2001 int index = GetIndexIntoMasterTable(DATA, LVDS_Info);
2002 uint16_t data_offset, misc;
2003 union lvds_info *lvds_info;
2004 uint8_t frev, crev;
2005 struct amdgpu_encoder_atom_dig *lvds = NULL;
2006 int encoder_enum = (encoder->encoder_enum & ENUM_ID_MASK) >> ENUM_ID_SHIFT;
2007
2008 if (amdgpu_atom_parse_data_header(mode_info->atom_context, index, NULL,
2009 &frev, &crev, &data_offset)) {
2010 lvds_info =
2011 (union lvds_info *)(mode_info->atom_context->bios + data_offset);
2012 lvds =
2013 kzalloc(sizeof(struct amdgpu_encoder_atom_dig), GFP_KERNEL);
2014
2015 if (!lvds)
2016 return NULL;
2017
2018 lvds->native_mode.clock =
2019 le16_to_cpu(lvds_info->info.sLCDTiming.usPixClk) * 10;
2020 lvds->native_mode.hdisplay =
2021 le16_to_cpu(lvds_info->info.sLCDTiming.usHActive);
2022 lvds->native_mode.vdisplay =
2023 le16_to_cpu(lvds_info->info.sLCDTiming.usVActive);
2024 lvds->native_mode.htotal = lvds->native_mode.hdisplay +
2025 le16_to_cpu(lvds_info->info.sLCDTiming.usHBlanking_Time);
2026 lvds->native_mode.hsync_start = lvds->native_mode.hdisplay +
2027 le16_to_cpu(lvds_info->info.sLCDTiming.usHSyncOffset);
2028 lvds->native_mode.hsync_end = lvds->native_mode.hsync_start +
2029 le16_to_cpu(lvds_info->info.sLCDTiming.usHSyncWidth);
2030 lvds->native_mode.vtotal = lvds->native_mode.vdisplay +
2031 le16_to_cpu(lvds_info->info.sLCDTiming.usVBlanking_Time);
2032 lvds->native_mode.vsync_start = lvds->native_mode.vdisplay +
2033 le16_to_cpu(lvds_info->info.sLCDTiming.usVSyncOffset);
2034 lvds->native_mode.vsync_end = lvds->native_mode.vsync_start +
2035 le16_to_cpu(lvds_info->info.sLCDTiming.usVSyncWidth);
2036 lvds->panel_pwr_delay =
2037 le16_to_cpu(lvds_info->info.usOffDelayInMs);
2038 lvds->lcd_misc = lvds_info->info.ucLVDS_Misc;
2039
2040 misc = le16_to_cpu(lvds_info->info.sLCDTiming.susModeMiscInfo.usAccess);
2041 if (misc & ATOM_VSYNC_POLARITY)
2042 lvds->native_mode.flags |= DRM_MODE_FLAG_NVSYNC;
2043 if (misc & ATOM_HSYNC_POLARITY)
2044 lvds->native_mode.flags |= DRM_MODE_FLAG_NHSYNC;
2045 if (misc & ATOM_COMPOSITESYNC)
2046 lvds->native_mode.flags |= DRM_MODE_FLAG_CSYNC;
2047 if (misc & ATOM_INTERLACE)
2048 lvds->native_mode.flags |= DRM_MODE_FLAG_INTERLACE;
2049 if (misc & ATOM_DOUBLE_CLOCK_MODE)
2050 lvds->native_mode.flags |= DRM_MODE_FLAG_DBLSCAN;
2051
2052 lvds->native_mode.width_mm = le16_to_cpu(lvds_info->info.sLCDTiming.usImageHSize);
2053 lvds->native_mode.height_mm = le16_to_cpu(lvds_info->info.sLCDTiming.usImageVSize);
2054
2055
2056 drm_mode_set_crtcinfo(&lvds->native_mode, CRTC_INTERLACE_HALVE_V);
2057
2058 lvds->lcd_ss_id = lvds_info->info.ucSS_Id;
2059
2060 encoder->native_mode = lvds->native_mode;
2061
2062 if (encoder_enum == 2)
2063 lvds->linkb = true;
2064 else
2065 lvds->linkb = false;
2066
2067
2068 if (le16_to_cpu(lvds_info->info.usModePatchTableOffset)) {
2069 ATOM_FAKE_EDID_PATCH_RECORD *fake_edid_record;
2070 ATOM_PANEL_RESOLUTION_PATCH_RECORD *panel_res_record;
2071 bool bad_record = false;
2072 u8 *record;
2073
2074 if ((frev == 1) && (crev < 2))
2075
2076 record = (u8 *)(mode_info->atom_context->bios +
2077 le16_to_cpu(lvds_info->info.usModePatchTableOffset));
2078 else
2079
2080 record = (u8 *)(mode_info->atom_context->bios +
2081 data_offset +
2082 le16_to_cpu(lvds_info->info.usModePatchTableOffset));
2083 while (*record != ATOM_RECORD_END_TYPE) {
2084 switch (*record) {
2085 case LCD_MODE_PATCH_RECORD_MODE_TYPE:
2086 record += sizeof(ATOM_PATCH_RECORD_MODE);
2087 break;
2088 case LCD_RTS_RECORD_TYPE:
2089 record += sizeof(ATOM_LCD_RTS_RECORD);
2090 break;
2091 case LCD_CAP_RECORD_TYPE:
2092 record += sizeof(ATOM_LCD_MODE_CONTROL_CAP);
2093 break;
2094 case LCD_FAKE_EDID_PATCH_RECORD_TYPE:
2095 fake_edid_record = (ATOM_FAKE_EDID_PATCH_RECORD *)record;
2096 if (fake_edid_record->ucFakeEDIDLength) {
2097 struct edid *edid;
2098 int edid_size =
2099 max((int)EDID_LENGTH, (int)fake_edid_record->ucFakeEDIDLength);
2100 edid = kmalloc(edid_size, GFP_KERNEL);
2101 if (edid) {
2102 memcpy((u8 *)edid, (u8 *)&fake_edid_record->ucFakeEDIDString[0],
2103 fake_edid_record->ucFakeEDIDLength);
2104
2105 if (drm_edid_is_valid(edid)) {
2106 adev->mode_info.bios_hardcoded_edid = edid;
2107 adev->mode_info.bios_hardcoded_edid_size = edid_size;
2108 } else
2109 kfree(edid);
2110 }
2111 }
2112 record += fake_edid_record->ucFakeEDIDLength ?
2113 fake_edid_record->ucFakeEDIDLength + 2 :
2114 sizeof(ATOM_FAKE_EDID_PATCH_RECORD);
2115 break;
2116 case LCD_PANEL_RESOLUTION_RECORD_TYPE:
2117 panel_res_record = (ATOM_PANEL_RESOLUTION_PATCH_RECORD *)record;
2118 lvds->native_mode.width_mm = panel_res_record->usHSize;
2119 lvds->native_mode.height_mm = panel_res_record->usVSize;
2120 record += sizeof(ATOM_PANEL_RESOLUTION_PATCH_RECORD);
2121 break;
2122 default:
2123 DRM_ERROR("Bad LCD record %d\n", *record);
2124 bad_record = true;
2125 break;
2126 }
2127 if (bad_record)
2128 break;
2129 }
2130 }
2131 }
2132 return lvds;
2133}
2134
2135struct amdgpu_encoder_atom_dig *
2136amdgpu_atombios_encoder_get_dig_info(struct amdgpu_encoder *amdgpu_encoder)
2137{
2138 int encoder_enum = (amdgpu_encoder->encoder_enum & ENUM_ID_MASK) >> ENUM_ID_SHIFT;
2139 struct amdgpu_encoder_atom_dig *dig = kzalloc(sizeof(struct amdgpu_encoder_atom_dig), GFP_KERNEL);
2140
2141 if (!dig)
2142 return NULL;
2143
2144
2145 dig->coherent_mode = true;
2146 dig->dig_encoder = -1;
2147
2148 if (encoder_enum == 2)
2149 dig->linkb = true;
2150 else
2151 dig->linkb = false;
2152
2153 return dig;
2154}
2155
2156
