omapfb: Enable DISPC and DSS autoidling

Signed-off-by: Juha Yrjola <juha.yrjola@solidboot.com>

diff --git a/drivers/video/omap/dispc.c b/drivers/video/omap/dispc.c
index ecc785d362ce75013303ba37d7e2c554dfe56e65..048b8e26099f1d7c668f852455c22cb62b048f85 100644 (file)
--- a/drivers/video/omap/dispc.c
+++ b/drivers/video/omap/dispc.c
@@ -35,6 +35,9 @@
 
 #define MODULE_NAME                    "dispc"
 
+#define DSS_BASE                       0x48050000
+#define DSS_SYSCONFIG                  0x0010
+
 #define DISPC_BASE                     0x48050400
 
 /* DISPC common */
@@ -1111,6 +1114,18 @@ static int omap_dispc_init(struct omapfb_device *fbdev, int ext_mode,
                enable_digit_clocks(0);
        }
 
+       /* Enable smart idle and autoidle */
+       l = dispc_read_reg(DISPC_CONTROL);
+       l &= ~((3 << 12) | (3 << 3));
+       l |= (2 << 12) | (2 << 3) | (1 << 0);
+       dispc_write_reg(DISPC_SYSCONFIG, l);
+       omap_writel(1 << 0, DSS_BASE + DSS_SYSCONFIG);
+
+       /* Set functional clock autogating */
+       l = dispc_read_reg(DISPC_CONFIG);
+       l |= 1 << 9;
+       dispc_write_reg(DISPC_CONFIG, l);
+
        l = dispc_read_reg(DISPC_IRQSTATUS);
        dispc_write_reg(l, DISPC_IRQSTATUS);