coresight: stm: Update STM driver to use Trace ID API

Updates the STM driver to use the trace ID allocation API.
This uses the _system_id calls to allocate an ID on device poll,
and release on device remove.

The sysfs access to the STMTRACEIDR register has been changed from RW
to RO. Having this value as writable is not appropriate for the new
Trace ID scheme - and had potential to cause errors in the previous
scheme if values clashed with other sources.

Signed-off-by: Mike Leach <mike.leach@linaro.org>
Reviewed-by: Suzuki K Poulose <suzuki.poulose@arm.com>
Signed-off-by: Suzuki K Poulose <suzuki.poulose@arm.com>
Link: https://lore.kernel.org/r/20230116124928.5440-5-mike.leach@linaro.org

diff --git a/drivers/hwtracing/coresight/coresight-stm.c b/drivers/hwtracing/coresight/coresight-stm.c
index 463f449cfb795806cf0490e2dcb191e19b8c07f7..6af1b996af6fa3640e70308282d42c79e2df5b31 100644 (file)
--- a/drivers/hwtracing/coresight/coresight-stm.c
+++ b/drivers/hwtracing/coresight/coresight-stm.c
@@ -31,6 +31,7 @@
 #include <linux/stm.h>
 
 #include "coresight-priv.h"
+#include "coresight-trace-id.h"
 
 #define STMDMASTARTR                   0xc04
 #define STMDMASTOPR                    0xc08
@@ -615,24 +616,7 @@ static ssize_t traceid_show(struct device *dev,
        val = drvdata->traceid;
        return sprintf(buf, "%#lx\n", val);
 }
-
-static ssize_t traceid_store(struct device *dev,
-                            struct device_attribute *attr,
-                            const char *buf, size_t size)
-{
-       int ret;
-       unsigned long val;
-       struct stm_drvdata *drvdata = dev_get_drvdata(dev->parent);
-
-       ret = kstrtoul(buf, 16, &val);
-       if (ret)
-               return ret;
-
-       /* traceid field is 7bit wide on STM32 */
-       drvdata->traceid = val & 0x7f;
-       return size;
-}
-static DEVICE_ATTR_RW(traceid);
+static DEVICE_ATTR_RO(traceid);
 
 static struct attribute *coresight_stm_attrs[] = {
        &dev_attr_hwevent_enable.attr,
@@ -803,14 +787,6 @@ static void stm_init_default_data(struct stm_drvdata *drvdata)
         */
        drvdata->stmsper = ~0x0;
 
-       /*
-        * The trace ID value for *ETM* tracers start at CPU_ID * 2 + 0x10 and
-        * anything equal to or higher than 0x70 is reserved.  Since 0x00 is
-        * also reserved the STM trace ID needs to be higher than 0x00 and
-        * lowner than 0x10.
-        */
-       drvdata->traceid = 0x1;
-
        /* Set invariant transaction timing on all channels */
        bitmap_clear(drvdata->chs.guaranteed, 0, drvdata->numsp);
 }
@@ -838,7 +814,7 @@ static void stm_init_generic_data(struct stm_drvdata *drvdata,
 
 static int stm_probe(struct amba_device *adev, const struct amba_id *id)
 {
-       int ret;
+       int ret, trace_id;
        void __iomem *base;
        struct device *dev = &adev->dev;
        struct coresight_platform_data *pdata = NULL;
@@ -922,12 +898,22 @@ static int stm_probe(struct amba_device *adev, const struct amba_id *id)
                goto stm_unregister;
        }
 
+       trace_id = coresight_trace_id_get_system_id();
+       if (trace_id < 0) {
+               ret = trace_id;
+               goto cs_unregister;
+       }
+       drvdata->traceid = (u8)trace_id;
+
        pm_runtime_put(&adev->dev);
 
        dev_info(&drvdata->csdev->dev, "%s initialized\n",
                 (char *)coresight_get_uci_data(id));
        return 0;
 
+cs_unregister:
+       coresight_unregister(drvdata->csdev);
+
 stm_unregister:
        stm_unregister_device(&drvdata->stm);
        return ret;
@@ -937,6 +923,7 @@ static void stm_remove(struct amba_device *adev)
 {
        struct stm_drvdata *drvdata = dev_get_drvdata(&adev->dev);
 
+       coresight_trace_id_put_system_id(drvdata->traceid);
        coresight_unregister(drvdata->csdev);
 
        stm_unregister_device(&drvdata->stm);