@@ -1909,6 +1909,55 @@ const struct coresight_ops tmc_etr_cs_ops = {
.panic_ops = &tmc_etr_sync_ops,
};
+static void tmc_delete_etr_buf_node(struct tmc_drvdata *drvdata)
+{
+ struct etr_buf_node *nd, *next;
+
+ list_for_each_entry_safe(nd, next, &drvdata->etr_buf_list, node) {
+ if (nd->sysfs_buf == drvdata->sysfs_buf) {
+ list_del(&nd->node);
+ kfree(nd);
+ } else {
+ /* Free allocated buffers which are not utilized by ETR */
+ list_del(&nd->node);
+ tmc_free_etr_buf(nd->sysfs_buf);
+ nd->sysfs_buf = NULL;
+ kfree(nd);
+ }
+ }
+}
+
+static int tmc_create_etr_buf_node(struct tmc_drvdata *drvdata, struct etr_buf *alloc_buf)
+{
+ struct etr_buf_node *sysfs_buf_node;
+ struct etr_buf *sysfs_buf;
+
+ if (!alloc_buf) {
+ sysfs_buf = tmc_alloc_etr_buf(drvdata, drvdata->size, 0, cpu_to_node(0), NULL);
+ if (IS_ERR(sysfs_buf))
+ return PTR_ERR(sysfs_buf);
+ } else {
+ sysfs_buf = alloc_buf;
+ }
+
+ sysfs_buf_node = kzalloc(sizeof(struct etr_buf_node), GFP_KERNEL);
+ if (IS_ERR(sysfs_buf_node)) {
+ if (!alloc_buf)
+ tmc_free_etr_buf(sysfs_buf);
+ return PTR_ERR(sysfs_buf_node);
+ }
+
+ sysfs_buf_node->sysfs_buf = sysfs_buf;
+ sysfs_buf_node->reading = false;
+ if (!alloc_buf)
+ sysfs_buf_node->is_free = true;
+ else
+ sysfs_buf_node->is_free = false;
+ list_add(&sysfs_buf_node->node, &drvdata->etr_buf_list);
+
+ return 0;
+}
+
int tmc_read_prepare_etr(struct tmc_drvdata *drvdata)
{
int ret = 0;
Create and insert or remove the etr_buf_node to/from the etr_buf_list. Signed-off-by: Jie Gan <jie.gan@oss.qualcomm.com> --- .../hwtracing/coresight/coresight-tmc-etr.c | 49 +++++++++++++++++++ 1 file changed, 49 insertions(+)