6db4831e98
Android 14
316 lines
8.1 KiB
C
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
|
|
|
|
}
|
|
|
|
|