Signed-off-by: Vincent Abriou <vincent.abriou at st.com>
---
 drivers/gpu/drm/sti/sti_tvout.c | 157 ++++++++++++++++++++++++++++++++++++++++
 1 file changed, 157 insertions(+)

diff --git a/drivers/gpu/drm/sti/sti_tvout.c b/drivers/gpu/drm/sti/sti_tvout.c
index 0b171fd..d4bb953 100644
--- a/drivers/gpu/drm/sti/sti_tvout.c
+++ b/drivers/gpu/drm/sti/sti_tvout.c
@@ -462,6 +462,157 @@ static void tvout_hda_start(struct sti_tvout *tvout, bool 
main_path)
        tvout_write(tvout, 0, TVO_HD_DAC_CFG_OFF);
 }

+#define DBGFS_DUMP(reg) seq_printf(s, "\n  %-25s 0x%08X", #reg, \
+                                  readl(tvout->regs + reg))
+
+static void tvout_dbg_vip(struct seq_file *s, int val)
+{
+       int r, g, b, tmp, mask;
+       char *const reorder[] = {"Y_G", "Cb_B", "Cr_R"};
+       char *const clipping[] = {"No", "EAV/SAV", "Limited range RGB/Y",
+                                 "Limited range Cb/Cr", "decided by register"};
+       char *const round[] = {"8-bit", "10-bit", "12-bit"};
+       char *const input_sel[] = {"Main (color matrix enabled)",
+                                  "Main (color matrix by-passed)",
+                                  "", "", "", "", "", "",
+                                  "Aux (color matrix enabled)",
+                                  "Aux (color matrix by-passed)",
+                                  "", "", "", "", "", "Force value"};
+
+       seq_puts(s, "\t");
+       mask = TVO_VIP_REORDER_MASK << TVO_VIP_REORDER_R_SHIFT;
+       r = (val & mask) >> TVO_VIP_REORDER_R_SHIFT;
+       mask = TVO_VIP_REORDER_MASK << TVO_VIP_REORDER_G_SHIFT;
+       g = (val & mask) >> TVO_VIP_REORDER_G_SHIFT;
+       mask = TVO_VIP_REORDER_MASK << TVO_VIP_REORDER_B_SHIFT;
+       b = (val & mask) >> TVO_VIP_REORDER_B_SHIFT;
+       seq_printf(s, "%-24s %s->%s %s->%s %s->%s\n", "Reorder:",
+                  reorder[r], reorder[TVO_VIP_REORDER_CR_R_SEL],
+                  reorder[g], reorder[TVO_VIP_REORDER_Y_G_SEL],
+                  reorder[b], reorder[TVO_VIP_REORDER_CB_B_SEL]);
+       seq_puts(s, "\t\t\t\t\t");
+       mask = TVO_VIP_CLIP_MASK << TVO_VIP_CLIP_SHIFT;
+       tmp = (val & mask) >> TVO_VIP_CLIP_SHIFT;
+       seq_printf(s, "%-24s %s\n", "Clipping:", clipping[tmp]);
+       seq_puts(s, "\t\t\t\t\t");
+       mask = TVO_VIP_RND_MASK << TVO_VIP_RND_SHIFT;
+       tmp = (val & mask) >> TVO_VIP_RND_SHIFT;
+       seq_printf(s, "%-24s input data rounded to %s per component\n",
+                  "Round:", round[tmp]);
+       seq_puts(s, "\t\t\t\t\t");
+       tmp = (val & TVO_VIP_SEL_INPUT_MASK);
+       seq_printf(s, "%-24s %s", "Input selection:", input_sel[tmp]);
+}
+
+static void tvout_dbg_hd_dac_cfg(struct seq_file *s, int val)
+{
+       seq_printf(s, "\t%-24s %s", "HD DAC:",
+                  val & 1 ? "disabled" : "enabled");
+}
+
+static int tvout_dbg_show(struct seq_file *s, void *data)
+{
+       struct drm_info_node *node = s->private;
+       struct sti_tvout *tvout = (struct sti_tvout *)node->info_ent->data;
+       struct drm_device *dev = node->minor->dev;
+       struct drm_crtc *crtc;
+       int ret;
+
+       ret = mutex_lock_interruptible(&dev->struct_mutex);
+       if (ret)
+               return ret;
+
+       seq_printf(s, "TVOUT: (vaddr = 0x%p)", tvout->regs);
+
+       seq_puts(s, "\n\n  HDMI encoder: ");
+       crtc = tvout->hdmi->crtc;
+       if (crtc) {
+               seq_printf(s, "connected to %s path",
+                          sti_crtc_is_main(crtc) ? "main" : "aux");
+               DBGFS_DUMP(TVO_HDMI_SYNC_SEL);
+               DBGFS_DUMP(TVO_VIP_HDMI);
+               tvout_dbg_vip(s, readl(tvout->regs + TVO_VIP_HDMI));
+       } else {
+               seq_puts(s, "disabled");
+       }
+
+       seq_puts(s, "\n\n  DVO encoder: ");
+       crtc = tvout->dvo->crtc;
+       if (crtc) {
+               seq_printf(s, "connected to %s path",
+                          sti_crtc_is_main(crtc) ? "main" : "aux");
+               DBGFS_DUMP(TVO_DVO_SYNC_SEL);
+               DBGFS_DUMP(TVO_DVO_CONFIG);
+               DBGFS_DUMP(TVO_VIP_DVO);
+               tvout_dbg_vip(s, readl(tvout->regs + TVO_VIP_DVO));
+       } else {
+               seq_puts(s, "disabled");
+       }
+
+       seq_puts(s, "\n\n  HDA encoder: ");
+       crtc = tvout->hda->crtc;
+       if (crtc) {
+               seq_printf(s, "connected to %s path",
+                          sti_crtc_is_main(crtc) ? "main" : "aux");
+               DBGFS_DUMP(TVO_HD_SYNC_SEL);
+               DBGFS_DUMP(TVO_HD_DAC_CFG_OFF);
+               tvout_dbg_hd_dac_cfg(s,
+                                    readl(tvout->regs + TVO_HD_DAC_CFG_OFF));
+               DBGFS_DUMP(TVO_VIP_HDF);
+               tvout_dbg_vip(s, readl(tvout->regs + TVO_VIP_HDF));
+       } else {
+               seq_puts(s, "disabled");
+       }
+
+       seq_puts(s, "\n\n  main path configuration");
+       DBGFS_DUMP(TVO_CSC_MAIN_M0);
+       DBGFS_DUMP(TVO_CSC_MAIN_M1);
+       DBGFS_DUMP(TVO_CSC_MAIN_M2);
+       DBGFS_DUMP(TVO_CSC_MAIN_M3);
+       DBGFS_DUMP(TVO_CSC_MAIN_M4);
+       DBGFS_DUMP(TVO_CSC_MAIN_M5);
+       DBGFS_DUMP(TVO_CSC_MAIN_M6);
+       DBGFS_DUMP(TVO_CSC_MAIN_M7);
+       DBGFS_DUMP(TVO_MAIN_IN_VID_FORMAT);
+
+       seq_puts(s, "\n\n  auxiliary path configuration");
+       DBGFS_DUMP(TVO_CSC_AUX_M0);
+       DBGFS_DUMP(TVO_CSC_AUX_M2);
+       DBGFS_DUMP(TVO_CSC_AUX_M3);
+       DBGFS_DUMP(TVO_CSC_AUX_M4);
+       DBGFS_DUMP(TVO_CSC_AUX_M5);
+       DBGFS_DUMP(TVO_CSC_AUX_M6);
+       DBGFS_DUMP(TVO_CSC_AUX_M7);
+       DBGFS_DUMP(TVO_AUX_IN_VID_FORMAT);
+       seq_puts(s, "\n");
+
+       mutex_unlock(&dev->struct_mutex);
+       return 0;
+}
+
+static struct drm_info_list tvout_debugfs_files[] = {
+       { "tvout", tvout_dbg_show, 0, NULL },
+};
+
+static void tvout_debugfs_exit(struct sti_tvout *tvout, struct drm_minor 
*minor)
+{
+       drm_debugfs_remove_files(tvout_debugfs_files,
+                                ARRAY_SIZE(tvout_debugfs_files),
+                                minor);
+}
+
+static int tvout_debugfs_init(struct sti_tvout *tvout, struct drm_minor *minor)
+{
+       unsigned int i;
+
+       for (i = 0; i < ARRAY_SIZE(tvout_debugfs_files); i++)
+               tvout_debugfs_files[i].data = tvout;
+
+       return drm_debugfs_create_files(tvout_debugfs_files,
+                                       ARRAY_SIZE(tvout_debugfs_files),
+                                       minor->debugfs_root, minor);
+}
+
 static void sti_tvout_encoder_dpms(struct drm_encoder *encoder, int mode)
 {
 }
@@ -678,6 +829,9 @@ static int sti_tvout_bind(struct device *dev, struct device 
*master, void *data)

        sti_tvout_create_encoders(drm_dev, tvout);

+       if (tvout_debugfs_init(tvout, drm_dev->primary))
+               DRM_ERROR("TVOUT debugfs setup failed\n");
+
        return 0;
 }

@@ -685,8 +839,11 @@ static void sti_tvout_unbind(struct device *dev, struct 
device *master,
        void *data)
 {
        struct sti_tvout *tvout = dev_get_drvdata(dev);
+       struct drm_device *drm_dev = data;

        sti_tvout_destroy_encoders(tvout);
+
+       tvout_debugfs_exit(tvout, drm_dev->primary);
 }

 static const struct component_ops sti_tvout_ops = {
-- 
1.9.1

Reply via email to