drivers/misc/mediatek/hdmi/debug.c

// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright (c) 2020 MediaTek Inc.
 */

#if IS_ENABLED(CONFIG_MTK_HDMI_SUPPORT)
#include <linux/string.h>
#include <linux/time.h>
#include <linux/uaccess.h>

#include <linux/debugfs.h>

#include <mach/mt_typedefs.h>

#if IS_ENABLED(CONFIG_MTK_INTERNAL_HDMI_SUPPORT)
#include "internal_hdmi_drv.h"
#elif IS_ENABLED(CONFIG_MTK_INTERNAL_MHL_SUPPORT)
#include "inter_mhl_drv.h"
#else
#include "hdmi_drv.h"
#endif
#include "linux/hdmitx.h"

/*
 *void DBG_Init(void);
 *void DBG_Deinit(void);

 *extern void hdmi_log_enable(int enable);
 *extern void hdmi_cable_fake_plug_in(void);
 *extern void hdmi_cable_fake_plug_out(void);
 */

/* ------------------------------------ */
/* External variable declarations */
/* ------------------------------------ */

/* extern LCM_DRIVER *lcm_drv; */
/* ------------------------------------ */
/* Debug Options */
/* ------------------------------------ */


static char STR_HELP[] =
	"\n"
	"USAGE\n"
	"        echo [ACTION]... > hdmi\n"
	"\n"
	"ACTION\n"
	"        hdmitx:[on|off]\n"
	"             enable hdmi video output\n"
	"\n";

/* extern void hdmi_log_enable(int enable); */
/* TODO: this is a temp debug solution */
/* extern void hdmi_cable_fake_plug_in(void); */
/* extern int hdmi_drv_init(void); */
static void process_dbg_opt(const char *opt)
{
	if (0)
		;/* to do*/

#if IS_ENABLED(CONFIG_MTK_HDMI_SUPPORT)
	else if (strncmp(opt, "on", 2) == 0) {
		hdmi_power_on();
	} else if (strncmp(opt, "off", 3) == 0) {
		hdmi_power_off();
	} else if (strncmp(opt, "suspend", 7) == 0) {
		hdmi_suspend();
	} else if (strncmp(opt, "resume", 6) == 0) {
		hdmi_resume();
	/* } else if (0 == strncmp(opt, "colorbar", 8)) { */

	/*} else if (0 == strncmp(opt, "ldooff", 6)) { */

	} else if (strncmp(opt, "loglv:", 6) == 0) {
		unsigned int lv = *(opt + 6) - '0';

		if (lv >= 0 && lv <= 9)
			hdmi_log_level(lv);
	} else if (strncmp(opt, "log:", 4) == 0) {
		if (strncmp(opt + 4, "on", 2) == 0)
			hdmi_log_enable(true);
		else if (strncmp(opt + 4, "off", 3) == 0)
			hdmi_log_enable(false);
		else
			goto Error;
	} else if (strncmp(opt, "fakecablein:", 12) == 0) {
		if (strncmp(opt + 12, "enable", 6) == 0)
			hdmi_cable_fake_plug_in();
		else if (strncmp(opt + 12, "disable", 7) == 0)
			hdmi_cable_fake_plug_out();
		else
			goto Error;
	}
#endif
	else
		goto Error;

	return;

 Error:
	pr_debug("[hdmitx] parse command error!\n\n%s", STR_HELP);
}

static void process_dbg_cmd(char *cmd)
{
	char *tok;

	pr_info("[hdmitx] %s\n", cmd);

	while ((tok = strsep(&cmd, " ")) != NULL)
		process_dbg_opt(tok);

}

/* ------------------------------ */
/* Debug FileSystem Routines */
/* ------------------------------ */

struct dentry *hdmitx_dbgfs;


static ssize_t debug_open(struct inode *inode, struct file *file)
{
	file->private_data = inode->i_private;
	return 0;
}


static char debug_buffer[2048];

static ssize_t debug_read(struct file *file, char __user *ubuf,
	size_t count, loff_t *ppos)
{
	const int debug_bufmax = sizeof(debug_buffer) - 1;
	int n = 0;

	n += scnprintf(debug_buffer + n, debug_bufmax - n, STR_HELP);
	debug_buffer[n++] = 0;

	return simple_read_from_buffer(ubuf, count, ppos, debug_buffer, n);
}


static ssize_t debug_write(struct file *file, const char __user *ubuf,
	size_t count, loff_t *ppos)
{
	const int debug_bufmax = sizeof(debug_buffer) - 1;
	size_t ret;

	ret = count;

	if (count > debug_bufmax)
		count = debug_bufmax;

	if (copy_from_user(&debug_buffer, ubuf, count))
		return -EFAULT;

	debug_buffer[count] = 0;

	process_dbg_cmd(debug_buffer);

	return ret;
}


static const struct file_operations debug_fops = {
	.read = debug_read,
	.write = debug_write,
	.open = debug_open,
};


void HDMI_DBG_Init(void)
{
	hdmitx_dbgfs = debugfs_create_file("hdmi",
		S_IFREG | 0444, NULL, (void *)0, &debug_fops);
}


void HDMI_DBG_Deinit(void)
{
	debugfs_remove(hdmitx_dbgfs);
}
#endif