From f0d6fe0685a3e4867e661e244a7555ab76729a03 Mon Sep 17 00:00:00 2001
From: Yuanfang Zhang <zhangyuanfang@codeaurora.org>
Date: Fri, 8 May 2020 16:04:54 +0800
Subject: [PATCH] coresight: tpdm: add integration_test sysfs node

Add a sysfs_node integration_test to test TPDM trace path.

Change-Id: I5f1cde1ab109b88b8ba6a1b6eba83e014bf6eea3
Signed-off-by: Yuanfang Zhang <zhangyuanfang@codeaurora.org>
---
 drivers/hwtracing/coresight/coresight-tpdm.c | 43 ++++++++++++++++++++
 1 file changed, 43 insertions(+)

diff --git a/drivers/hwtracing/coresight/coresight-tpdm.c b/drivers/hwtracing/coresight/coresight-tpdm.c
index e23f9fbfd243..1e2f4a603437 100644
--- a/drivers/hwtracing/coresight/coresight-tpdm.c
+++ b/drivers/hwtracing/coresight/coresight-tpdm.c
@@ -101,6 +101,8 @@ do {									\
 /* TPDM Specific Registers */
 #define TPDM_ITATBCNTRL		(0xEF0)
 #define TPDM_CLK_CTRL		(0x220)
+#define TPDM_ITCNTRL		(0xF00)
+
 
 #define TPDM_DATASETS		32
 #define TPDM_BC_MAX_COUNTERS	32
@@ -134,6 +136,11 @@ do {									\
 
 #define HW_ENABLE_CHECK_VALUE   0x10
 
+
+#define ATBCNTRL_VAL_32		0xC00F1409
+#define ATBCNTRL_VAL_64		0xC01F1409
+
+
 enum tpdm_dataset {
 	TPDM_DS_IMPLDEF,
 	TPDM_DS_DSB,
@@ -909,6 +916,41 @@ static ssize_t reset_store(struct device *dev,
 }
 static DEVICE_ATTR_WO(reset);
 
+static ssize_t integration_test_store(struct device *dev,
+					  struct device_attribute *attr,
+					  const char *buf,
+					  size_t size)
+{
+	int i, ret = 0;
+	unsigned long val;
+	struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent);
+
+	ret = kstrtoul(buf, 10, &val);
+	if (ret)
+		return ret;
+
+	if (val != 1 && val != 2)
+		return -EINVAL;
+
+	if (!drvdata->enable)
+		return -EINVAL;
+
+	if (val == 1)
+		val = ATBCNTRL_VAL_64;
+	else
+		val = ATBCNTRL_VAL_32;
+	TPDM_UNLOCK(drvdata);
+	tpdm_writel(drvdata, 0x1, TPDM_ITCNTRL);
+
+	for (i = 1; i < 5; i++)
+		tpdm_writel(drvdata, val, TPDM_ITATBCNTRL);
+
+	tpdm_writel(drvdata, 0, TPDM_ITCNTRL);
+	TPDM_LOCK(drvdata);
+	return size;
+}
+static DEVICE_ATTR_WO(integration_test);
+
 static ssize_t gp_regs_show(struct device *dev,
 				 struct device_attribute *attr,
 				 char *buf)
@@ -3962,6 +4004,7 @@ static struct attribute *tpdm_attrs[] = {
 	&dev_attr_available_datasets.attr,
 	&dev_attr_enable_datasets.attr,
 	&dev_attr_reset.attr,
+	&dev_attr_integration_test.attr,
 	&dev_attr_gp_regs.attr,
 	NULL,
 };