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>

diff --git a/drivers/remoteproc/remoteproc_debugfs.c b/drivers/remoteproc/remoteproc_debugfs.c
index 1c122e2..dc5e259 100644 (file)
--- 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)