hdmitx: add EMP (any packets) function

PD#156734: add EMP (any packets) function for test

The function is only used to test now. The details need to
be discussed in the feature.

method:
echo emp > /sys/class/amhdmitx/amhdmitx0/config

Change-Id: I73cf93d90c9247336340fdc36ae8779743dc262d
Signed-off-by: Yi Zhou <yi.zhou@amlogic.com>

diff --git a/drivers/amlogic/media/vout/hdmitx/hdmi_tx_20/hdmi_tx_main.c b/drivers/amlogic/media/vout/hdmitx/hdmi_tx_20/hdmi_tx_main.c
index ab5186c..3d7bbd6 100644 (file)
--- a/drivers/amlogic/media/vout/hdmitx/hdmi_tx_20/hdmi_tx_main.c
+++ b/drivers/amlogic/media/vout/hdmitx/hdmi_tx_20/hdmi_tx_main.c
@@ -72,6 +72,7 @@ static void hdmitx_get_edid(struct hdmitx_dev *hdev);
 static void hdmitx_set_drm_pkt(struct master_display_info_s *data);
 static void hdmitx_set_vsif_pkt(enum eotf_type type, enum mode_type
        tunnel_mode, struct dv_vsif_para *data);
+static void hdmitx_set_emp_pkt(void);
 static int check_fbc_special(unsigned char *edid_dat);
 static struct vinfo_s *hdmitx_get_current_vinfo(void);
 
@@ -1293,6 +1294,41 @@ static void hdmitx_set_vsif_pkt(enum eotf_type type,
        }
 }
 
+static void hdmitx_set_emp_pkt(void)
+{
+       unsigned int number;
+       unsigned char *virt_ptr;
+       unsigned char *virt_ptr_align32bit;
+       unsigned long phys_ptr;
+       unsigned int i;
+       struct hdmitx_dev *hdev = &hdmitx_device;
+/*******this data is used to test*********/
+       unsigned char EMP[64] = {0x81, 0x01, 0x18, 0x57,
+               0x03, 0x0c, 0x30, 0x0, 0x0, 0x0};
+       number = 2;
+
+/************************************/
+       if (hdmitx_device.chip_type < MESON_CPU_ID_G12A) {
+               pr_info("this chip doesn't support emp function\n");
+               return;
+       }
+       virt_ptr = kzalloc(sizeof(unsigned char)*(number + 0x1f),
+               GFP_KERNEL);
+       pr_info("emp_pkt virt_ptr: %p\n", virt_ptr);
+       virt_ptr_align32bit = (unsigned char *)
+               ((((unsigned long)virt_ptr) + 0x1f) & (~0x1f));
+       pr_info("emp_pkt virt_ptr_align32bit: %p\n", virt_ptr_align32bit);
+
+       for (i = 0; i < number * 32; i++)
+               virt_ptr_align32bit[i]  = EMP[i];
+
+       phys_ptr = virt_to_phys(virt_ptr_align32bit);
+       pr_info("emp_pkt phys_ptr: %lx\n", phys_ptr);
+
+       hdev->HWOp.CntlConfig(hdev, CONF_EMP_NUMBER, number);
+       hdev->HWOp.CntlConfig(hdev, CONF_EMP_PHY_ADDR, phys_ptr);
+}
+
 /*config attr*/
 static ssize_t show_config(struct device *dev,
        struct device_attribute *attr, char *buf)
@@ -1412,6 +1448,10 @@ static ssize_t store_config(struct device *dev,
                                DRM_DB, DRM_HB);
        } else if (strncmp(buf, "vsif", 4) == 0)
                hdmitx_set_vsif_pkt(buf[4] - '0', buf[5] == '1', NULL);
+       else if (strncmp(buf, "emp", 3) == 0) {
+               if (hdmitx_device.chip_type >= MESON_CPU_ID_G12A)
+                       hdmitx_set_emp_pkt();
+       }
 
        return 16;
 }

diff --git a/drivers/amlogic/media/vout/hdmitx/hdmi_tx_20/hw/hdmi_tx_hw.c b/drivers/amlogic/media/vout/hdmitx/hdmi_tx_20/hw/hdmi_tx_hw.c
index 5879a32..4919fe3 100644 (file)
--- a/drivers/amlogic/media/vout/hdmitx/hdmi_tx_20/hw/hdmi_tx_hw.c
+++ b/drivers/amlogic/media/vout/hdmitx/hdmi_tx_20/hw/hdmi_tx_hw.c
@@ -3483,6 +3483,14 @@ static int hdmitx_cntl_config(struct hdmitx_dev *hdev, unsigned int cmd,
        case CONF_AVI_YQ01:
                hdmitx_set_reg_bits(HDMITX_DWC_FC_AVICONF3, argv, 2, 2);
                break;
+       case CONF_EMP_NUMBER:
+               hdmitx_set_reg_bits(HDMITX_TOP_EMP_CNTL0, argv, 16, 16);
+       case CONF_EMP_PHY_ADDR:
+               hdmitx_rd_check_reg(HDMITX_TOP_EMP_STAT0, 0, 0x3fffffff);
+               hdmitx_wr_reg(HDMITX_TOP_EMP_MEMADDR_START, argv);/*phys_ptr*/
+               hdmitx_set_reg_bits(HDMITX_TOP_EMP_CNTL1, 1, 17, 1); /*little*/
+               hdmitx_set_reg_bits(HDMITX_TOP_EMP_CNTL1, 120, 0, 16);
+               hdmitx_set_reg_bits(HDMITX_TOP_EMP_CNTL0, 1, 0, 1);/*emp_tx_en*/
        default:
                break;
        }

diff --git a/include/linux/amlogic/media/vout/hdmi_tx/hdmi_tx_module.h b/include/linux/amlogic/media/vout/hdmi_tx/hdmi_tx_module.h
index 832c032..ef6f7b1 100644 (file)
--- a/include/linux/amlogic/media/vout/hdmi_tx/hdmi_tx_module.h
+++ b/include/linux/amlogic/media/vout/hdmi_tx/hdmi_tx_module.h
@@ -418,6 +418,8 @@ struct hdmitx_dev {
 #define CONF_VIDEO_MUTE_OP      (CMD_CONF_OFFSET + 0x1000 + 0x04)
 #define VIDEO_MUTE          0x1
 #define VIDEO_UNMUTE        0x2
+#define CONF_EMP_NUMBER         (CMD_CONF_OFFSET + 0x3000 + 0x00)
+#define CONF_EMP_PHY_ADDR       (CMD_CONF_OFFSET + 0x3000 + 0x01)
 
 /* Audio part */
 #define CONF_CLR_AVI_PACKET     (CMD_CONF_OFFSET + 0x04)