@@ -1236,6 +1236,68 @@ void tmc_etr_disable_hw(struct tmc_drvdata *drvdata)
drvdata->etr_buf = NULL;
}
+static long tmc_etr_flat_resrv_get_rwp_offset(struct tmc_drvdata *drvdata)
+{
+ dma_addr_t paddr = drvdata->sysfs_buf->hwaddr;
+ u64 rwp;
+
+ rwp = tmc_read_rwp(drvdata);
+ return rwp - paddr;
+}
+
+static long tmc_etr_sg_get_rwp_offset(struct tmc_drvdata *drvdata)
+{
+ struct etr_buf *etr_buf = drvdata->sysfs_buf;
+ struct etr_sg_table *etr_table = etr_buf->private;
+ struct tmc_sg_table *table = etr_table->sg_table;
+ long w_offset;
+ u64 rwp;
+
+ rwp = tmc_read_rwp(drvdata);
+ w_offset = tmc_sg_get_data_page_offset(table, rwp);
+
+ return w_offset;
+}
+
+/**
+ * tmc_etr_get_rwp_offset() - Retrieving the offset to the write pointer.
+ *
+ * @drvdata: driver data of TMC device.
+ *
+ * Retrieve the offset to the write pointer of the ETR
+ * buffer based on whether the memory mode is SG, flat or reserved.
+ *
+ * Return w_offset of the ETR buffer upon success, else the error number.
+ */
+long tmc_etr_get_rwp_offset(struct tmc_drvdata *drvdata)
+{
+ struct etr_buf *etr_buf;
+ long w_offset;
+
+ if (WARN_ON(!drvdata) || WARN_ON(!drvdata->sysfs_buf) ||
+ WARN_ON(drvdata->config_type != TMC_CONFIG_TYPE_ETR))
+ return -EINVAL;
+
+ etr_buf = drvdata->sysfs_buf;
+ /* Disable the ETR if it is running */
+ if (coresight_get_mode(drvdata->csdev) != CS_MODE_DISABLED)
+ __tmc_etr_disable_hw(drvdata);
+
+ if (etr_buf->mode == ETR_MODE_ETR_SG)
+ w_offset = tmc_etr_sg_get_rwp_offset(drvdata);
+ else if (etr_buf->mode == ETR_MODE_FLAT || etr_buf->mode == ETR_MODE_RESRV)
+ w_offset = tmc_etr_flat_resrv_get_rwp_offset(drvdata);
+ else
+ w_offset = -EINVAL;
+
+ /* Restart the ETR if the mode is not disabled */
+ if (coresight_get_mode(drvdata->csdev) != CS_MODE_DISABLED)
+ __tmc_etr_enable_hw(drvdata);
+
+ return w_offset;
+}
+EXPORT_SYMBOL_GPL(tmc_etr_get_rwp_offset);
+
static struct etr_buf *tmc_etr_get_sysfs_buffer(struct coresight_device *csdev)
{
int ret = 0;
@@ -442,5 +442,6 @@ void tmc_etr_remove_catu_ops(void);
struct etr_buf *tmc_etr_get_buffer(struct coresight_device *csdev,
enum cs_mode mode, void *data);
extern const struct attribute_group coresight_etr_group;
+long tmc_etr_get_rwp_offset(struct tmc_drvdata *drvdata);
#endif
The new functions calculate and return the offset to the write pointer of the ETR buffer based on whether the memory mode is SG, flat or reserved. The functions have the RWP offset can directly read data from ETR buffer, enabling the transfer of data to any required location. Signed-off-by: Jie Gan <jie.gan@oss.qualcomm.com> --- .../hwtracing/coresight/coresight-tmc-etr.c | 62 +++++++++++++++++++ drivers/hwtracing/coresight/coresight-tmc.h | 1 + 2 files changed, 63 insertions(+)