1 files changed, 58 insertions, 3 deletions

diff --git a/drivers/video/samsung/dsim2/s5p_mipi_dsi.c b/drivers/video/samsung/dsim2/s5p_mipi_dsi.c
index e1b5b6a..6ed8d7e 100644
--- a/drivers/video/samsung/dsim2/s5p_mipi_dsi.c
+++ b/drivers/video/samsung/dsim2/s5p_mipi_dsi.c
@@ -42,6 +42,11 @@
 #define master_to_device(a)	(a->dsim_lcd_dev)
 #define dev_to_dsim(a)		platform_get_drvdata(to_platform_device(a))
 
+#ifdef CONFIG_SLP_DISP_DEBUG
+#define DSIM_MAX_REG	128
+#define DSIM_BASE_REG	0x11C80000
+#endif
+
 struct mipi_dsim_ddi {
 	int				bus_id;
 	struct list_head		list;
@@ -267,9 +272,6 @@ struct mipi_dsim_ddi
 				return dsim_ddi;
 			}
 		}
-
-		kfree(dsim_ddi);
-		list_del(&dsim_ddi->list);
 	}
 
 out:
@@ -478,6 +480,43 @@ static int s5p_mipi_dsi_power_on(struct mipi_dsim_device *dsim, bool enable)
 	return 0;
 }
 
+#ifdef CONFIG_SLP_DISP_DEBUG
+static int s5p_mipi_dsi_read_reg(struct mipi_dsim_device *dsim, char *buf)
+{
+	u32 cfg;
+	int i;
+	int pos = 0;
+
+	pos += sprintf(buf+pos, "0x%.8x | ", DSIM_BASE_REG);
+	for (i = 1; i < DSIM_MAX_REG + 1; i++) {
+		cfg = readl(dsim->reg_base + ((i-1) * sizeof(u32)));
+		pos += sprintf(buf+pos, "0x%.8x ", cfg);
+		if (i % 4 == 0)
+			pos += sprintf(buf+pos, "\n0x%.8x | ",
+				DSIM_BASE_REG + (i * sizeof(u32)));
+	}
+
+	return pos;
+}
+
+static ssize_t show_read_reg(struct device *dev, struct device_attribute *attr,
+			char *buf)
+{
+	struct mipi_dsim_device *dsim = dev_to_dsim(dev);
+
+	if (!dsim->reg_base) {
+		dev_err(dev, "failed to get current register.\n");
+		return -EINVAL;
+	}
+
+	return s5p_mipi_dsi_read_reg(dsim, buf);
+}
+
+static struct device_attribute device_attrs[] = {
+	__ATTR(read_reg, S_IRUGO, show_read_reg, NULL),
+};
+#endif
+
 static int s5p_mipi_dsi_probe(struct platform_device *pdev)
 {
 	struct resource *res;
@@ -487,6 +526,9 @@ static int s5p_mipi_dsi_probe(struct platform_device *pdev)
 	struct mipi_dsim_lcd_driver *client_drv;
 	struct mipi_dsim_ddi *dsim_ddi;
 	int ret = -EINVAL;
+#ifdef CONFIG_SLP_DISP_DEBUG
+	int i;
+#endif
 
 	dsim = kzalloc(sizeof(struct mipi_dsim_device), GFP_KERNEL);
 	if (!dsim) {
@@ -597,6 +639,18 @@ static int s5p_mipi_dsi_probe(struct platform_device *pdev)
 
 	client_drv = dsim_ddi->dsim_lcd_drv;
 
+#ifdef CONFIG_SLP_DISP_DEBUG
+	for (i = 0; i < ARRAY_SIZE(device_attrs); i++) {
+		ret = device_create_file(&(pdev->dev),
+					&device_attrs[i]);
+		if (ret)
+			break;
+	}
+
+	if (ret < 0)
+		dev_err(&pdev->dev, "failed to add sysfs entries\n");
+#endif
+
 	/* initialize mipi-dsi client(lcd panel). */
 	if (client_drv && client_drv->probe)
 		client_drv->probe(dsim_ddi->dsim_lcd_dev);
@@ -706,6 +760,7 @@ static int __devexit s5p_mipi_dsi_remove(struct platform_device *pdev)
 			if (dsim_lcd_drv->remove)
 				dsim_lcd_drv->remove(dsim_ddi->dsim_lcd_dev);
 
+			list_del(&dsim_ddi->list);
 			kfree(dsim_ddi);
 		}
 	}