kernel_samsung_a34x-permissive/drivers/gpu/drm/mediatek/mtk_dp_debug.c
2024-04-28 15:51:13 +02:00

316 lines
8.1 KiB
C

/* SPDX-License-Identifier: GPL-2.0 */
/*
* Copyright (c) 2019 MediaTek Inc.
*/
#include "mtk_dp_debug.h"
#include "mtk_dp.h"
#include "mtk_dp_api.h"
#if IS_ENABLED(CONFIG_DEBUG_FS)
#include <linux/debugfs.h>
#endif
#if IS_ENABLED(CONFIG_PROC_FS)
#include <linux/proc_fs.h>
#endif
static bool g_dptx_log;
void mtk_dp_debug_enable(bool enable)
{
g_dptx_log = enable;
}
bool mtk_dp_debug_get(void)
{
return g_dptx_log;
}
void mtk_dp_debug(const char *opt)
{
DPTXFUNC("[debug]: %s\n", opt);
if (strncmp(opt, "fakecablein:", 12) == 0) {
if (strncmp(opt + 12, "enable", 6) == 0) {
if (strncmp(opt + 12, "enable4k30P6", 12) == 0)
mtk_dp_fake_plugin(SINK_3840_2160_30, 0);
else if (strncmp(opt + 12, "enable4k30p8", 12) == 0)
mtk_dp_fake_plugin(SINK_3840_2160_30, 1);
else if (strncmp(opt + 12, "enable4k30p10", 13) == 0)
mtk_dp_fake_plugin(SINK_3840_2160_30, 2);
else if (strncmp(opt + 12, "enable4k60p6", 12) == 0)
mtk_dp_fake_plugin(SINK_3840_2160, 0);
else if (strncmp(opt + 12, "enable4k60p8", 12) == 0)
mtk_dp_fake_plugin(SINK_3840_2160, 1);
else if (strncmp(opt + 12, "enable4k60p10", 13) == 0)
mtk_dp_fake_plugin(SINK_3840_2160, 2);
else if (strncmp(opt + 12, "enable720p6", 11) == 0)
mtk_dp_fake_plugin(SINK_1280_720, 0);
else if (strncmp(opt + 12, "enable720p8", 11) == 0)
mtk_dp_fake_plugin(SINK_1280_720, 1);
else if (strncmp(opt + 12, "enable720p10", 12) == 0)
mtk_dp_fake_plugin(SINK_1280_720, 2);
else if (strncmp(opt + 12, "enable480p6", 11) == 0)
mtk_dp_fake_plugin(SINK_640_480, 0);
else if (strncmp(opt + 12, "enable480p8", 11) == 0)
mtk_dp_fake_plugin(SINK_640_480, 1);
else if (strncmp(opt + 12, "enable480p10", 12) == 0)
mtk_dp_fake_plugin(SINK_640_480, 2);
else if (strncmp(opt + 12, "enable1080p6", 12) == 0)
mtk_dp_fake_plugin(SINK_1920_1080, 0);
else if (strncmp(opt + 12, "enable1080p8", 12) == 0)
mtk_dp_fake_plugin(SINK_1920_1080, 1);
else if (strncmp(opt + 12, "enable1080p10", 13) == 0)
mtk_dp_fake_plugin(SINK_1920_1080, 2);
} else
DDPINFO("fakecablein error msg\n");
} else if (strncmp(opt, "fec:", 4) == 0) {
if (strncmp(opt + 4, "enable", 6) == 0)
mtk_dp_fec_enable(1);
else if (strncmp(opt + 4, "disable", 7) == 0)
mtk_dp_fec_enable(0);
else
DDPINFO("fec:enable/disable error msg\n");
} else if (strncmp(opt, "power:", 6) == 0) {
if (strncmp(opt + 6, "on", 2) == 0)
mtk_dp_power_save(0x1);
else if (strncmp(opt + 6, "off", 3) == 0)
mtk_dp_power_save(0x0);
} else if (strncmp(opt, "audio:", 6) == 0) {
if (strncmp(opt + 6, "2ch", 3) == 0)
mtk_dp_force_audio(0, 0xff, 0xff);
else if (strncmp(opt + 6, "8ch", 3) == 0)
mtk_dp_force_audio(6, 0xff, 0xff);
if (strncmp(opt + min_t(int, strlen(opt), 9), "32fs", 4) == 0)
mtk_dp_force_audio(0xff, 0, 0xff);
else if (strncmp(opt + min_t(int, strlen(opt), 9), "44fs", 4) == 0)
mtk_dp_force_audio(0xff, 1, 0xff);
else if (strncmp(opt + min_t(int, strlen(opt), 9), "48fs", 4) == 0)
mtk_dp_force_audio(0xff, 2, 0xff);
else if (strncmp(opt + min_t(int, strlen(opt), 9), "96fs", 4) == 0)
mtk_dp_force_audio(0xff, 3, 0xff);
else if (strncmp(opt + min_t(int, strlen(opt), 9), "192f", 4) == 0)
mtk_dp_force_audio(0xff, 4, 0xff);
if (strncmp(opt + min_t(int, strlen(opt), 13), "16bit", 5) == 0)
mtk_dp_force_audio(0xff, 0xff, 0);
else if (strncmp(opt + min_t(int, strlen(opt), 13), "20bit", 5) == 0)
mtk_dp_force_audio(0xff, 0xff, 1);
else if (strncmp(opt + min_t(int, strlen(opt), 13), "24bit", 5) == 0)
mtk_dp_force_audio(0xff, 0xff, 2);
} else if (strncmp(opt, "dptest:", 7) == 0) {
if (strncmp(opt + 7, "2", 1) == 0)
mtk_dp_test(2);
else if (strncmp(opt + 7, "4", 1) == 0)
mtk_dp_test(4);
else if (strncmp(opt + 7, "8", 1) == 0)
mtk_dp_test(8);
else
DDPINFO("dptest error msg\n");
} else if (strncmp(opt, "debug_log:", 10) == 0) {
if (strncmp(opt + 10, "on", 2) == 0)
mtk_dp_debug_enable(true);
else if (strncmp(opt + 10, "off", 3) == 0)
mtk_dp_debug_enable(false);
} else if (strncmp(opt, "force_hdcp13:", 13) == 0) {
if (strncmp(opt + 13, "enable", 6) == 0)
mtk_dp_force_hdcp1x(true);
else
mtk_dp_force_hdcp1x(false);
} else if (strncmp(opt, "hdcp:", 5) == 0) {
if (strncmp(opt + 5, "enable", 6) == 0)
mtk_dp_hdcp_enable(true);
else if (strncmp(opt + 5, "disable", 7) == 0)
mtk_dp_hdcp_enable(false);
} else if (strncmp(opt, "adjust_phy:", 11) == 0) {
int ret = 0;
uint8_t index, c0, cp1;
ret = sscanf(opt, "adjust_phy:%d,%d,%d\n", &index, &c0, &cp1);
if (ret != 3) {
DPTXERR("ret = %s\n", ret);
return;
}
mtk_dp_set_adjust_phy(index, c0, cp1);
} else if (strncmp(opt, "setpowermode", 12) == 0) {
mtk_dp_SWInterruptSet(2);
mdelay(100);
mtk_dp_SWInterruptSet(4);
} else if (strncmp(opt, "pattern:", 8) == 0) {
int ret = 0;
uint8_t enable, resolution;
ret = sscanf(opt, "pattern:%d,%d\n", &enable, &resolution);
if (ret != 2) {
DPTXMSG("ret = %s\n", ret);
return;
}
DPTXMSG("Paterrn Gen:enable = %d, resolution =%d\n",
enable, resolution);
mdrv_DPTx_PatternSet(enable, resolution);
} else if (strncmp(opt, "maxlinkrate:", 12) == 0) {
int ret = 0;
uint8_t enable, maxlinkrate;
ret = sscanf(opt, "maxlinkrate:%d,%d\n", &enable, &maxlinkrate);
if (ret != 2) {
DPTXMSG("ret = %s\n", ret);
return;
}
DPTXMSG("set max link rate:enable = %d, maxlinkrate =%d\n",
enable, maxlinkrate);
mdrv_DPTx_set_maxlinkrate(enable, maxlinkrate);
}
}
#if IS_ENABLED(CONFIG_DEBUG_FS)
static struct dentry *mtkdp_dbgfs;
#endif
#if IS_ENABLED(CONFIG_PROC_FS)
static struct proc_dir_entry *mtkdp_procfs;
#endif
struct mtk_dp_debug_info {
char *name;
uint8_t index;
};
enum mtk_dp_debug_index {
DP_INFO_HDCP = 0,
DP_INFO_PHY = 1,
DP_INFO_MAX
};
static struct mtk_dp_debug_info dp_info[DP_INFO_MAX] = {
{"HDCP", DP_INFO_HDCP},
{"PHY", DP_INFO_PHY},
};
static uint8_t g_infoIndex = DP_INFO_HDCP;
static int mtk_dp_debug_open(struct inode *inode, struct file *file)
{
file->private_data = inode->i_private;
return 0;
}
static ssize_t mtk_dp_debug_read(struct file *file, char __user *ubuf,
size_t count, loff_t *ppos)
{
int ret = 0;
char *buffer;
buffer = kmalloc(PAGE_SIZE/8, GFP_KERNEL);
if (!buffer)
return -ENOMEM;
switch (g_infoIndex) {
case DP_INFO_HDCP:
ret = mtk_dp_hdcp_getInfo(buffer, PAGE_SIZE/8);
break;
case DP_INFO_PHY:
ret = mtk_dp_phy_getInfo(buffer, PAGE_SIZE/8);
break;
default:
DPTXERR("Invalid inedx!");
}
if (ret > 0)
ret = simple_read_from_buffer(ubuf, count, ppos, buffer, ret);
kfree(buffer);
return ret;
}
static void mtk_dp_process_dbg_opt(const char *opt)
{
int i = 0;
for (i = 0; i < DP_INFO_MAX; i++) {
if (!strncmp(opt, dp_info[i].name, strlen(dp_info[i].name))) {
g_infoIndex = dp_info[i].index;
break;
}
}
if (g_infoIndex == DP_INFO_MAX)
g_infoIndex = DP_INFO_HDCP;
}
static ssize_t mtk_dp_debug_write(struct file *file, const char __user *ubuf,
size_t count, loff_t *ppos)
{
const int debug_bufmax = 512 - 1;
size_t ret;
char cmd_buffer[512];
char *tok;
char *cmd = cmd_buffer;
ret = count;
if (count > debug_bufmax)
count = debug_bufmax;
if (copy_from_user(&cmd_buffer, ubuf, count) != 0ULL)
return -EFAULT;
cmd_buffer[count] = '\0';
DPTXMSG("[mtkdp_dbg]%s!\n", cmd_buffer);
while ((tok = strsep(&cmd, " ")) != NULL)
mtk_dp_process_dbg_opt(tok);
return ret;
}
static const struct file_operations dp_debug_fops = {
.read = mtk_dp_debug_read,
.write = mtk_dp_debug_write,
.open = mtk_dp_debug_open,
};
int mtk_dp_debugfs_init(void)
{
#if IS_ENABLED(CONFIG_DEBUG_FS)
mtkdp_dbgfs = debugfs_create_file("mtk_dpinfo", 0644,
NULL, NULL, &dp_debug_fops);
if (IS_ERR_OR_NULL(mtkdp_dbgfs))
return -ENOMEM;
#endif
#if IS_ENABLED(CONFIG_PROC_FS)
mtkdp_procfs = proc_create("mtk_dpinfo", 0640, NULL,
&dp_debug_fops);
if (IS_ERR_OR_NULL(mtkdp_procfs))
return -ENOMEM;
#endif
return 0;
}
void mtk_dp_debugfs_deinit(void)
{
#if IS_ENABLED(CONFIG_DEBUG_FS)
debugfs_remove(mtkdp_dbgfs);
mtkdp_dbgfs = NULL;
#endif
#if IS_ENABLED(CONFIG_PROC_FS)
if (mtkdp_procfs) {
proc_remove(mtkdp_procfs);
mtkdp_procfs = NULL;
}
#endif
}