Merge branch 'origin' into for-linus

Conflicts:
	MAINTAINERS

1 files changed, 77 insertions, 59 deletions

diff --git a/drivers/video/omap/dispc.c b/drivers/video/omap/dispc.c
index 148cbcc39602..80a11d078df4 100644
--- a/drivers/video/omap/dispc.c
+++ b/drivers/video/omap/dispc.c
@@ -155,6 +155,8 @@ struct resmap {
         unsigned long   *map;
 };
 
+#define MAX_IRQ_HANDLERS            4
+
 static struct {
         void __iomem    *base;
 
@@ -167,9 +169,11 @@ static struct {
 
         int             ext_mode;
 
-        unsigned long   enabled_irqs;
-        void            (*irq_callback)(void *);
-        void            *irq_callback_data;
+        struct {
+                u32     irq_mask;
+                void    (*callback)(void *);
+                void    *data;
+        } irq_handlers[MAX_IRQ_HANDLERS];
         struct completion       frame_done;
 
         int             fir_hinc[OMAPFB_PLANE_NUM];
@@ -212,9 +216,9 @@ static void enable_rfbi_mode(int enable)
         dispc_write_reg(DISPC_CONTROL, l);
 
         /* Set bypass mode in RFBI module */
-        l = __raw_readl(IO_ADDRESS(RFBI_CONTROL));
+        l = __raw_readl(OMAP2_IO_ADDRESS(RFBI_CONTROL));
         l |= enable ? 0 : (1 << 1);
-        __raw_writel(l, IO_ADDRESS(RFBI_CONTROL));
+        __raw_writel(l, OMAP2_IO_ADDRESS(RFBI_CONTROL));
 }
 
 static void set_lcd_data_lines(int data_lines)
@@ -286,7 +290,7 @@ static void setup_plane_fifo(int plane, int ext_mode)
         BUG_ON(plane > 2);
 
         l = dispc_read_reg(fsz_reg[plane]);
-        l &= FLD_MASK(0, 9);
+        l &= FLD_MASK(0, 11);
         if (ext_mode) {
                 low = l * 3 / 4;
                 high = l;
@@ -294,7 +298,7 @@ static void setup_plane_fifo(int plane, int ext_mode)
                 low = l / 4;
                 high = l * 3 / 4;
         }
-        MOD_REG_FLD(ftrs_reg[plane], FLD_MASK(16, 9) | FLD_MASK(0, 9),
+        MOD_REG_FLD(ftrs_reg[plane], FLD_MASK(16, 12) | FLD_MASK(0, 12),
                         (high << 16) | low);
 }
 
@@ -809,57 +813,74 @@ static void set_lcd_timings(void)
         panel->pixel_clock = fck / lck_div / pck_div / 1000;
 }
 
-int omap_dispc_request_irq(void (*callback)(void *data), void *data)
+static void recalc_irq_mask(void)
 {
-        int r = 0;
+        int i;
+        unsigned long irq_mask = DISPC_IRQ_MASK_ERROR;
 
-        BUG_ON(callback == NULL);
+        for (i = 0; i < MAX_IRQ_HANDLERS; i++) {
+                if (!dispc.irq_handlers[i].callback)
+                        continue;
 
-        if (dispc.irq_callback)
-                r = -EBUSY;
-        else {
-                dispc.irq_callback = callback;
-                dispc.irq_callback_data = data;
+                irq_mask |= dispc.irq_handlers[i].irq_mask;
         }
 
-        return r;
-}
-EXPORT_SYMBOL(omap_dispc_request_irq);
-
-void omap_dispc_enable_irqs(int irq_mask)
-{
         enable_lcd_clocks(1);
-        dispc.enabled_irqs = irq_mask;
-        irq_mask |= DISPC_IRQ_MASK_ERROR;
         MOD_REG_FLD(DISPC_IRQENABLE, 0x7fff, irq_mask);
         enable_lcd_clocks(0);
 }
-EXPORT_SYMBOL(omap_dispc_enable_irqs);
 
-void omap_dispc_disable_irqs(int irq_mask)
+int omap_dispc_request_irq(unsigned long irq_mask, void (*callback)(void *data),
+                           void *data)
 {
-        enable_lcd_clocks(1);
-        dispc.enabled_irqs &= ~irq_mask;
-        irq_mask &= ~DISPC_IRQ_MASK_ERROR;
-        MOD_REG_FLD(DISPC_IRQENABLE, 0x7fff, irq_mask);
-        enable_lcd_clocks(0);
+        int i;
+
+        BUG_ON(callback == NULL);
+
+        for (i = 0; i < MAX_IRQ_HANDLERS; i++) {
+                if (dispc.irq_handlers[i].callback)
+                        continue;
+
+                dispc.irq_handlers[i].irq_mask = irq_mask;
+                dispc.irq_handlers[i].callback = callback;
+                dispc.irq_handlers[i].data = data;
+                recalc_irq_mask();
+
+                return 0;
+        }
+
+        return -EBUSY;
 }
-EXPORT_SYMBOL(omap_dispc_disable_irqs);
+EXPORT_SYMBOL(omap_dispc_request_irq);
 
-void omap_dispc_free_irq(void)
+void omap_dispc_free_irq(unsigned long irq_mask, void (*callback)(void *data),
+                         void *data)
 {
-        enable_lcd_clocks(1);
-        omap_dispc_disable_irqs(DISPC_IRQ_MASK_ALL);
-        dispc.irq_callback = NULL;
-        dispc.irq_callback_data = NULL;
-        enable_lcd_clocks(0);
+        int i;
+
+        for (i = 0; i < MAX_IRQ_HANDLERS; i++) {
+                if (dispc.irq_handlers[i].callback == callback &&
+                    dispc.irq_handlers[i].data == data) {
+                        dispc.irq_handlers[i].irq_mask = 0;
+                        dispc.irq_handlers[i].callback = NULL;
+                        dispc.irq_handlers[i].data = NULL;
+                        recalc_irq_mask();
+                        return;
+                }
+        }
+
+        BUG();
 }
 EXPORT_SYMBOL(omap_dispc_free_irq);
 
 static irqreturn_t omap_dispc_irq_handler(int irq, void *dev)
 {
-        u32 stat = dispc_read_reg(DISPC_IRQSTATUS);
+        u32 stat;
+        int i = 0;
+
+        enable_lcd_clocks(1);
 
+        stat = dispc_read_reg(DISPC_IRQSTATUS);
         if (stat & DISPC_IRQ_FRAMEMASK)
                 complete(&dispc.frame_done);
 
@@ -870,11 +891,17 @@ static irqreturn_t omap_dispc_irq_handler(int irq, void *dev)
                 }
         }
 
-        if ((stat & dispc.enabled_irqs) && dispc.irq_callback)
-                dispc.irq_callback(dispc.irq_callback_data);
+        for (i = 0; i < MAX_IRQ_HANDLERS; i++) {
+                if (unlikely(dispc.irq_handlers[i].callback &&
+                             (stat & dispc.irq_handlers[i].irq_mask)))
+                        dispc.irq_handlers[i].callback(
+                                                dispc.irq_handlers[i].data);
+        }
 
         dispc_write_reg(DISPC_IRQSTATUS, stat);
 
+        enable_lcd_clocks(0);
+
         return IRQ_HANDLED;
 }
 
@@ -913,18 +940,13 @@ static void put_dss_clocks(void)
 
 static void enable_lcd_clocks(int enable)
 {
-        if (enable)
+        if (enable) {
+                clk_enable(dispc.dss_ick);
                 clk_enable(dispc.dss1_fck);
-        else
+        } else {
                 clk_disable(dispc.dss1_fck);
-}
-
-static void enable_interface_clocks(int enable)
-{
-        if (enable)
-                clk_enable(dispc.dss_ick);
-        else
                 clk_disable(dispc.dss_ick);
+        }
 }
 
 static void enable_digit_clocks(int enable)
@@ -1365,7 +1387,6 @@ static int omap_dispc_init(struct omapfb_device *fbdev, int ext_mode,
         if ((r = get_dss_clocks()) < 0)
                 goto fail0;
 
-        enable_interface_clocks(1);
         enable_lcd_clocks(1);
 
 #ifdef CONFIG_FB_OMAP_BOOTLOADER_INIT
@@ -1396,10 +1417,10 @@ 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);
+        /* Enable smart standby/idle, autoidle and wakeup */
+        l = dispc_read_reg(DISPC_SYSCONFIG);
         l &= ~((3 << 12) | (3 << 3));
-        l |= (2 << 12) | (2 << 3) | (1 << 0);
+        l |= (2 << 12) | (2 << 3) | (1 << 2) | (1 << 0);
         dispc_write_reg(DISPC_SYSCONFIG, l);
         omap_writel(1 << 0, DSS_BASE + DSS_SYSCONFIG);
 
@@ -1409,10 +1430,9 @@ static int omap_dispc_init(struct omapfb_device *fbdev, int ext_mode,
         dispc_write_reg(DISPC_CONFIG, l);
 
         l = dispc_read_reg(DISPC_IRQSTATUS);
-        dispc_write_reg(l, DISPC_IRQSTATUS);
+        dispc_write_reg(DISPC_IRQSTATUS, l);
 
-        /* Enable those that we handle always */
-        omap_dispc_enable_irqs(DISPC_IRQ_FRAMEMASK);
+        recalc_irq_mask();
 
         if ((r = request_irq(INT_24XX_DSS_IRQ, omap_dispc_irq_handler,
                            0, MODULE_NAME, fbdev)) < 0) {
@@ -1421,7 +1441,7 @@ static int omap_dispc_init(struct omapfb_device *fbdev, int ext_mode,
         }
 
         /* L3 firewall setting: enable access to OCM RAM */
-        __raw_writel(0x402000b0, IO_ADDRESS(0x680050a0));
+        __raw_writel(0x402000b0, OMAP2_IO_ADDRESS(0x680050a0));
 
         if ((r = alloc_palette_ram()) < 0)
                 goto fail2;
@@ -1469,7 +1489,6 @@ fail2:
         free_irq(INT_24XX_DSS_IRQ, fbdev);
 fail1:
         enable_lcd_clocks(0);
-        enable_interface_clocks(0);
         put_dss_clocks();
 fail0:
         iounmap(dispc.base);
@@ -1487,7 +1506,6 @@ static void omap_dispc_cleanup(void)
         cleanup_fbmem();
         free_palette_ram();
         free_irq(INT_24XX_DSS_IRQ, dispc.fbdev);
-        enable_interface_clocks(0);
         put_dss_clocks();
         iounmap(dispc.base);
 }