From 9077ac86036f1b614dd9d1951479bddc1796180f Mon Sep 17 00:00:00 2001
From: Zheng Yang <zhengyang@rock-chips.com>
Date: Tue, 30 Jun 2015 11:19:31 +0800
Subject: [PATCH] HDMI:rk3368/rk3288: add debugfs node regs_phy to modify phy
regs.
and rename debugfs node hdmi to regs_ctrl.
Signed-off-by: Zheng Yang <zhengyang@rock-chips.com>
---
.../hdmi/rockchip-hdmiv2/rockchip_hdmiv2.c | 78 +++++++++++++------
.../hdmi/rockchip-hdmiv2/rockchip_hdmiv2_hw.c | 10 +--
.../hdmi/rockchip-hdmiv2/rockchip_hdmiv2_hw.h | 4 +
3 files changed, 64 insertions(+), 28 deletions(-)
diff --git a/drivers/video/rockchip/hdmi/rockchip-hdmiv2/rockchip_hdmiv2.c b/drivers/video/rockchip/hdmi/rockchip-hdmiv2/rockchip_hdmiv2.c
index 93da9cf0b18b..9eab961642d4 100644
--- a/drivers/video/rockchip/hdmi/rockchip-hdmiv2/rockchip_hdmiv2.c
+++ b/drivers/video/rockchip/hdmi/rockchip-hdmiv2/rockchip_hdmiv2.c
@@ -48,10 +48,9 @@ static const struct rockchip_hdmiv2_reg_table hdmi_reg_table[] = {
{I2C_MASTER_BASE, I2CM_SCDC_UPDATE1},
};
-static int rockchip_hdmiv2_reg_show(struct seq_file *s, void *v)
+static int hdmi_regs_ctrl_show(struct seq_file *s, void *v)
{
- int i = 0, j = 0;
- u32 val = 0;
+ u32 i = 0, j = 0, val = 0;
seq_puts(s, "\n>>>hdmi_ctl reg ");
for (i = 0; i < 16; i++)
@@ -69,16 +68,14 @@ static int rockchip_hdmiv2_reg_show(struct seq_file *s, void *v)
}
seq_puts(s, "\n-----------------------------------------------------------------\n");
- /*rockchip_hdmiv2_dump_phy_regs(hdmi_dev);*/
return 0;
}
-static ssize_t rockchip_hdmiv2_reg_write(struct file *file,
- const char __user *buf,
- size_t count, loff_t *ppos)
+static ssize_t hdmi_regs_ctrl_write(struct file *file,
+ const char __user *buf,
+ size_t count, loff_t *ppos)
{
- u32 reg;
- u32 val;
+ u32 reg, val;
char kbuf[25];
if (copy_from_user(kbuf, buf, count))
@@ -97,21 +94,52 @@ static ssize_t rockchip_hdmiv2_reg_write(struct file *file,
return count;
}
-static int rockchip_hdmiv2_reg_open(struct inode *inode, struct file *file)
+static int hdmi_regs_phy_show(struct seq_file *s, void *v)
{
- struct hdmi_dev *hdmi_dev = inode->i_private;
+ u32 i;
- return single_open(file, rockchip_hdmiv2_reg_show, hdmi_dev);
+ seq_puts(s, "\n>>>hdmi_phy reg ");
+ for (i = 0; i < 0x28; i++)
+ seq_printf(s, "regs %02x val %04x\n",
+ i, rockchip_hdmiv2_read_phy(hdmi_dev, i));
+ return 0;
}
-static const struct file_operations rockchip_hdmiv2_reg_fops = {
- .owner = THIS_MODULE,
- .open = rockchip_hdmiv2_reg_open,
- .read = seq_read,
- .write = rockchip_hdmiv2_reg_write,
- .llseek = seq_lseek,
- .release = single_release,
-};
+static ssize_t hdmi_regs_phy_write(struct file *file,
+ const char __user *buf,
+ size_t count, loff_t *ppos)
+{
+ u32 reg, val;
+ char kbuf[25];
+
+ if (copy_from_user(kbuf, buf, count))
+ return -EFAULT;
+ if (sscanf(kbuf, "%x%x", ®, &val) == -1)
+ return -EFAULT;
+ dev_info(hdmi_dev->hdmi->dev,
+ "/**********hdmi reg phy config******/");
+ dev_info(hdmi_dev->hdmi->dev, "\n reg=%x val=%x\n", reg, val);
+ rockchip_hdmiv2_write_phy(hdmi_dev, reg, val);
+ return count;
+}
+
+#define HDMI_DEBUG_ENTRY(name) \
+static int hdmi_##name##_open(struct inode *inode, struct file *file) \
+{ \
+ return single_open(file, hdmi_##name##_show, inode->i_private); \
+} \
+\
+static const struct file_operations hdmi_##name##_fops = { \
+ .owner = THIS_MODULE, \
+ .open = hdmi_##name##_open, \
+ .read = seq_read, \
+ .write = hdmi_##name##_write, \
+ .llseek = seq_lseek, \
+ .release = single_release, \
+}
+
+HDMI_DEBUG_ENTRY(regs_phy);
+HDMI_DEBUG_ENTRY(regs_ctrl);
#endif
#ifdef CONFIG_HAS_EARLYSUSPEND
@@ -470,10 +498,14 @@ static int rockchip_hdmiv2_probe(struct platform_device *pdev)
if (IS_ERR(hdmi_dev->debugfs_dir))
dev_err(hdmi_dev->hdmi->dev,
"failed to create debugfs dir for rockchip hdmiv2!\n");
- else
- debugfs_create_file("hdmi", S_IRUSR,
+ else {
+ debugfs_create_file("regs_ctrl", S_IRUSR,
hdmi_dev->debugfs_dir,
- hdmi_dev, &rockchip_hdmiv2_reg_fops);
+ hdmi_dev, &hdmi_regs_ctrl_fops);
+ debugfs_create_file("regs_phy", S_IRUSR,
+ hdmi_dev->debugfs_dir,
+ hdmi_dev, &hdmi_regs_phy_fops);
+ }
#endif
rk_display_device_enable(hdmi_dev->hdmi->ddev);
diff --git a/drivers/video/rockchip/hdmi/rockchip-hdmiv2/rockchip_hdmiv2_hw.c b/drivers/video/rockchip/hdmi/rockchip-hdmiv2/rockchip_hdmiv2_hw.c
index 2cf7b8be22a0..98c088de2e22 100755
--- a/drivers/video/rockchip/hdmi/rockchip-hdmiv2/rockchip_hdmiv2_hw.c
+++ b/drivers/video/rockchip/hdmi/rockchip-hdmiv2/rockchip_hdmiv2_hw.c
@@ -324,8 +324,8 @@ static void rockchip_hdmiv2_powerdown(struct hdmi_dev *hdmi_dev)
hdmi_writel(hdmi_dev, MC_CLKDIS, 0x7f);
}
-static int rockchip_hdmiv2_write_phy(struct hdmi_dev *hdmi_dev,
- int reg_addr, int val)
+int rockchip_hdmiv2_write_phy(struct hdmi_dev *hdmi_dev,
+ int reg_addr, int val)
{
int trytime = 2, i = 0, op_status = 0;
@@ -360,8 +360,8 @@ static int rockchip_hdmiv2_write_phy(struct hdmi_dev *hdmi_dev,
return -1;
}
-static int __maybe_unused rockchip_hdmiv2_read_phy(struct hdmi_dev *hdmi_dev,
- int reg_addr)
+int rockchip_hdmiv2_read_phy(struct hdmi_dev *hdmi_dev,
+ int reg_addr)
{
int trytime = 2, i = 0, op_status = 0;
int val = 0;
@@ -472,7 +472,7 @@ static int rockchip_hdmiv2_config_phy(struct hdmi_dev *hdmi_dev)
phy_mpll->gmp_cntrl));
}
rockchip_hdmiv2_write_phy(hdmi_dev, PHYTX_TERM_RESIS,
- v_TX_TERM(R50_OHMS));
+ v_TX_TERM(R50_OHMS));
rockchip_hdmiv2_write_phy(hdmi_dev, PHYTX_CLKSYMCTRL,
v_OVERRIDE(1) | v_SLOPEBOOST(0) |
v_TX_SYMON(1) | v_TX_TRAON(0) |
diff --git a/drivers/video/rockchip/hdmi/rockchip-hdmiv2/rockchip_hdmiv2_hw.h b/drivers/video/rockchip/hdmi/rockchip-hdmiv2/rockchip_hdmiv2_hw.h
index 97dcff5d0ce2..6df698da8f1f 100644
--- a/drivers/video/rockchip/hdmi/rockchip-hdmiv2/rockchip_hdmiv2_hw.h
+++ b/drivers/video/rockchip/hdmi/rockchip-hdmiv2/rockchip_hdmiv2_hw.h
@@ -1568,4 +1568,8 @@ void rockchip_hdmiv2_dump_phy_regs(struct hdmi_dev *hdmi_dev);
void rockchip_hdmiv2_hdcp_init(struct hdmi *hdmi);
void rockchip_hdmiv2_hdcp2_enable(int enable);
void rockchip_hdmiv2_hdcp_isr(struct hdmi_dev *hdmi_dev, int hdcp_int);
+int rockchip_hdmiv2_write_phy(struct hdmi_dev *hdmi_dev,
+ int reg_addr, int val);
+int rockchip_hdmiv2_read_phy(struct hdmi_dev *hdmi_dev,
+ int reg_addr);
#endif
--
2.34.1