remoteproc: debug: add resource table dump feature

This patch adds the capability to display the content of
the resource table associated to a remote processor firmware.

Signed-off-by: Loic Pallardy <loic.pallardy@st.com>
Signed-off-by: Bjorn Andersson <bjorn.andersson@linaro.org>

1 files changed, 99 insertions, 0 deletions

diff --git a/drivers/remoteproc/remoteproc_debugfs.c b/drivers/remoteproc/remoteproc_debugfs.c
index 1c122e230cec..dc5e25943df7 100644
--- a/drivers/remoteproc/remoteproc_debugfs.c
+++ b/drivers/remoteproc/remoteproc_debugfs.c
@@ -155,6 +155,103 @@ static const struct file_operations rproc_recovery_ops = {
         .llseek = generic_file_llseek,
 };
 
+/* Expose resource table content via debugfs */
+static int rproc_rsc_table_show(struct seq_file *seq, void *p)
+{
+        static const char * const types[] = {"carveout", "devmem", "trace", "vdev"};
+        struct rproc *rproc = seq->private;
+        struct resource_table *table = rproc->table_ptr;
+        struct fw_rsc_carveout *c;
+        struct fw_rsc_devmem *d;
+        struct fw_rsc_trace *t;
+        struct fw_rsc_vdev *v;
+        int i, j;
+
+        if (!table) {
+                seq_puts(seq, "No resource table found\n");
+                return 0;
+        }
+
+        for (i = 0; i < table->num; i++) {
+                int offset = table->offset[i];
+                struct fw_rsc_hdr *hdr = (void *)table + offset;
+                void *rsc = (void *)hdr + sizeof(*hdr);
+
+                switch (hdr->type) {
+                case RSC_CARVEOUT:
+                        c = rsc;
+                        seq_printf(seq, "Entry %d is of type %s\n", i, types[hdr->type]);
+                        seq_printf(seq, "  Device Address 0x%x\n", c->da);
+                        seq_printf(seq, "  Physical Address 0x%x\n", c->pa);
+                        seq_printf(seq, "  Length 0x%x Bytes\n", c->len);
+                        seq_printf(seq, "  Flags 0x%x\n", c->flags);
+                        seq_printf(seq, "  Reserved (should be zero) [%d]\n", c->reserved);
+                        seq_printf(seq, "  Name %s\n\n", c->name);
+                        break;
+                case RSC_DEVMEM:
+                        d = rsc;
+                        seq_printf(seq, "Entry %d is of type %s\n", i, types[hdr->type]);
+                        seq_printf(seq, "  Device Address 0x%x\n", d->da);
+                        seq_printf(seq, "  Physical Address 0x%x\n", d->pa);
+                        seq_printf(seq, "  Length 0x%x Bytes\n", d->len);
+                        seq_printf(seq, "  Flags 0x%x\n", d->flags);
+                        seq_printf(seq, "  Reserved (should be zero) [%d]\n", d->reserved);
+                        seq_printf(seq, "  Name %s\n\n", d->name);
+                        break;
+                case RSC_TRACE:
+                        t = rsc;
+                        seq_printf(seq, "Entry %d is of type %s\n", i, types[hdr->type]);
+                        seq_printf(seq, "  Device Address 0x%x\n", t->da);
+                        seq_printf(seq, "  Length 0x%x Bytes\n", t->len);
+                        seq_printf(seq, "  Reserved (should be zero) [%d]\n", t->reserved);
+                        seq_printf(seq, "  Name %s\n\n", t->name);
+                        break;
+                case RSC_VDEV:
+                        v = rsc;
+                        seq_printf(seq, "Entry %d is of type %s\n", i, types[hdr->type]);
+
+                        seq_printf(seq, "  ID %d\n", v->id);
+                        seq_printf(seq, "  Notify ID %d\n", v->notifyid);
+                        seq_printf(seq, "  Device features 0x%x\n", v->dfeatures);
+                        seq_printf(seq, "  Guest features 0x%x\n", v->gfeatures);
+                        seq_printf(seq, "  Config length 0x%x\n", v->config_len);
+                        seq_printf(seq, "  Status 0x%x\n", v->status);
+                        seq_printf(seq, "  Number of vrings %d\n", v->num_of_vrings);
+                        seq_printf(seq, "  Reserved (should be zero) [%d][%d]\n\n",
+                                   v->reserved[0], v->reserved[1]);
+
+                        for (j = 0; j < v->num_of_vrings; j++) {
+                                seq_printf(seq, "  Vring %d\n", j);
+                                seq_printf(seq, "    Device Address 0x%x\n", v->vring[j].da);
+                                seq_printf(seq, "    Alignment %d\n", v->vring[j].align);
+                                seq_printf(seq, "    Number of buffers %d\n", v->vring[j].num);
+                                seq_printf(seq, "    Notify ID %d\n", v->vring[j].notifyid);
+                                seq_printf(seq, "    Physical Address 0x%x\n\n",
+                                           v->vring[j].pa);
+                        }
+                        break;
+                default:
+                        seq_printf(seq, "Unknown resource type found: %d [hdr: %p]\n",
+                                   hdr->type, hdr);
+                        break;
+                }
+        }
+
+        return 0;
+}
+
+static int rproc_rsc_table_open(struct inode *inode, struct file *file)
+{
+        return single_open(file, rproc_rsc_table_show, inode->i_private);
+}
+
+static const struct file_operations rproc_rsc_table_ops = {
+        .open           = rproc_rsc_table_open,
+        .read           = seq_read,
+        .llseek         = seq_lseek,
+        .release        = single_release,
+};
+
 void rproc_remove_trace_file(struct dentry *tfile)
 {
         debugfs_remove(tfile);
@@ -198,6 +295,8 @@ void rproc_create_debug_dir(struct rproc *rproc)
                             rproc, &rproc_name_ops);
         debugfs_create_file("recovery", 0400, rproc->dbg_dir,
                             rproc, &rproc_recovery_ops);
+        debugfs_create_file("resource_table", 0400, rproc->dbg_dir,
+                            rproc, &rproc_rsc_table_ops);
 }
 
 void __init rproc_init_debugfs(void)