kernel_xiaomi_lancelot/drivers/gpu/drm/mediatek/mtk_dp_debug.c

/*
 * Copyright (c) 2020 MediaTek Inc.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 */

#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 + 9, "32fs", 4) == 0)
			mtk_dp_force_audio(0xff, 0, 0xff);
		else if (strncmp(opt + 9, "44fs", 4) == 0)
			mtk_dp_force_audio(0xff, 1, 0xff);
		else if (strncmp(opt + 9, "48fs", 4) == 0)
			mtk_dp_force_audio(0xff, 2, 0xff);
		else if (strncmp(opt + 9, "96fs", 4) == 0)
			mtk_dp_force_audio(0xff, 3, 0xff);
		else if (strncmp(opt + 9, "192f", 4) == 0)
			mtk_dp_force_audio(0xff, 4, 0xff);

		if (strncmp(opt + 13, "16bit", 5) == 0)
			mtk_dp_force_audio(0xff, 0xff, 0);
		else if (strncmp(opt + 13, "20bit", 5) == 0)
			mtk_dp_force_audio(0xff, 0xff, 1);
		else if (strncmp(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", 0644, 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

}