forked from mirrors/linux
		
	Coresight: Add trace_id function to retrieving the trace ID
Add 'trace_id' function pointer in coresight_ops. It's responsible for retrieving the device's trace ID. Co-developed-by: James Clark <james.clark@linaro.org> Signed-off-by: James Clark <james.clark@linaro.org> Reviewed-by: James Clark <james.clark@linaro.org> Signed-off-by: Jie Gan <quic_jiegan@quicinc.com> Signed-off-by: Suzuki K Poulose <suzuki.poulose@arm.com> Link: https://lore.kernel.org/r/20250303032931.2500935-3-quic_jiegan@quicinc.com
This commit is contained in:
		
							parent
							
								
									dc872c5f52
								
							
						
					
					
						commit
						c367a89dec
					
				
					 7 changed files with 71 additions and 1 deletions
				
			
		| 
						 | 
				
			
			@ -24,6 +24,7 @@
 | 
			
		|||
#include "coresight-etm-perf.h"
 | 
			
		||||
#include "coresight-priv.h"
 | 
			
		||||
#include "coresight-syscfg.h"
 | 
			
		||||
#include "coresight-trace-id.h"
 | 
			
		||||
 | 
			
		||||
/*
 | 
			
		||||
 * Mutex used to lock all sysfs enable and disable actions and loading and
 | 
			
		||||
| 
						 | 
				
			
			@ -1567,6 +1568,35 @@ void coresight_remove_driver(struct amba_driver *amba_drv,
 | 
			
		|||
}
 | 
			
		||||
EXPORT_SYMBOL_GPL(coresight_remove_driver);
 | 
			
		||||
 | 
			
		||||
int coresight_etm_get_trace_id(struct coresight_device *csdev, enum cs_mode mode,
 | 
			
		||||
			       struct coresight_device *sink)
 | 
			
		||||
{
 | 
			
		||||
	int trace_id;
 | 
			
		||||
	int cpu = source_ops(csdev)->cpu_id(csdev);
 | 
			
		||||
 | 
			
		||||
	switch (mode) {
 | 
			
		||||
	case CS_MODE_SYSFS:
 | 
			
		||||
		trace_id = coresight_trace_id_get_cpu_id(cpu);
 | 
			
		||||
		break;
 | 
			
		||||
	case CS_MODE_PERF:
 | 
			
		||||
		if (WARN_ON(!sink))
 | 
			
		||||
			return -EINVAL;
 | 
			
		||||
 | 
			
		||||
		trace_id = coresight_trace_id_get_cpu_id_map(cpu, &sink->perf_sink_id_map);
 | 
			
		||||
		break;
 | 
			
		||||
	default:
 | 
			
		||||
		trace_id = -EINVAL;
 | 
			
		||||
		break;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	if (!IS_VALID_CS_TRACE_ID(trace_id))
 | 
			
		||||
		dev_err(&csdev->dev,
 | 
			
		||||
			"Failed to allocate trace ID on CPU%d\n", cpu);
 | 
			
		||||
 | 
			
		||||
	return trace_id;
 | 
			
		||||
}
 | 
			
		||||
EXPORT_SYMBOL_GPL(coresight_etm_get_trace_id);
 | 
			
		||||
 | 
			
		||||
MODULE_LICENSE("GPL v2");
 | 
			
		||||
MODULE_AUTHOR("Pratik Patel <pratikp@codeaurora.org>");
 | 
			
		||||
MODULE_AUTHOR("Mathieu Poirier <mathieu.poirier@linaro.org>");
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -41,6 +41,16 @@ static void dummy_source_disable(struct coresight_device *csdev,
 | 
			
		|||
	dev_dbg(csdev->dev.parent, "Dummy source disabled\n");
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int dummy_source_trace_id(struct coresight_device *csdev, __maybe_unused enum cs_mode mode,
 | 
			
		||||
				 __maybe_unused struct coresight_device *sink)
 | 
			
		||||
{
 | 
			
		||||
	struct dummy_drvdata *drvdata;
 | 
			
		||||
 | 
			
		||||
	drvdata = dev_get_drvdata(csdev->dev.parent);
 | 
			
		||||
 | 
			
		||||
	return drvdata->traceid;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int dummy_sink_enable(struct coresight_device *csdev, enum cs_mode mode,
 | 
			
		||||
				void *data)
 | 
			
		||||
{
 | 
			
		||||
| 
						 | 
				
			
			@ -62,6 +72,7 @@ static const struct coresight_ops_source dummy_source_ops = {
 | 
			
		|||
};
 | 
			
		||||
 | 
			
		||||
static const struct coresight_ops dummy_source_cs_ops = {
 | 
			
		||||
	.trace_id	= dummy_source_trace_id,
 | 
			
		||||
	.source_ops	= &dummy_source_ops,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -704,6 +704,7 @@ static const struct coresight_ops_source etm_source_ops = {
 | 
			
		|||
};
 | 
			
		||||
 | 
			
		||||
static const struct coresight_ops etm_cs_ops = {
 | 
			
		||||
	.trace_id	= coresight_etm_get_trace_id,
 | 
			
		||||
	.source_ops	= &etm_source_ops,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -1104,6 +1104,7 @@ static const struct coresight_ops_source etm4_source_ops = {
 | 
			
		|||
};
 | 
			
		||||
 | 
			
		||||
static const struct coresight_ops etm4_cs_ops = {
 | 
			
		||||
	.trace_id	= coresight_etm_get_trace_id,
 | 
			
		||||
	.source_ops	= &etm4_source_ops,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -281,12 +281,23 @@ static void stm_disable(struct coresight_device *csdev,
 | 
			
		|||
	}
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int stm_trace_id(struct coresight_device *csdev, __maybe_unused enum cs_mode mode,
 | 
			
		||||
			__maybe_unused struct coresight_device *sink)
 | 
			
		||||
{
 | 
			
		||||
	struct stm_drvdata *drvdata;
 | 
			
		||||
 | 
			
		||||
	drvdata = dev_get_drvdata(csdev->dev.parent);
 | 
			
		||||
 | 
			
		||||
	return drvdata->traceid;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static const struct coresight_ops_source stm_source_ops = {
 | 
			
		||||
	.enable		= stm_enable,
 | 
			
		||||
	.disable	= stm_disable,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
static const struct coresight_ops stm_cs_ops = {
 | 
			
		||||
	.trace_id	= stm_trace_id,
 | 
			
		||||
	.source_ops	= &stm_source_ops,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -242,12 +242,23 @@ static void tpda_disable(struct coresight_device *csdev,
 | 
			
		|||
	dev_dbg(drvdata->dev, "TPDA inport %d disabled\n", in->dest_port);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int tpda_trace_id(struct coresight_device *csdev, __maybe_unused enum cs_mode mode,
 | 
			
		||||
			 __maybe_unused struct coresight_device *sink)
 | 
			
		||||
{
 | 
			
		||||
	struct tpda_drvdata *drvdata;
 | 
			
		||||
 | 
			
		||||
	drvdata = dev_get_drvdata(csdev->dev.parent);
 | 
			
		||||
 | 
			
		||||
	return drvdata->atid;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static const struct coresight_ops_link tpda_link_ops = {
 | 
			
		||||
	.enable		= tpda_enable,
 | 
			
		||||
	.disable	= tpda_disable,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
static const struct coresight_ops tpda_cs_ops = {
 | 
			
		||||
	.trace_id	= tpda_trace_id,
 | 
			
		||||
	.link_ops	= &tpda_link_ops,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -335,6 +335,7 @@ enum cs_mode {
 | 
			
		|||
	CS_MODE_PERF,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
#define coresight_ops(csdev)	csdev->ops
 | 
			
		||||
#define source_ops(csdev)	csdev->ops->source_ops
 | 
			
		||||
#define sink_ops(csdev)		csdev->ops->sink_ops
 | 
			
		||||
#define link_ops(csdev)		csdev->ops->link_ops
 | 
			
		||||
| 
						 | 
				
			
			@ -421,6 +422,8 @@ struct coresight_ops_panic {
 | 
			
		|||
};
 | 
			
		||||
 | 
			
		||||
struct coresight_ops {
 | 
			
		||||
	int (*trace_id)(struct coresight_device *csdev, enum cs_mode mode,
 | 
			
		||||
			struct coresight_device *sink);
 | 
			
		||||
	const struct coresight_ops_sink *sink_ops;
 | 
			
		||||
	const struct coresight_ops_link *link_ops;
 | 
			
		||||
	const struct coresight_ops_source *source_ops;
 | 
			
		||||
| 
						 | 
				
			
			@ -713,4 +716,6 @@ int coresight_init_driver(const char *drv, struct amba_driver *amba_drv,
 | 
			
		|||
 | 
			
		||||
void coresight_remove_driver(struct amba_driver *amba_drv,
 | 
			
		||||
			     struct platform_driver *pdev_drv);
 | 
			
		||||
int coresight_etm_get_trace_id(struct coresight_device *csdev, enum cs_mode mode,
 | 
			
		||||
			       struct coresight_device *sink);
 | 
			
		||||
#endif		/* _LINUX_COREISGHT_H */
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
		Loading…
	
		Reference in a new issue