drm/sti: add debugfs entries for MIXER crtc

Signed-off-by: Vincent Abriou <vincent.abriou@st.com>
Reviewed-by: Benjamin Gaignard <benjamin.gaignard@linaro.org>

3 files changed, 149 insertions, 3 deletions

diff --git a/drivers/gpu/drm/sti/sti_compositor.c b/drivers/gpu/drm/sti/sti_compositor.c
index 5b827a9116b0..3d2fa3ab33df 100644
--- a/drivers/gpu/drm/sti/sti_compositor.c
+++ b/drivers/gpu/drm/sti/sti_compositor.c
@@ -81,7 +81,7 @@ static int sti_compositor_bind(struct device *dev,
                 case STI_MIXER_MAIN_SUBDEV:
                 case STI_MIXER_AUX_SUBDEV:
                         compo->mixer[mixer_id++] =
-                            sti_mixer_create(compo->dev, desc[i].id,
+                            sti_mixer_create(compo->dev, drm_dev, desc[i].id,
                                              compo->regs + desc[i].offset);
                         break;
                 case STI_GPD_SUBDEV:
diff --git a/drivers/gpu/drm/sti/sti_mixer.c b/drivers/gpu/drm/sti/sti_mixer.c
index 49db835dce03..e7425c38fc93 100644
--- a/drivers/gpu/drm/sti/sti_mixer.c
+++ b/drivers/gpu/drm/sti/sti_mixer.c
@@ -75,6 +75,145 @@ static inline void sti_mixer_reg_write(struct sti_mixer *mixer,
         writel(val, mixer->regs + reg_id);
 }
 
+#define DBGFS_DUMP(reg) seq_printf(s, "\n  %-25s 0x%08X", #reg, \
+                                   sti_mixer_reg_read(mixer, reg))
+
+static void mixer_dbg_ctl(struct seq_file *s, int val)
+{
+        unsigned int i;
+        int count = 0;
+        char *const disp_layer[] = {"BKG", "VID0", "VID1", "GDP0",
+                                    "GDP1", "GDP2", "GDP3"};
+
+        seq_puts(s, "\tEnabled: ");
+        for (i = 0; i < 7; i++) {
+                if (val & 1) {
+                        seq_printf(s, "%s ", disp_layer[i]);
+                        count++;
+                }
+                val = val >> 1;
+        }
+
+        val = val >> 2;
+        if (val & 1) {
+                seq_puts(s, "CURS ");
+                count++;
+        }
+        if (!count)
+                seq_puts(s, "Nothing");
+}
+
+static void mixer_dbg_crb(struct seq_file *s, int val)
+{
+        int i;
+
+        seq_puts(s, "\tDepth: ");
+        for (i = 0; i < GAM_MIXER_NB_DEPTH_LEVEL; i++) {
+                switch (val & GAM_DEPTH_MASK_ID) {
+                case GAM_DEPTH_VID0_ID:
+                        seq_puts(s, "VID0");
+                        break;
+                case GAM_DEPTH_VID1_ID:
+                        seq_puts(s, "VID1");
+                        break;
+                case GAM_DEPTH_GDP0_ID:
+                        seq_puts(s, "GDP0");
+                        break;
+                case GAM_DEPTH_GDP1_ID:
+                        seq_puts(s, "GDP1");
+                        break;
+                case GAM_DEPTH_GDP2_ID:
+                        seq_puts(s, "GDP2");
+                        break;
+                case GAM_DEPTH_GDP3_ID:
+                        seq_puts(s, "GDP3");
+                        break;
+                default:
+                        seq_puts(s, "---");
+                }
+
+                if (i < GAM_MIXER_NB_DEPTH_LEVEL - 1)
+                        seq_puts(s, " < ");
+                val = val >> 3;
+        }
+}
+
+static void mixer_dbg_mxn(struct seq_file *s, void *addr)
+{
+        int i;
+
+        for (i = 1; i < 8; i++)
+                seq_printf(s, "-0x%08X", (int)readl(addr + i * 4));
+}
+
+static int mixer_dbg_show(struct seq_file *s, void *arg)
+{
+        struct drm_info_node *node = s->private;
+        struct sti_mixer *mixer = (struct sti_mixer *)node->info_ent->data;
+        struct drm_device *dev = node->minor->dev;
+        int ret;
+
+        ret = mutex_lock_interruptible(&dev->struct_mutex);
+        if (ret)
+                return ret;
+
+        seq_printf(s, "%s: (vaddr = 0x%p)",
+                   sti_mixer_to_str(mixer), mixer->regs);
+
+        DBGFS_DUMP(GAM_MIXER_CTL);
+        mixer_dbg_ctl(s, sti_mixer_reg_read(mixer, GAM_MIXER_CTL));
+        DBGFS_DUMP(GAM_MIXER_BKC);
+        DBGFS_DUMP(GAM_MIXER_BCO);
+        DBGFS_DUMP(GAM_MIXER_BCS);
+        DBGFS_DUMP(GAM_MIXER_AVO);
+        DBGFS_DUMP(GAM_MIXER_AVS);
+        DBGFS_DUMP(GAM_MIXER_CRB);
+        mixer_dbg_crb(s, sti_mixer_reg_read(mixer, GAM_MIXER_CRB));
+        DBGFS_DUMP(GAM_MIXER_ACT);
+        DBGFS_DUMP(GAM_MIXER_MBP);
+        DBGFS_DUMP(GAM_MIXER_MX0);
+        mixer_dbg_mxn(s, mixer->regs + GAM_MIXER_MX0);
+        seq_puts(s, "\n");
+
+        mutex_unlock(&dev->struct_mutex);
+        return 0;
+}
+
+static struct drm_info_list mixer0_debugfs_files[] = {
+        { "mixer_main", mixer_dbg_show, 0, NULL },
+};
+
+static struct drm_info_list mixer1_debugfs_files[] = {
+        { "mixer_aux", mixer_dbg_show, 0, NULL },
+};
+
+static int mixer_debugfs_init(struct sti_mixer *mixer, struct drm_minor *minor)
+{
+        unsigned int i;
+        struct drm_info_list *mixer_debugfs_files;
+        int nb_files;
+
+        switch (mixer->id) {
+        case STI_MIXER_MAIN:
+                mixer_debugfs_files = mixer0_debugfs_files;
+                nb_files = ARRAY_SIZE(mixer0_debugfs_files);
+                break;
+        case STI_MIXER_AUX:
+                mixer_debugfs_files = mixer1_debugfs_files;
+                nb_files = ARRAY_SIZE(mixer1_debugfs_files);
+                break;
+        default:
+                return -EINVAL;
+        }
+
+        for (i = 0; i < nb_files; i++)
+                mixer_debugfs_files[i].data = mixer;
+
+        return drm_debugfs_create_files(mixer_debugfs_files,
+                                        nb_files,
+                                        minor->debugfs_root, minor);
+}
+
 void sti_mixer_set_background_status(struct sti_mixer *mixer, bool enable)
 {
         u32 val = sti_mixer_reg_read(mixer, GAM_MIXER_CTL);
@@ -237,7 +376,9 @@ void sti_mixer_set_matrix(struct sti_mixer *mixer)
                                     mixerColorSpaceMatIdentity[i]);
 }
 
-struct sti_mixer *sti_mixer_create(struct device *dev, int id,
+struct sti_mixer *sti_mixer_create(struct device *dev,
+                                   struct drm_device *drm_dev,
+                                   int id,
                                    void __iomem *baseaddr)
 {
         struct sti_mixer *mixer = devm_kzalloc(dev, sizeof(*mixer), GFP_KERNEL);
@@ -258,5 +399,8 @@ struct sti_mixer *sti_mixer_create(struct device *dev, int id,
         DRM_DEBUG_DRIVER("%s created. Regs=%p\n",
                          sti_mixer_to_str(mixer), mixer->regs);
 
+        if (mixer_debugfs_init(mixer, drm_dev->primary))
+                DRM_ERROR("MIXER debugfs setup failed\n");
+
         return mixer;
 }
diff --git a/drivers/gpu/drm/sti/sti_mixer.h b/drivers/gpu/drm/sti/sti_mixer.h
index efb1a9a5ba86..6f35fc086873 100644
--- a/drivers/gpu/drm/sti/sti_mixer.h
+++ b/drivers/gpu/drm/sti/sti_mixer.h
@@ -42,7 +42,9 @@ struct sti_mixer {
 
 const char *sti_mixer_to_str(struct sti_mixer *mixer);
 
-struct sti_mixer *sti_mixer_create(struct device *dev, int id,
+struct sti_mixer *sti_mixer_create(struct device *dev,
+                                   struct drm_device *drm_dev,
+                                   int id,
                                    void __iomem *baseaddr);
 
 int sti_mixer_set_plane_status(struct sti_mixer *mixer,