463 lines
11 KiB
C
463 lines
11 KiB
C
|
// SPDX-License-Identifier: GPL-2.0-only
|
||
|
|
/*
|
||
|
|
* Copyright (c) 2017-2020, The Linux Foundation. All rights reserved.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#define pr_fmt(fmt)"[drm-dp] %s: " fmt, __func__
|
||
|
|
|
||
|
|
#include <linux/debugfs.h>
|
||
|
|
#include <drm/drm_connector.h>
|
||
|
|
#include <drm/drm_file.h>
|
||
|
|
|
||
|
|
#include "dp_parser.h"
|
||
|
|
#include "dp_catalog.h"
|
||
|
|
#include "dp_aux.h"
|
||
|
|
#include "dp_ctrl.h"
|
||
|
|
#include "dp_debug.h"
|
||
|
|
#include "dp_display.h"
|
||
|
|
|
||
|
|
#define DEBUG_NAME "msm_dp"
|
||
|
|
|
||
|
|
struct dp_debug_private {
|
||
|
|
struct dentry *root;
|
||
|
|
|
||
|
|
struct dp_usbpd *usbpd;
|
||
|
|
struct dp_link *link;
|
||
|
|
struct dp_panel *panel;
|
||
|
|
struct drm_connector **connector;
|
||
|
|
struct device *dev;
|
||
|
|
struct drm_device *drm_dev;
|
||
|
|
|
||
|
|
struct dp_debug dp_debug;
|
||
|
|
};
|
||
|
|
|
||
|
|
static int dp_debug_check_buffer_overflow(int rc, int *max_size, int *len)
|
||
|
|
{
|
||
|
|
if (rc >= *max_size) {
|
||
|
|
DRM_ERROR("buffer overflow\n");
|
||
|
|
return -EINVAL;
|
||
|
|
}
|
||
|
|
*len += rc;
|
||
|
|
*max_size = SZ_4K - *len;
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static ssize_t dp_debug_read_info(struct file *file, char __user *user_buff,
|
||
|
|
size_t count, loff_t *ppos)
|
||
|
|
{
|
||
|
|
struct dp_debug_private *debug = file->private_data;
|
||
|
|
char *buf;
|
||
|
|
u32 len = 0, rc = 0;
|
||
|
|
u64 lclk = 0;
|
||
|
|
u32 max_size = SZ_4K;
|
||
|
|
u32 link_params_rate;
|
||
|
|
struct drm_display_mode *drm_mode;
|
||
|
|
|
||
|
|
if (!debug)
|
||
|
|
return -ENODEV;
|
||
|
|
|
||
|
|
if (*ppos)
|
||
|
|
return 0;
|
||
|
|
|
||
|
|
buf = kzalloc(SZ_4K, GFP_KERNEL);
|
||
|
|
if (!buf)
|
||
|
|
return -ENOMEM;
|
||
|
|
|
||
|
|
drm_mode = &debug->panel->dp_mode.drm_mode;
|
||
|
|
|
||
|
|
rc = snprintf(buf + len, max_size, "\tname = %s\n", DEBUG_NAME);
|
||
|
|
if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
|
||
|
|
goto error;
|
||
|
|
|
||
|
|
rc = snprintf(buf + len, max_size,
|
||
|
|
"\tdp_panel\n\t\tmax_pclk_khz = %d\n",
|
||
|
|
debug->panel->max_pclk_khz);
|
||
|
|
if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
|
||
|
|
goto error;
|
||
|
|
|
||
|
|
rc = snprintf(buf + len, max_size,
|
||
|
|
"\tdrm_dp_link\n\t\trate = %u\n",
|
||
|
|
debug->panel->link_info.rate);
|
||
|
|
if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
|
||
|
|
goto error;
|
||
|
|
|
||
|
|
rc = snprintf(buf + len, max_size,
|
||
|
|
"\t\tnum_lanes = %u\n",
|
||
|
|
debug->panel->link_info.num_lanes);
|
||
|
|
if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
|
||
|
|
goto error;
|
||
|
|
|
||
|
|
rc = snprintf(buf + len, max_size,
|
||
|
|
"\t\tcapabilities = %lu\n",
|
||
|
|
debug->panel->link_info.capabilities);
|
||
|
|
if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
|
||
|
|
goto error;
|
||
|
|
|
||
|
|
rc = snprintf(buf + len, max_size,
|
||
|
|
"\tdp_panel_info:\n\t\tactive = %dx%d\n",
|
||
|
|
drm_mode->hdisplay,
|
||
|
|
drm_mode->vdisplay);
|
||
|
|
if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
|
||
|
|
goto error;
|
||
|
|
|
||
|
|
rc = snprintf(buf + len, max_size,
|
||
|
|
"\t\tback_porch = %dx%d\n",
|
||
|
|
drm_mode->htotal - drm_mode->hsync_end,
|
||
|
|
drm_mode->vtotal - drm_mode->vsync_end);
|
||
|
|
if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
|
||
|
|
goto error;
|
||
|
|
|
||
|
|
rc = snprintf(buf + len, max_size,
|
||
|
|
"\t\tfront_porch = %dx%d\n",
|
||
|
|
drm_mode->hsync_start - drm_mode->hdisplay,
|
||
|
|
drm_mode->vsync_start - drm_mode->vdisplay);
|
||
|
|
if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
|
||
|
|
goto error;
|
||
|
|
|
||
|
|
rc = snprintf(buf + len, max_size,
|
||
|
|
"\t\tsync_width = %dx%d\n",
|
||
|
|
drm_mode->hsync_end - drm_mode->hsync_start,
|
||
|
|
drm_mode->vsync_end - drm_mode->vsync_start);
|
||
|
|
if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
|
||
|
|
goto error;
|
||
|
|
|
||
|
|
rc = snprintf(buf + len, max_size,
|
||
|
|
"\t\tactive_low = %dx%d\n",
|
||
|
|
debug->panel->dp_mode.h_active_low,
|
||
|
|
debug->panel->dp_mode.v_active_low);
|
||
|
|
if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
|
||
|
|
goto error;
|
||
|
|
|
||
|
|
rc = snprintf(buf + len, max_size,
|
||
|
|
"\t\th_skew = %d\n",
|
||
|
|
drm_mode->hskew);
|
||
|
|
if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
|
||
|
|
goto error;
|
||
|
|
|
||
|
|
rc = snprintf(buf + len, max_size,
|
||
|
|
"\t\trefresh rate = %d\n",
|
||
|
|
drm_mode_vrefresh(drm_mode));
|
||
|
|
if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
|
||
|
|
goto error;
|
||
|
|
|
||
|
|
rc = snprintf(buf + len, max_size,
|
||
|
|
"\t\tpixel clock khz = %d\n",
|
||
|
|
drm_mode->clock);
|
||
|
|
if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
|
||
|
|
goto error;
|
||
|
|
|
||
|
|
rc = snprintf(buf + len, max_size,
|
||
|
|
"\t\tbpp = %d\n",
|
||
|
|
debug->panel->dp_mode.bpp);
|
||
|
|
if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
|
||
|
|
goto error;
|
||
|
|
|
||
|
|
/* Link Information */
|
||
|
|
rc = snprintf(buf + len, max_size,
|
||
|
|
"\tdp_link:\n\t\ttest_requested = %d\n",
|
||
|
|
debug->link->sink_request);
|
||
|
|
if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
|
||
|
|
goto error;
|
||
|
|
|
||
|
|
rc = snprintf(buf + len, max_size,
|
||
|
|
"\t\tnum_lanes = %d\n",
|
||
|
|
debug->link->link_params.num_lanes);
|
||
|
|
if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
|
||
|
|
goto error;
|
||
|
|
|
||
|
|
link_params_rate = debug->link->link_params.rate;
|
||
|
|
rc = snprintf(buf + len, max_size,
|
||
|
|
"\t\tbw_code = %d\n",
|
||
|
|
drm_dp_link_rate_to_bw_code(link_params_rate));
|
||
|
|
if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
|
||
|
|
goto error;
|
||
|
|
|
||
|
|
lclk = debug->link->link_params.rate * 1000;
|
||
|
|
rc = snprintf(buf + len, max_size,
|
||
|
|
"\t\tlclk = %lld\n", lclk);
|
||
|
|
if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
|
||
|
|
goto error;
|
||
|
|
|
||
|
|
rc = snprintf(buf + len, max_size,
|
||
|
|
"\t\tv_level = %d\n",
|
||
|
|
debug->link->phy_params.v_level);
|
||
|
|
if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
|
||
|
|
goto error;
|
||
|
|
|
||
|
|
rc = snprintf(buf + len, max_size,
|
||
|
|
"\t\tp_level = %d\n",
|
||
|
|
debug->link->phy_params.p_level);
|
||
|
|
if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
|
||
|
|
goto error;
|
||
|
|
|
||
|
|
if (copy_to_user(user_buff, buf, len))
|
||
|
|
goto error;
|
||
|
|
|
||
|
|
*ppos += len;
|
||
|
|
|
||
|
|
kfree(buf);
|
||
|
|
return len;
|
||
|
|
error:
|
||
|
|
kfree(buf);
|
||
|
|
return -EINVAL;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int dp_test_data_show(struct seq_file *m, void *data)
|
||
|
|
{
|
||
|
|
struct drm_device *dev;
|
||
|
|
struct dp_debug_private *debug;
|
||
|
|
struct drm_connector *connector;
|
||
|
|
struct drm_connector_list_iter conn_iter;
|
||
|
|
u32 bpc;
|
||
|
|
|
||
|
|
debug = m->private;
|
||
|
|
dev = debug->drm_dev;
|
||
|
|
drm_connector_list_iter_begin(dev, &conn_iter);
|
||
|
|
drm_for_each_connector_iter(connector, &conn_iter) {
|
||
|
|
|
||
|
|
if (connector->connector_type !=
|
||
|
|
DRM_MODE_CONNECTOR_DisplayPort)
|
||
|
|
continue;
|
||
|
|
|
||
|
|
if (connector->status == connector_status_connected) {
|
||
|
|
bpc = debug->link->test_video.test_bit_depth;
|
||
|
|
seq_printf(m, "hdisplay: %d\n",
|
||
|
|
debug->link->test_video.test_h_width);
|
||
|
|
seq_printf(m, "vdisplay: %d\n",
|
||
|
|
debug->link->test_video.test_v_height);
|
||
|
|
seq_printf(m, "bpc: %u\n",
|
||
|
|
dp_link_bit_depth_to_bpc(bpc));
|
||
|
|
} else
|
||
|
|
seq_puts(m, "0");
|
||
|
|
}
|
||
|
|
|
||
|
|
drm_connector_list_iter_end(&conn_iter);
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
DEFINE_SHOW_ATTRIBUTE(dp_test_data);
|
||
|
|
|
||
|
|
static int dp_test_type_show(struct seq_file *m, void *data)
|
||
|
|
{
|
||
|
|
struct dp_debug_private *debug = m->private;
|
||
|
|
struct drm_device *dev = debug->drm_dev;
|
||
|
|
struct drm_connector *connector;
|
||
|
|
struct drm_connector_list_iter conn_iter;
|
||
|
|
|
||
|
|
drm_connector_list_iter_begin(dev, &conn_iter);
|
||
|
|
drm_for_each_connector_iter(connector, &conn_iter) {
|
||
|
|
|
||
|
|
if (connector->connector_type !=
|
||
|
|
DRM_MODE_CONNECTOR_DisplayPort)
|
||
|
|
continue;
|
||
|
|
|
||
|
|
if (connector->status == connector_status_connected)
|
||
|
|
seq_printf(m, "%02x", DP_TEST_LINK_VIDEO_PATTERN);
|
||
|
|
else
|
||
|
|
seq_puts(m, "0");
|
||
|
|
}
|
||
|
|
drm_connector_list_iter_end(&conn_iter);
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
DEFINE_SHOW_ATTRIBUTE(dp_test_type);
|
||
|
|
|
||
|
|
static ssize_t dp_test_active_write(struct file *file,
|
||
|
|
const char __user *ubuf,
|
||
|
|
size_t len, loff_t *offp)
|
||
|
|
{
|
||
|
|
char *input_buffer;
|
||
|
|
int status = 0;
|
||
|
|
struct dp_debug_private *debug;
|
||
|
|
struct drm_device *dev;
|
||
|
|
struct drm_connector *connector;
|
||
|
|
struct drm_connector_list_iter conn_iter;
|
||
|
|
int val = 0;
|
||
|
|
|
||
|
|
debug = ((struct seq_file *)file->private_data)->private;
|
||
|
|
dev = debug->drm_dev;
|
||
|
|
|
||
|
|
if (len == 0)
|
||
|
|
return 0;
|
||
|
|
|
||
|
|
input_buffer = memdup_user_nul(ubuf, len);
|
||
|
|
if (IS_ERR(input_buffer))
|
||
|
|
return PTR_ERR(input_buffer);
|
||
|
|
|
||
|
|
DRM_DEBUG_DRIVER("Copied %d bytes from user\n", (unsigned int)len);
|
||
|
|
|
||
|
|
drm_connector_list_iter_begin(dev, &conn_iter);
|
||
|
|
drm_for_each_connector_iter(connector, &conn_iter) {
|
||
|
|
if (connector->connector_type !=
|
||
|
|
DRM_MODE_CONNECTOR_DisplayPort)
|
||
|
|
continue;
|
||
|
|
|
||
|
|
if (connector->status == connector_status_connected) {
|
||
|
|
status = kstrtoint(input_buffer, 10, &val);
|
||
|
|
if (status < 0)
|
||
|
|
break;
|
||
|
|
DRM_DEBUG_DRIVER("Got %d for test active\n", val);
|
||
|
|
/* To prevent erroneous activation of the compliance
|
||
|
|
* testing code, only accept an actual value of 1 here
|
||
|
|
*/
|
||
|
|
if (val == 1)
|
||
|
|
debug->panel->video_test = true;
|
||
|
|
else
|
||
|
|
debug->panel->video_test = false;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
drm_connector_list_iter_end(&conn_iter);
|
||
|
|
kfree(input_buffer);
|
||
|
|
if (status < 0)
|
||
|
|
return status;
|
||
|
|
|
||
|
|
*offp += len;
|
||
|
|
return len;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int dp_test_active_show(struct seq_file *m, void *data)
|
||
|
|
{
|
||
|
|
struct dp_debug_private *debug = m->private;
|
||
|
|
struct drm_device *dev = debug->drm_dev;
|
||
|
|
struct drm_connector *connector;
|
||
|
|
struct drm_connector_list_iter conn_iter;
|
||
|
|
|
||
|
|
drm_connector_list_iter_begin(dev, &conn_iter);
|
||
|
|
drm_for_each_connector_iter(connector, &conn_iter) {
|
||
|
|
if (connector->connector_type !=
|
||
|
|
DRM_MODE_CONNECTOR_DisplayPort)
|
||
|
|
continue;
|
||
|
|
|
||
|
|
if (connector->status == connector_status_connected) {
|
||
|
|
if (debug->panel->video_test)
|
||
|
|
seq_puts(m, "1");
|
||
|
|
else
|
||
|
|
seq_puts(m, "0");
|
||
|
|
} else
|
||
|
|
seq_puts(m, "0");
|
||
|
|
}
|
||
|
|
drm_connector_list_iter_end(&conn_iter);
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int dp_test_active_open(struct inode *inode,
|
||
|
|
struct file *file)
|
||
|
|
{
|
||
|
|
return single_open(file, dp_test_active_show,
|
||
|
|
inode->i_private);
|
||
|
|
}
|
||
|
|
|
||
|
|
static const struct file_operations dp_debug_fops = {
|
||
|
|
.open = simple_open,
|
||
|
|
.read = dp_debug_read_info,
|
||
|
|
};
|
||
|
|
|
||
|
|
static const struct file_operations test_active_fops = {
|
||
|
|
.owner = THIS_MODULE,
|
||
|
|
.open = dp_test_active_open,
|
||
|
|
.read = seq_read,
|
||
|
|
.llseek = seq_lseek,
|
||
|
|
.release = single_release,
|
||
|
|
.write = dp_test_active_write
|
||
|
|
};
|
||
|
|
|
||
|
|
static int dp_debug_init(struct dp_debug *dp_debug, struct drm_minor *minor)
|
||
|
|
{
|
||
|
|
int rc = 0;
|
||
|
|
struct dp_debug_private *debug = container_of(dp_debug,
|
||
|
|
struct dp_debug_private, dp_debug);
|
||
|
|
|
||
|
|
debugfs_create_file("dp_debug", 0444, minor->debugfs_root,
|
||
|
|
debug, &dp_debug_fops);
|
||
|
|
|
||
|
|
debugfs_create_file("msm_dp_test_active", 0444,
|
||
|
|
minor->debugfs_root,
|
||
|
|
debug, &test_active_fops);
|
||
|
|
|
||
|
|
debugfs_create_file("msm_dp_test_data", 0444,
|
||
|
|
minor->debugfs_root,
|
||
|
|
debug, &dp_test_data_fops);
|
||
|
|
|
||
|
|
debugfs_create_file("msm_dp_test_type", 0444,
|
||
|
|
minor->debugfs_root,
|
||
|
|
debug, &dp_test_type_fops);
|
||
|
|
|
||
|
|
debug->root = minor->debugfs_root;
|
||
|
|
|
||
|
|
return rc;
|
||
|
|
}
|
||
|
|
|
||
|
|
struct dp_debug *dp_debug_get(struct device *dev, struct dp_panel *panel,
|
||
|
|
struct dp_usbpd *usbpd, struct dp_link *link,
|
||
|
|
struct drm_connector **connector, struct drm_minor *minor)
|
||
|
|
{
|
||
|
|
int rc = 0;
|
||
|
|
struct dp_debug_private *debug;
|
||
|
|
struct dp_debug *dp_debug;
|
||
|
|
|
||
|
|
if (!dev || !panel || !usbpd || !link) {
|
||
|
|
DRM_ERROR("invalid input\n");
|
||
|
|
rc = -EINVAL;
|
||
|
|
goto error;
|
||
|
|
}
|
||
|
|
|
||
|
|
debug = devm_kzalloc(dev, sizeof(*debug), GFP_KERNEL);
|
||
|
|
if (!debug) {
|
||
|
|
rc = -ENOMEM;
|
||
|
|
goto error;
|
||
|
|
}
|
||
|
|
|
||
|
|
debug->dp_debug.debug_en = false;
|
||
|
|
debug->usbpd = usbpd;
|
||
|
|
debug->link = link;
|
||
|
|
debug->panel = panel;
|
||
|
|
debug->dev = dev;
|
||
|
|
debug->drm_dev = minor->dev;
|
||
|
|
debug->connector = connector;
|
||
|
|
|
||
|
|
dp_debug = &debug->dp_debug;
|
||
|
|
dp_debug->vdisplay = 0;
|
||
|
|
dp_debug->hdisplay = 0;
|
||
|
|
dp_debug->vrefresh = 0;
|
||
|
|
|
||
|
|
rc = dp_debug_init(dp_debug, minor);
|
||
|
|
if (rc) {
|
||
|
|
devm_kfree(dev, debug);
|
||
|
|
goto error;
|
||
|
|
}
|
||
|
|
|
||
|
|
return dp_debug;
|
||
|
|
error:
|
||
|
|
return ERR_PTR(rc);
|
||
|
|
}
|
||
|
|
|
||
|
|
static int dp_debug_deinit(struct dp_debug *dp_debug)
|
||
|
|
{
|
||
|
|
struct dp_debug_private *debug;
|
||
|
|
|
||
|
|
if (!dp_debug)
|
||
|
|
return -EINVAL;
|
||
|
|
|
||
|
|
debug = container_of(dp_debug, struct dp_debug_private, dp_debug);
|
||
|
|
|
||
|
|
debugfs_remove_recursive(debug->root);
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
void dp_debug_put(struct dp_debug *dp_debug)
|
||
|
|
{
|
||
|
|
struct dp_debug_private *debug;
|
||
|
|
|
||
|
|
if (!dp_debug)
|
||
|
|
return;
|
||
|
|
|
||
|
|
debug = container_of(dp_debug, struct dp_debug_private, dp_debug);
|
||
|
|
|
||
|
|
dp_debug_deinit(dp_debug);
|
||
|
|
|
||
|
|
devm_kfree(debug->dev, debug);
|
||
|
|
}
|