hdmirx: add phy eq debug function [1/1]

PD#SWPL-12881

Problem:
Need to add eq debug function

Solution:
Add phy eq debug function,use auto-eq as default.

Verify:
TL1

Change-Id: I723d74d1bad226267b60ffb66d3670d01e6a4e1b
Signed-off-by: yicheng shen <yicheng.shen@amlogic.com>

diff --git a/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_drv.h b/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_drv.h
index 148e4d8..e29649f 100644 (file)
--- a/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_drv.h
+++ b/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_drv.h
@@ -41,7 +41,7 @@
  *
  *
  */
-#define RX_VER1 "ver.2019/09/05"
+#define RX_VER1 "ver.2019/10/21"
 /*
  *
  *

diff --git a/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_hw.c b/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_hw.c
index cb31828..04aa5d0 100644 (file)
--- a/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_hw.c
+++ b/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_hw.c
@@ -105,6 +105,7 @@ int clock_lock_th = 2;
 int scdc_force_en = 1;
 /* for hdcp_hpd debug, disable by default */
 bool hdcp_hpd_ctrl_en;
+int eq_dbg_lvl;
 
 /*------------------------variable define end------------------------------*/
 
@@ -3549,6 +3550,43 @@ static const uint32_t phy_dchd_2[][3] = {
        },
 };
 
+static const u32 eq_debug[] = {
+       /* value     eq gain */
+       0xffffffff,
+       0xffff1030,/* min */
+       0x7fff1030,
+       0x7f7f1030,
+       0x3f7f1030,
+       0x3f3f1030,
+       0x1f3f1030,
+       0x1f1f1030,
+       0x0f0f1030,/* half of all range max */
+       0x0f071030,
+       0x07071030,
+       0x07031030,
+       0x03031030,
+       0x03011030,
+       0x01011030,
+       0x01001030,
+       0x00001030,/* max */
+       0xffff0000,/* min */
+       0x7fff0000,
+       0x7f7f0000,
+       0x3f7f0000,
+       0x3f3f0000,
+       0x1f3f0000,
+       0x1f1f0000,
+       0x0f0f0000,/* half of all range max */
+       0x0f070000,
+       0x07070000,
+       0x07030000,
+       0x03030000,
+       0x03010000,
+       0x01010000,
+       0x01000000,
+       0x00000000,/* max */
+};
+
 void aml_phy_switch_port(void)
 {
           uint32_t data32;
@@ -3640,10 +3678,14 @@ void aml_phy_init_1(void)
 void aml_phy_init(void)
 {
        uint32_t idx = rx.phy.phy_bw;
-       uint32_t data32;
+       u32 data32, c1, c2, r1, r2;
        uint32_t term_value =
                hdmirx_rd_top(TOP_HPD_PWR5V) & 0x7;
 
+       c1 = eq_debug[eq_dbg_lvl] & 0xff;
+       c2 = (eq_debug[eq_dbg_lvl] >> 8) & 0xff;
+       r1 = (eq_debug[eq_dbg_lvl] >> 16) & 0xff;
+       r2 = (eq_debug[eq_dbg_lvl] >> 24) & 0xff;
        data32 = phy_misci[idx][0];
        data32 = (data32 & (~0x7));
        data32 |= term_value;
@@ -3685,14 +3727,27 @@ void aml_phy_init(void)
                wr_reg_hhi(HHI_HDMIRX_PHY_DCHA_CNTL2,
                        phy_dcha_reva[idx][2]);
        } else {
-               wr_reg_hhi(HHI_HDMIRX_PHY_DCHA_CNTL0,
-                       phy_dcha[idx][0]);
+               if (eq_dbg_lvl == 0) {
+                       wr_reg_hhi(HHI_HDMIRX_PHY_DCHA_CNTL0,
+                                  phy_dcha[idx][0]);
 
-               wr_reg_hhi(HHI_HDMIRX_PHY_DCHA_CNTL1,
-                       phy_dcha[idx][1]);
+                       wr_reg_hhi(HHI_HDMIRX_PHY_DCHA_CNTL1,
+                                  phy_dcha[idx][1]);
 
-               wr_reg_hhi(HHI_HDMIRX_PHY_DCHA_CNTL2,
-                       phy_dcha[idx][2]);
+                       wr_reg_hhi(HHI_HDMIRX_PHY_DCHA_CNTL2,
+                                  phy_dcha[idx][2]);
+               } else {
+                       wr_reg_hhi(HHI_HDMIRX_PHY_DCHA_CNTL0,
+                                  (phy_dcha[idx][0] | (c1 << 10)
+                               | (c2 << 18) | (r1 << 26)));
+
+                       wr_reg_hhi(HHI_HDMIRX_PHY_DCHA_CNTL1,
+                                  (phy_dcha[idx][1] | (r1 >> 6))
+                               | (r2 << 2));
+
+                       wr_reg_hhi(HHI_HDMIRX_PHY_DCHA_CNTL2,
+                                  (phy_dcha[idx][2] & (~(1 << 24))));
+               }
        }
 
        if (cdr_lock_level == 0)

diff --git a/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_hw.h b/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_hw.h
index f3c6359..737d4bf 100644 (file)
--- a/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_hw.h
+++ b/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_hw.h
@@ -1119,6 +1119,8 @@ extern int hbr_force_8ch;
 extern int clock_lock_th;
 extern int scdc_force_en;
 extern bool hdcp_hpd_ctrl_en;
+extern int eq_dbg_lvl;
+
 extern void rx_get_best_eq_setting(void);
 extern void wr_reg_hhi(unsigned int offset, unsigned int val);
 extern void wr_reg_hhi_bits(unsigned int offset, unsigned int mask,
@@ -1223,10 +1225,10 @@ extern void rx_force_rxsense_cfg(uint8_t level);
 extern void rx_force_hpd_rxsense_cfg(uint8_t level);
 void rx_audio_bandgap_rst(void);
 void rx_audio_bandgap_en(void);
+void rx_aml_eq_debug(int eq_lvl);
 extern void rx_phy_rxsense_pulse(unsigned int t1, unsigned int t2, bool en);
 extern void rx_phy_power_on(unsigned int onoff);
 
-
 enum measure_clk_top_e {
        TOP_HDMI_TMDSCLK = 0,
        TOP_HDMI_CABLECLK,

diff --git a/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_wrapper.c b/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_wrapper.c
index 9dc04ac..8163e57 100644 (file)
--- a/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_wrapper.c
+++ b/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_wrapper.c
@@ -1736,6 +1736,8 @@ int rx_set_global_variable(const char *buf, int size)
                return pr_var(scdc_force_en, index);
        if (set_pr_var(tmpbuf, hdcp_hpd_ctrl_en, value, &index, ret))
                return pr_var(hdcp_hpd_ctrl_en, index);
+       if (set_pr_var(tmpbuf, eq_dbg_lvl, value, &index, ret))
+               return pr_var(eq_dbg_lvl, index);
        return 0;
 }
 
@@ -1850,6 +1852,7 @@ void rx_get_global_variable(const char *buf)
        pr_var(earc_cap_ds_update_hpd_en, i++);
        pr_var(scdc_force_en, i++);
        pr_var(hdcp_hpd_ctrl_en, i++);
+       pr_var(eq_dbg_lvl, i++);
 }
 
 void skip_frame(unsigned int cnt)