1 // SPDX-License-Identifier: GPL-2.0-only
3 * Copyright (c) 2012-2020, The Linux Foundation. All rights reserved.
8 #include <drm/drm_connector.h>
9 #include <drm/drm_edid.h>
10 #include <drm/drm_print.h>
12 struct dp_panel_private {
14 struct drm_device *drm_dev;
15 struct dp_panel dp_panel;
16 struct drm_dp_aux *aux;
18 struct dp_catalog *catalog;
20 bool aux_cfg_update_done;
23 static int dp_panel_read_dpcd(struct dp_panel *dp_panel)
28 struct dp_panel_private *panel;
29 struct dp_link_info *link_info;
30 u8 *dpcd, major = 0, minor = 0, temp;
31 u32 offset = DP_DPCD_REV;
33 dpcd = dp_panel->dpcd;
35 panel = container_of(dp_panel, struct dp_panel_private, dp_panel);
36 link_info = &dp_panel->link_info;
38 rlen = drm_dp_dpcd_read(panel->aux, offset,
39 dpcd, (DP_RECEIVER_CAP_SIZE + 1));
40 if (rlen < (DP_RECEIVER_CAP_SIZE + 1)) {
41 DRM_ERROR("dpcd read failed, rlen=%zd\n", rlen);
42 if (rlen == -ETIMEDOUT)
50 temp = dpcd[DP_TRAINING_AUX_RD_INTERVAL];
52 /* check for EXTENDED_RECEIVER_CAPABILITY_FIELD_PRESENT */
54 drm_dbg_dp(panel->drm_dev,
55 "using EXTENDED_RECEIVER_CAPABILITY_FIELD\n");
56 offset = DPRX_EXTENDED_DPCD_FIELD;
59 rlen = drm_dp_dpcd_read(panel->aux, offset,
60 dpcd, (DP_RECEIVER_CAP_SIZE + 1));
61 if (rlen < (DP_RECEIVER_CAP_SIZE + 1)) {
62 DRM_ERROR("dpcd read failed, rlen=%zd\n", rlen);
63 if (rlen == -ETIMEDOUT)
71 link_info->revision = dpcd[DP_DPCD_REV];
72 major = (link_info->revision >> 4) & 0x0f;
73 minor = link_info->revision & 0x0f;
75 link_info->rate = drm_dp_bw_code_to_link_rate(dpcd[DP_MAX_LINK_RATE]);
76 link_info->num_lanes = dpcd[DP_MAX_LANE_COUNT] & DP_MAX_LANE_COUNT_MASK;
78 if (link_info->num_lanes > dp_panel->max_dp_lanes)
79 link_info->num_lanes = dp_panel->max_dp_lanes;
81 /* Limit support upto HBR2 until HBR3 support is added */
82 if (link_info->rate >= (drm_dp_bw_code_to_link_rate(DP_LINK_BW_5_4)))
83 link_info->rate = drm_dp_bw_code_to_link_rate(DP_LINK_BW_5_4);
85 drm_dbg_dp(panel->drm_dev, "version: %d.%d\n", major, minor);
86 drm_dbg_dp(panel->drm_dev, "link_rate=%d\n", link_info->rate);
87 drm_dbg_dp(panel->drm_dev, "lane_count=%d\n", link_info->num_lanes);
89 if (drm_dp_enhanced_frame_cap(dpcd))
90 link_info->capabilities |= DP_LINK_CAP_ENHANCED_FRAMING;
92 dp_panel->dfp_present = dpcd[DP_DOWNSTREAMPORT_PRESENT];
93 dp_panel->dfp_present &= DP_DWN_STRM_PORT_PRESENT;
95 if (dp_panel->dfp_present && (dpcd[DP_DPCD_REV] > 0x10)) {
96 dp_panel->ds_port_cnt = dpcd[DP_DOWN_STREAM_PORT_COUNT];
97 dp_panel->ds_port_cnt &= DP_PORT_COUNT_MASK;
98 len = DP_DOWNSTREAM_PORTS * DP_DOWNSTREAM_CAP_SIZE;
100 rlen = drm_dp_dpcd_read(panel->aux,
101 DP_DOWNSTREAM_PORT_0, dp_panel->ds_cap_info, len);
103 DRM_ERROR("ds port status failed, rlen=%zd\n", rlen);
113 static u32 dp_panel_get_supported_bpp(struct dp_panel *dp_panel,
114 u32 mode_edid_bpp, u32 mode_pclk_khz)
116 struct dp_link_info *link_info;
117 const u32 max_supported_bpp = 30, min_supported_bpp = 18;
118 u32 bpp = 0, data_rate_khz = 0;
120 bpp = min_t(u32, mode_edid_bpp, max_supported_bpp);
122 link_info = &dp_panel->link_info;
123 data_rate_khz = link_info->num_lanes * link_info->rate * 8;
125 while (bpp > min_supported_bpp) {
126 if (mode_pclk_khz * bpp <= data_rate_khz)
134 static int dp_panel_update_modes(struct drm_connector *connector,
140 rc = drm_connector_update_edid_property(connector, edid);
142 DRM_ERROR("failed to update edid property %d\n", rc);
145 rc = drm_add_edid_modes(connector, edid);
149 rc = drm_connector_update_edid_property(connector, NULL);
151 DRM_ERROR("failed to update edid property %d\n", rc);
156 int dp_panel_read_sink_caps(struct dp_panel *dp_panel,
157 struct drm_connector *connector)
161 struct dp_panel_private *panel;
163 if (!dp_panel || !connector) {
164 DRM_ERROR("invalid input\n");
168 panel = container_of(dp_panel, struct dp_panel_private, dp_panel);
170 rc = dp_panel_read_dpcd(dp_panel);
172 DRM_ERROR("read dpcd failed %d\n", rc);
176 bw_code = drm_dp_link_rate_to_bw_code(dp_panel->link_info.rate);
177 if (!is_link_rate_valid(bw_code) ||
178 !is_lane_count_valid(dp_panel->link_info.num_lanes) ||
179 (bw_code > dp_panel->max_bw_code)) {
180 DRM_ERROR("Illegal link rate=%d lane=%d\n", dp_panel->link_info.rate,
181 dp_panel->link_info.num_lanes);
185 if (dp_panel->dfp_present) {
186 rlen = drm_dp_dpcd_read(panel->aux, DP_SINK_COUNT,
189 count = DP_GET_SINK_COUNT(count);
191 DRM_ERROR("no downstream ports connected\n");
192 panel->link->sink_count = 0;
199 kfree(dp_panel->edid);
200 dp_panel->edid = NULL;
202 dp_panel->edid = drm_get_edid(connector,
204 if (!dp_panel->edid) {
205 DRM_ERROR("panel edid read failed\n");
206 /* check edid read fail is due to unplug */
207 if (!dp_catalog_link_is_connected(panel->catalog)) {
213 if (panel->aux_cfg_update_done) {
214 drm_dbg_dp(panel->drm_dev,
215 "read DPCD with updated AUX config\n");
216 rc = dp_panel_read_dpcd(dp_panel);
217 bw_code = drm_dp_link_rate_to_bw_code(dp_panel->link_info.rate);
218 if (rc || !is_link_rate_valid(bw_code) ||
219 !is_lane_count_valid(dp_panel->link_info.num_lanes)
220 || (bw_code > dp_panel->max_bw_code)) {
221 DRM_ERROR("read dpcd failed %d\n", rc);
224 panel->aux_cfg_update_done = false;
230 u32 dp_panel_get_mode_bpp(struct dp_panel *dp_panel,
231 u32 mode_edid_bpp, u32 mode_pclk_khz)
233 struct dp_panel_private *panel;
236 if (!dp_panel || !mode_edid_bpp || !mode_pclk_khz) {
237 DRM_ERROR("invalid input\n");
241 panel = container_of(dp_panel, struct dp_panel_private, dp_panel);
243 if (dp_panel->video_test)
244 bpp = dp_link_bit_depth_to_bpp(
245 panel->link->test_video.test_bit_depth);
247 bpp = dp_panel_get_supported_bpp(dp_panel, mode_edid_bpp,
253 int dp_panel_get_modes(struct dp_panel *dp_panel,
254 struct drm_connector *connector)
257 DRM_ERROR("invalid input\n");
262 return dp_panel_update_modes(connector, dp_panel->edid);
267 static u8 dp_panel_get_edid_checksum(struct edid *edid)
269 struct edid *last_block;
271 bool is_edid_corrupt = false;
274 DRM_ERROR("invalid edid input\n");
278 raw_edid = (u8 *)edid;
279 raw_edid += (edid->extensions * EDID_LENGTH);
280 last_block = (struct edid *)raw_edid;
282 /* block type extension */
283 drm_edid_block_valid(raw_edid, 1, false, &is_edid_corrupt);
284 if (!is_edid_corrupt)
285 return last_block->checksum;
287 DRM_ERROR("Invalid block, no checksum\n");
291 void dp_panel_handle_sink_request(struct dp_panel *dp_panel)
293 struct dp_panel_private *panel;
296 DRM_ERROR("invalid input\n");
300 panel = container_of(dp_panel, struct dp_panel_private, dp_panel);
302 if (panel->link->sink_request & DP_TEST_LINK_EDID_READ) {
306 checksum = dp_panel_get_edid_checksum(dp_panel->edid);
308 checksum = dp_panel->connector->real_edid_checksum;
310 dp_link_send_edid_checksum(panel->link, checksum);
311 dp_link_send_test_response(panel->link);
315 void dp_panel_tpg_config(struct dp_panel *dp_panel, bool enable)
317 struct dp_catalog *catalog;
318 struct dp_panel_private *panel;
321 DRM_ERROR("invalid input\n");
325 panel = container_of(dp_panel, struct dp_panel_private, dp_panel);
326 catalog = panel->catalog;
328 if (!panel->panel_on) {
329 drm_dbg_dp(panel->drm_dev,
330 "DP panel not enabled, handle TPG on next on\n");
335 dp_catalog_panel_tpg_disable(catalog);
339 drm_dbg_dp(panel->drm_dev, "calling catalog tpg_enable\n");
340 dp_catalog_panel_tpg_enable(catalog, &panel->dp_panel.dp_mode.drm_mode);
343 void dp_panel_dump_regs(struct dp_panel *dp_panel)
345 struct dp_catalog *catalog;
346 struct dp_panel_private *panel;
348 panel = container_of(dp_panel, struct dp_panel_private, dp_panel);
349 catalog = panel->catalog;
351 dp_catalog_dump_regs(catalog);
354 int dp_panel_timing_cfg(struct dp_panel *dp_panel)
356 u32 data, total_ver, total_hor;
357 struct dp_catalog *catalog;
358 struct dp_panel_private *panel;
359 struct drm_display_mode *drm_mode;
361 panel = container_of(dp_panel, struct dp_panel_private, dp_panel);
362 catalog = panel->catalog;
363 drm_mode = &panel->dp_panel.dp_mode.drm_mode;
365 drm_dbg_dp(panel->drm_dev, "width=%d hporch= %d %d %d\n",
366 drm_mode->hdisplay, drm_mode->htotal - drm_mode->hsync_end,
367 drm_mode->hsync_start - drm_mode->hdisplay,
368 drm_mode->hsync_end - drm_mode->hsync_start);
370 drm_dbg_dp(panel->drm_dev, "height=%d vporch= %d %d %d\n",
371 drm_mode->vdisplay, drm_mode->vtotal - drm_mode->vsync_end,
372 drm_mode->vsync_start - drm_mode->vdisplay,
373 drm_mode->vsync_end - drm_mode->vsync_start);
375 total_hor = drm_mode->htotal;
377 total_ver = drm_mode->vtotal;
383 catalog->total = data;
385 data = (drm_mode->vtotal - drm_mode->vsync_start);
387 data |= (drm_mode->htotal - drm_mode->hsync_start);
389 catalog->sync_start = data;
391 data = drm_mode->vsync_end - drm_mode->vsync_start;
393 data |= (panel->dp_panel.dp_mode.v_active_low << 31);
394 data |= drm_mode->hsync_end - drm_mode->hsync_start;
395 data |= (panel->dp_panel.dp_mode.h_active_low << 15);
397 catalog->width_blanking = data;
399 data = drm_mode->vdisplay;
401 data |= drm_mode->hdisplay;
403 catalog->dp_active = data;
405 dp_catalog_panel_timing_cfg(catalog);
406 panel->panel_on = true;
411 int dp_panel_init_panel_info(struct dp_panel *dp_panel)
413 struct drm_display_mode *drm_mode;
414 struct dp_panel_private *panel;
416 drm_mode = &dp_panel->dp_mode.drm_mode;
418 panel = container_of(dp_panel, struct dp_panel_private, dp_panel);
421 * print resolution info as this is a result
422 * of user initiated action of cable connection
424 drm_dbg_dp(panel->drm_dev, "SET NEW RESOLUTION:\n");
425 drm_dbg_dp(panel->drm_dev, "%dx%d@%dfps\n",
426 drm_mode->hdisplay, drm_mode->vdisplay, drm_mode_vrefresh(drm_mode));
427 drm_dbg_dp(panel->drm_dev,
428 "h_porches(back|front|width) = (%d|%d|%d)\n",
429 drm_mode->htotal - drm_mode->hsync_end,
430 drm_mode->hsync_start - drm_mode->hdisplay,
431 drm_mode->hsync_end - drm_mode->hsync_start);
432 drm_dbg_dp(panel->drm_dev,
433 "v_porches(back|front|width) = (%d|%d|%d)\n",
434 drm_mode->vtotal - drm_mode->vsync_end,
435 drm_mode->vsync_start - drm_mode->vdisplay,
436 drm_mode->vsync_end - drm_mode->vsync_start);
437 drm_dbg_dp(panel->drm_dev, "pixel clock (KHz)=(%d)\n",
439 drm_dbg_dp(panel->drm_dev, "bpp = %d\n", dp_panel->dp_mode.bpp);
441 dp_panel->dp_mode.bpp = max_t(u32, 18,
442 min_t(u32, dp_panel->dp_mode.bpp, 30));
443 drm_dbg_dp(panel->drm_dev, "updated bpp = %d\n",
444 dp_panel->dp_mode.bpp);
449 struct dp_panel *dp_panel_get(struct dp_panel_in *in)
451 struct dp_panel_private *panel;
452 struct dp_panel *dp_panel;
454 if (!in->dev || !in->catalog || !in->aux || !in->link) {
455 DRM_ERROR("invalid input\n");
456 return ERR_PTR(-EINVAL);
459 panel = devm_kzalloc(in->dev, sizeof(*panel), GFP_KERNEL);
461 return ERR_PTR(-ENOMEM);
463 panel->dev = in->dev;
464 panel->aux = in->aux;
465 panel->catalog = in->catalog;
466 panel->link = in->link;
468 dp_panel = &panel->dp_panel;
469 dp_panel->max_bw_code = DP_LINK_BW_8_1;
470 panel->aux_cfg_update_done = false;
475 void dp_panel_put(struct dp_panel *dp_panel)
480 kfree(dp_panel->edid);