From: Yi Zhou <yi.zhou@amlogic.com>
Date: Mon, 12 Mar 2018 10:39:56 +0000 (+0800)
Subject: hdmitx: add EMP (any packets) function
X-Git-Tag: khadas-vims-v0.9.6-release~2334
X-Git-Url: http://review.tizen.org/git/?a=commitdiff_plain;h=f36c4e21f68e44f86793fde9ca84ba7b96d6fc42;p=platform%2Fkernel%2Flinux-amlogic.git

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
--- 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
--- 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
--- 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)