drm/exynos: Add 1024x768/1280x800 HDMI resolutions
[cascardo/linux.git] / drivers / gpu / drm / exynos / exynos_mixer.c
index 0879538..1fd60bd 100644 (file)
@@ -36,7 +36,9 @@
 
 #include "exynos_drm_drv.h"
 #include "exynos_drm_crtc.h"
-#include "exynos_drm_hdmi.h"
+#include "exynos_drm_display.h"
+
+#include "exynos_hdmi.h"
 
 #include <plat/map-base.h>
 #ifdef CONFIG_EXYNOS_IOMMU
 #include <linux/of_platform.h>
 #endif
 
-#define MIXER_WIN_NR           3
-#define MIXER_DEFAULT_WIN      0
 
 #define get_mixer_context(dev) platform_get_drvdata(to_platform_device(dev))
 
+#define MIXER_WIN_NR           3
+#define MIXER_DEFAULT_WIN      0
+
 struct hdmi_win_data {
        dma_addr_t              dma_addr;
-       void __iomem            *vaddr;
        dma_addr_t              chroma_dma_addr;
-       void __iomem            *chroma_vaddr;
        uint32_t                pixel_format;
        unsigned int            bpp;
        unsigned int            crtc_x;
@@ -67,6 +68,7 @@ struct hdmi_win_data {
        unsigned int            mode_width;
        unsigned int            mode_height;
        unsigned int            scan_flags;
+       bool                    updated;
 };
 
 struct mixer_resources {
@@ -85,15 +87,30 @@ struct mixer_resources {
 };
 
 struct mixer_context {
+       struct device           *dev;
+       struct drm_device       *drm_dev;
        unsigned int            irq;
        int                     pipe;
        bool                    interlace;
+       bool                    is_mixer_powered_on;
+       bool                    enabled[MIXER_WIN_NR];
 
        struct mixer_resources  mixer_res;
        struct hdmi_win_data    win_data[MIXER_WIN_NR];
-       unsigned long event_flags;
+       unsigned long           event_flags;
+       int                     previous_dxy;
+};
+
+struct mixer_scan_range {
+       int min_res[2], max_res[2];
+       enum exynos_mixer_mode_type mode_type;
+};
+
+struct mixer_scan_adjustment {
+       int res[2], new_res[2];
 };
 
+
 /* event flags used  */
 enum mixer_status_flags {
        MXR_EVENT_VSYNC = 1,
@@ -128,7 +145,46 @@ static const u8 filter_cr_horiz_tap4[] = {
        70,     59,     48,     37,     27,     19,     11,     5,
 };
 
-static void mixer_win_reset(struct mixer_context *ctx);
+struct mixer_scan_range scan_ranges[] = {
+       {
+               .min_res = { 464, 0 },
+               .max_res = { 720, 480 },
+               .mode_type = EXYNOS_MIXER_MODE_SD_NTSC,
+       },
+       {
+               .min_res = { 464, 481 },
+               .max_res = { 720, 576 },
+               .mode_type = EXYNOS_MIXER_MODE_SD_PAL,
+       },
+       {
+               .min_res = { 1024, 0 },
+               .max_res = { 1280, 720 },
+               .mode_type = EXYNOS_MIXER_MODE_HD_720,
+       },
+       {
+               .min_res = { 1664, 0 },
+               .max_res = { 1920, 1080 },
+               .mode_type = EXYNOS_MIXER_MODE_HD_1080,
+       },
+       {
+               .min_res = { 1440, 900 },
+               .max_res = { 1440, 900 },
+               .mode_type = EXYNOS_MIXER_MODE_HD_1080,
+       },
+};
+
+struct mixer_scan_adjustment scan_adjustments[] = {
+       {
+               .res = { 1024, 768 },
+               .new_res = { 1024, 720 },
+       },
+       {
+               .res = { 1280, 800 },
+               .new_res = { 1280, 720 },
+       },
+};
+
+static void mixer_win_reset(struct mixer_context *mctx);
 
 static inline u32 vp_reg_read(struct mixer_resources *res, u32 reg_id)
 {
@@ -170,12 +226,75 @@ static inline void mixer_reg_writemask(struct mixer_resources *res,
        writel(val, res->mixer_regs + reg_id);
 }
 
-static void mixer_regs_dump(struct mixer_context *ctx)
+enum exynos_mixer_mode_type exynos_mixer_get_mode_type(int width, int height)
+{
+       int i;
+
+       /*
+        * If the mode matches an adjustment, adjust it before finding the
+        * mode type
+        */
+       for (i = 0; i < ARRAY_SIZE(scan_adjustments); i++) {
+               struct mixer_scan_adjustment *adj = &scan_adjustments[i];
+
+               if (width == adj->res[0] && height == adj->res[1]) {
+                       width = adj->new_res[0];
+                       height = adj->new_res[1];
+               }
+       }
+
+       for (i = 0; i < ARRAY_SIZE(scan_ranges); i++) {
+               struct mixer_scan_range *range = &scan_ranges[i];
+
+               if (width >= range->min_res[0] && width <= range->max_res[0]
+                && height >= range->min_res[1] && height <= range->max_res[1])
+                       return range->mode_type;
+       }
+       return EXYNOS_MIXER_MODE_INVALID;
+}
+
+static void mixer_adjust_modes(void *ctx, struct drm_connector *connector)
+{
+       int i;
+
+       for (i = 0; i < ARRAY_SIZE(scan_adjustments); i++) {
+               struct mixer_scan_adjustment *adj = &scan_adjustments[i];
+               struct drm_display_mode *t, *mode;
+               bool native_support = false;
+
+               /*
+                * Make sure the mode resulting from the adjustment is not
+                * already natively supported. This might cause us to do
+                * something stupid like choose a chopped 1280x800 resolution
+                * over native 720p.
+                */
+               list_for_each_entry_safe(mode, t, &connector->modes, head) {
+                       if (adj->new_res[0] == mode->hdisplay &&
+                           adj->new_res[1] == mode->vdisplay) {
+                               native_support = true;
+                               break;
+                       }
+               }
+               if (native_support)
+                       continue;
+
+               list_for_each_entry_safe(mode, t, &connector->modes, head) {
+                       if (adj->res[0] == mode->hdisplay &&
+                           adj->res[1] == mode->vdisplay) {
+                               mode->hdisplay = adj->new_res[0];
+                               mode->vdisplay = adj->new_res[1];
+                               break;
+                       }
+               }
+       }
+}
+
+static void mixer_regs_dump(struct mixer_context *mctx)
 {
 #define DUMPREG(reg_id) \
 do { \
        DRM_DEBUG_KMS(#reg_id " = %08x\n", \
-               (u32)readl(ctx->mixer_res.mixer_regs + reg_id)); \
+               (u32)readl(mctx->mixer_res.mixer_regs + reg_id)); \
 } while (0)
 
        DUMPREG(MXR_STATUS);
@@ -202,12 +321,12 @@ do { \
 #undef DUMPREG
 }
 
-static void vp_regs_dump(struct mixer_context *ctx)
+static void vp_regs_dump(struct mixer_context *mctx)
 {
 #define DUMPREG(reg_id) \
 do { \
        DRM_DEBUG_KMS(#reg_id " = %08x\n", \
-               (u32) readl(ctx->mixer_res.vp_regs + reg_id)); \
+               (u32) readl(mctx->mixer_res.vp_regs + reg_id)); \
 } while (0)
 
        DUMPREG(VP_ENABLE);
@@ -259,9 +378,9 @@ static void vp_default_filter(struct mixer_resources *res)
                filter_cr_horiz_tap4, sizeof filter_cr_horiz_tap4);
 }
 
-static void mixer_vsync_set_update(struct mixer_context *ctx, bool enable)
+static void mixer_vsync_set_update(struct mixer_context *mctx, bool enable)
 {
-       struct mixer_resources *res = &ctx->mixer_res;
+       struct mixer_resources *res = &mctx->mixer_res;
 
        /* block update on vsync */
        mixer_reg_writemask(res, MXR_STATUS, enable ?
@@ -272,33 +391,56 @@ static void mixer_vsync_set_update(struct mixer_context *ctx, bool enable)
                                VP_SHADOW_UPDATE_ENABLE : 0);
 }
 
-static void mixer_cfg_scan(struct mixer_context *ctx, unsigned int height)
+static void mixer_cfg_scan(struct mixer_context *mctx, u32 width, u32 height)
 {
-       struct mixer_resources *res = &ctx->mixer_res;
+       struct mixer_resources *res = &mctx->mixer_res;
+       enum exynos_mixer_mode_type mode_type;
        u32 val;
 
        /* choosing between interlace and progressive mode */
-       val = (ctx->interlace ? MXR_CFG_SCAN_INTERLACE :
+       val = (mctx->interlace ? MXR_CFG_SCAN_INTERLACE :
                                MXR_CFG_SCAN_PROGRASSIVE);
 
-       /* choosing between porper HD and SD mode */
-       if (height == 480)
+       /* choosing between proper HD and SD mode */
+       mode_type = exynos_mixer_get_mode_type(width, height);
+       switch (mode_type) {
+       case EXYNOS_MIXER_MODE_SD_NTSC:
                val |= MXR_CFG_SCAN_NTSC | MXR_CFG_SCAN_SD;
-       else if (height == 576)
+               break;
+       case EXYNOS_MIXER_MODE_SD_PAL:
                val |= MXR_CFG_SCAN_PAL | MXR_CFG_SCAN_SD;
-       else if (height == 720)
+               break;
+       case EXYNOS_MIXER_MODE_HD_720:
                val |= MXR_CFG_SCAN_HD_720 | MXR_CFG_SCAN_HD;
-       else if (height == 1080)
+               break;
+       case EXYNOS_MIXER_MODE_HD_1080:
                val |= MXR_CFG_SCAN_HD_1080 | MXR_CFG_SCAN_HD;
-       else
-               val |= MXR_CFG_SCAN_HD_720 | MXR_CFG_SCAN_HD;
+               break;
+       default:
+               DRM_ERROR("Invalid mixer config %dx%d\n", width, height);
+               return;
+       }
 
        mixer_reg_writemask(res, MXR_CFG, val, MXR_CFG_SCAN_MASK);
 }
 
-static void mixer_cfg_rgb_fmt(struct mixer_context *ctx, unsigned int height)
+static void mixer_set_layer_offset(struct mixer_context *mctx, u32 offset)
 {
-       struct mixer_resources *res = &ctx->mixer_res;
+       struct mixer_resources *res = &mctx->mixer_res;
+       int current_dxy = mixer_reg_read(res, MXR_GRAPHIC1_DXY);
+
+       if (mctx->previous_dxy != current_dxy) {
+               current_dxy += MXR_GRP_DXY_DX(offset);
+               mixer_reg_write(res, MXR_GRAPHIC1_DXY, current_dxy);
+               mctx->previous_dxy = current_dxy;
+       }
+
+       mixer_reg_write(res, MXR_GRAPHIC0_DXY, MXR_GRP_DXY_DX(offset));
+}
+
+static void mixer_cfg_rgb_fmt(struct mixer_context *mctx, unsigned int height)
+{
+       struct mixer_resources *res = &mctx->mixer_res;
        u32 val;
 
        if (height == 480) {
@@ -337,9 +479,9 @@ static void mixer_cfg_rgb_fmt(struct mixer_context *ctx, unsigned int height)
        mixer_reg_writemask(res, MXR_CFG, val, MXR_CFG_RGB_FMT_MASK);
 }
 
-static void mixer_cfg_layer(struct mixer_context *ctx, int win, bool enable)
+static void mixer_cfg_layer(struct mixer_context *mctx, int win, bool enable)
 {
-       struct mixer_resources *res = &ctx->mixer_res;
+       struct mixer_resources *res = &mctx->mixer_res;
        u32 val = enable ? ~0 : 0;
 
        switch (win) {
@@ -356,32 +498,56 @@ static void mixer_cfg_layer(struct mixer_context *ctx, int win, bool enable)
        }
 }
 
-static void mixer_run(struct mixer_context *ctx)
+static void mixer_run(struct mixer_context *mctx)
 {
-       struct mixer_resources *res = &ctx->mixer_res;
+       struct mixer_resources *res = &mctx->mixer_res;
 
        mixer_reg_writemask(res, MXR_STATUS, ~0, MXR_STATUS_REG_RUN);
 
-       mixer_regs_dump(ctx);
+       mixer_regs_dump(mctx);
 }
 
-static int mixer_wait_for_vsync(struct mixer_context *ctx)
+static int mixer_wait_for_vsync(struct mixer_context *mctx)
 {
        int ret;
 
-       ctx->event_flags |= MXR_EVENT_VSYNC;
+       mctx->event_flags |= MXR_EVENT_VSYNC;
 
-       ret = wait_event_timeout(ctx->mixer_res.event_queue,
-       ((ctx->event_flags & MXR_EVENT_VSYNC) == 0), msecs_to_jiffies(1000));
+       ret = wait_event_timeout(mctx->mixer_res.event_queue,
+       ((mctx->event_flags & MXR_EVENT_VSYNC) == 0), msecs_to_jiffies(1000));
        if (ret > 0)
                return 0;
 
        return -ETIME;
 }
 
-static void vp_video_buffer(struct mixer_context *ctx, int win)
+static int mixer_get_layer_update_count(struct mixer_context *ctx)
+{
+       struct mixer_resources *res = &ctx->mixer_res;
+       u32 val;
+
+       if (!res->is_soc_exynos5)
+               return 0;
+
+       val = mixer_reg_read(res, MXR_CFG);
+
+       return (val & MXR_CFG_LAYER_UPDATE_COUNT_MASK) >>
+                       MXR_CFG_LAYER_UPDATE_COUNT0;
+}
+
+static void mixer_layer_update(struct mixer_context *ctx)
 {
        struct mixer_resources *res = &ctx->mixer_res;
+
+       if (!res->is_soc_exynos5)
+               return;
+
+       mixer_reg_writemask(res, MXR_CFG, ~0, MXR_CFG_LAYER_UPDATE);
+}
+
+static void vp_video_buffer(struct mixer_context *mctx, int win)
+{
+       struct mixer_resources *res = &mctx->mixer_res;
        unsigned long flags;
        struct hdmi_win_data *win_data;
        unsigned int full_width, full_height, width, height;
@@ -394,7 +560,7 @@ static void vp_video_buffer(struct mixer_context *ctx, int win)
        bool crcb_mode = false;
        u32 val;
 
-       win_data = &ctx->win_data[win];
+       win_data = &mctx->win_data[win];
 
        switch (win_data->pixel_format) {
        case DRM_FORMAT_NV12MT:
@@ -440,7 +606,7 @@ static void vp_video_buffer(struct mixer_context *ctx, int win)
        }
 
        if (win_data->scan_flags & DRM_MODE_FLAG_INTERLACE) {
-               ctx->interlace = true;
+               mctx->interlace = true;
                if (tiled_mode) {
                        luma_addr[1] = luma_addr[0] + 0x40;
                        chroma_addr[1] = chroma_addr[0] + 0x40;
@@ -449,16 +615,18 @@ static void vp_video_buffer(struct mixer_context *ctx, int win)
                        chroma_addr[1] = chroma_addr[0] + full_width;
                }
        } else {
-               ctx->interlace = false;
+               mctx->interlace = false;
                luma_addr[1] = 0;
                chroma_addr[1] = 0;
        }
 
        spin_lock_irqsave(&res->reg_slock, flags);
-       mixer_vsync_set_update(ctx, false);
+       mixer_vsync_set_update(mctx, false);
+
+       mctx->enabled[win] = true;
 
        /* interlace or progressive scan mode */
-       val = (ctx->interlace ? ~0 : 0);
+       val = (mctx->interlace ? ~0 : 0);
        vp_reg_writemask(res, VP_MODE, val, VP_MODE_LINE_SKIP);
 
        /* setup format */
@@ -481,7 +649,7 @@ static void vp_video_buffer(struct mixer_context *ctx, int win)
 
        vp_reg_write(res, VP_DST_WIDTH, width);
        vp_reg_write(res, VP_DST_H_POSITION, dst_x_offset);
-       if (ctx->interlace) {
+       if (mctx->interlace) {
                vp_reg_write(res, VP_DST_HEIGHT, height / 2);
                vp_reg_write(res, VP_DST_V_POSITION, dst_y_offset / 2);
        } else {
@@ -500,20 +668,20 @@ static void vp_video_buffer(struct mixer_context *ctx, int win)
        vp_reg_write(res, VP_TOP_C_PTR, chroma_addr[0]);
        vp_reg_write(res, VP_BOT_C_PTR, chroma_addr[1]);
 
-       mixer_cfg_scan(ctx, mode_height);
-       mixer_cfg_rgb_fmt(ctx, mode_height);
-       mixer_cfg_layer(ctx, win, true);
-       mixer_run(ctx);
+       mixer_cfg_scan(mctx, mode_width, mode_height);
+       mixer_cfg_rgb_fmt(mctx, mode_height);
+       mixer_cfg_layer(mctx, win, true);
+       mixer_run(mctx);
 
-       mixer_vsync_set_update(ctx, true);
+       mixer_vsync_set_update(mctx, true);
        spin_unlock_irqrestore(&res->reg_slock, flags);
 
-       vp_regs_dump(ctx);
+       vp_regs_dump(mctx);
 }
 
-static void mixer_graph_buffer(struct mixer_context *ctx, int win)
+static void mixer_graph_buffer(struct mixer_context *mctx, int win)
 {
-       struct mixer_resources *res = &ctx->mixer_res;
+       struct mixer_resources *res = &mctx->mixer_res;
        unsigned long flags;
        struct hdmi_win_data *win_data;
        unsigned int full_width, width, height;
@@ -524,7 +692,7 @@ static void mixer_graph_buffer(struct mixer_context *ctx, int win)
        unsigned int fmt;
        u32 val;
 
-       win_data = &ctx->win_data[win];
+       win_data = &mctx->win_data[win];
 
        #define RGB565 4
        #define ARGB1555 5
@@ -566,12 +734,14 @@ static void mixer_graph_buffer(struct mixer_context *ctx, int win)
        src_y_offset = 0;
 
        if (win_data->scan_flags & DRM_MODE_FLAG_INTERLACE)
-               ctx->interlace = true;
+               mctx->interlace = true;
        else
-               ctx->interlace = false;
+               mctx->interlace = false;
 
        spin_lock_irqsave(&res->reg_slock, flags);
-       mixer_vsync_set_update(ctx, false);
+       mixer_vsync_set_update(mctx, false);
+
+       mctx->enabled[win] = true;
 
        /* setup format */
        mixer_reg_writemask(res, MXR_GRAPHIC_CFG(win),
@@ -599,19 +769,32 @@ static void mixer_graph_buffer(struct mixer_context *ctx, int win)
        /* set buffer address to mixer */
        mixer_reg_write(res, MXR_GRAPHIC_BASE(win), dma_addr);
 
-       mixer_cfg_scan(ctx, mode_height);
-       mixer_cfg_rgb_fmt(ctx, mode_height);
-       mixer_cfg_layer(ctx, win, true);
-       mixer_cfg_layer(ctx, MIXER_DEFAULT_WIN, true);
-       mixer_run(ctx);
+       mixer_cfg_scan(mctx, mode_width, mode_height);
+
+       /* Workaround 4 implementation for 1440x900 resolution support */
+       if (res->is_soc_exynos5) {
+               if (mode_width == 1440 && mode_height == 900)
+                       mixer_set_layer_offset(mctx, 224);
+       }
+
+       mixer_cfg_rgb_fmt(mctx, mode_height);
+       mixer_cfg_layer(mctx, win, true);
+       mixer_cfg_layer(mctx, MIXER_DEFAULT_WIN, true);
+
+       /* Only allow one update per vsync */
+       if (!win_data->updated)
+               mixer_layer_update(mctx);
+
+       win_data->updated = true;
+       mixer_run(mctx);
 
-       mixer_vsync_set_update(ctx, true);
+       mixer_vsync_set_update(mctx, true);
        spin_unlock_irqrestore(&res->reg_slock, flags);
 }
 
-static void vp_win_reset(struct mixer_context *ctx)
+static void vp_win_reset(struct mixer_context *mctx)
 {
-       struct mixer_resources *res = &ctx->mixer_res;
+       struct mixer_resources *res = &mctx->mixer_res;
        int tries = 100;
 
        vp_reg_write(res, VP_SRESET, VP_SRESET_PROCESSING);
@@ -626,12 +809,24 @@ static void vp_win_reset(struct mixer_context *ctx)
 
 static int mixer_enable_vblank(void *ctx, int pipe)
 {
-       struct mixer_context *mixer_ctx = ctx;
-       struct mixer_resources *res = &mixer_ctx->mixer_res;
+       struct mixer_context *mctx = ctx;
+       struct mixer_resources *res = &mctx->mixer_res;
 
-       DRM_DEBUG_KMS("[%d] %s\n", __LINE__, __func__);
+       DRM_DEBUG_KMS("pipe: %d\n", pipe);
 
-       mixer_ctx->pipe = pipe;
+       /*
+        * TODO (seanpaul): Right now, this is an expected code path since we
+        * call enable_vblank in the poweron routine; pipe might not be
+        * initialized the first time we run it. We should refactor things such
+        * that this isn't the case and we can either BUG_ON or DRM_ERROR here.
+        */
+       if (pipe < 0)
+               return -EINVAL;
+
+       if (!mctx->is_mixer_powered_on)
+               return -EPERM;
+
+       mctx->pipe = pipe;
 
        /* enable vsync interrupt */
        mixer_reg_writemask(res, MXR_INT_EN, MXR_INT_EN_VSYNC,
@@ -642,10 +837,13 @@ static int mixer_enable_vblank(void *ctx, int pipe)
 
 static void mixer_disable_vblank(void *ctx)
 {
-       struct mixer_context *mixer_ctx = ctx;
-       struct mixer_resources *res = &mixer_ctx->mixer_res;
+       struct mixer_context *mctx = ctx;
+       struct mixer_resources *res = &mctx->mixer_res;
 
-       DRM_DEBUG_KMS("[%d] %s\n", __LINE__, __func__);
+       DRM_DEBUG_KMS("pipe: %d\n", mctx->pipe);
+
+       if (!mctx->is_mixer_powered_on)
+               return;
 
        /* disable vsync interrupt */
        mixer_reg_writemask(res, MXR_INT_EN, 0, MXR_INT_EN_VSYNC);
@@ -654,12 +852,10 @@ static void mixer_disable_vblank(void *ctx)
 static void mixer_win_mode_set(void *ctx,
                              struct exynos_drm_overlay *overlay)
 {
-       struct mixer_context *mixer_ctx = ctx;
+       struct mixer_context *mctx = ctx;
        struct hdmi_win_data *win_data;
        int win;
 
-       DRM_DEBUG_KMS("[%d] %s\n", __LINE__, __func__);
-
        if (!overlay) {
                DRM_ERROR("overlay is NULL\n");
                return;
@@ -680,12 +876,10 @@ static void mixer_win_mode_set(void *ctx,
                return;
        }
 
-       win_data = &mixer_ctx->win_data[win];
+       win_data = &mctx->win_data[win];
 
        win_data->dma_addr = overlay->dma_addr[0];
-       win_data->vaddr = overlay->vaddr[0];
        win_data->chroma_dma_addr = overlay->dma_addr[1];
-       win_data->chroma_vaddr = overlay->vaddr[1];
        win_data->pixel_format = overlay->pixel_format;
        win_data->bpp = overlay->bpp;
 
@@ -707,11 +901,11 @@ static void mixer_win_mode_set(void *ctx,
 
 static void mixer_win_commit(void *ctx, int zpos)
 {
-       struct mixer_context *mixer_ctx = ctx;
-       struct mixer_resources *res = &mixer_ctx->mixer_res;
+       struct mixer_context *mctx = ctx;
+       struct mixer_resources *res = &mctx->mixer_res;
        int win = zpos;
 
-       DRM_DEBUG_KMS("[%d] %s, win: %d\n", __LINE__, __func__, win);
+       DRM_DEBUG_KMS("win: %d\n", win);
 
        if (win == DEFAULT_ZPOS)
                win = MIXER_DEFAULT_WIN;
@@ -721,24 +915,44 @@ static void mixer_win_commit(void *ctx, int zpos)
                return;
        }
 
+       if (!mctx->is_mixer_powered_on) {
+               DRM_DEBUG_KMS("not powered on\n");
+               return;
+       }
+
        if (!(res->is_soc_exynos5)) {
                if (win > 1)
-                       vp_video_buffer(mixer_ctx, win);
+                       vp_video_buffer(mctx, win);
                else
-                       mixer_graph_buffer(mixer_ctx, win);
+                       mixer_graph_buffer(mctx, win);
        }
        else
-               mixer_graph_buffer(mixer_ctx, win);
+               mixer_graph_buffer(mctx, win);
+}
+
+static void mixer_apply(void *ctx)
+{
+       struct mixer_context *mctx = ctx;
+       int i;
+
+       DRM_DEBUG_KMS("\n");
+
+       for (i = 0; i < MIXER_WIN_NR; i++) {
+               if (!mctx->enabled[i])
+                       continue;
+
+               mixer_win_commit(ctx, i);
+       }
 }
 
 static void mixer_win_disable(void *ctx, int zpos)
 {
-       struct mixer_context *mixer_ctx = ctx;
-       struct mixer_resources *res = &mixer_ctx->mixer_res;
+       struct mixer_context *mctx = ctx;
+       struct mixer_resources *res = &mctx->mixer_res;
        unsigned long flags;
        int win = zpos;
 
-       DRM_DEBUG_KMS("[%d] %s, win: %d\n", __LINE__, __func__, win);
+       DRM_DEBUG_KMS("win: %d\n", win);
 
        if (win == DEFAULT_ZPOS)
                win = MIXER_DEFAULT_WIN;
@@ -748,70 +962,42 @@ static void mixer_win_disable(void *ctx, int zpos)
                return;
        }
 
-       mixer_wait_for_vsync(mixer_ctx);
+       if (!mctx->is_mixer_powered_on)
+               return;
+
+       mixer_wait_for_vsync(mctx);
 
        spin_lock_irqsave(&res->reg_slock, flags);
-       mixer_vsync_set_update(mixer_ctx, false);
+       mixer_vsync_set_update(mctx, false);
 
-       mixer_cfg_layer(mixer_ctx, win, false);
+       mctx->enabled[win] = false;
+       mixer_cfg_layer(mctx, win, false);
 
-       mixer_vsync_set_update(mixer_ctx, true);
+       mixer_vsync_set_update(mctx, true);
 
        spin_unlock_irqrestore(&res->reg_slock, flags);
-
-       if (win == MIXER_DEFAULT_WIN) {
-               mixer_win_reset(ctx);
-               mixer_enable_vblank(ctx, mixer_ctx->pipe);
-       }
 }
 
-static struct exynos_mixer_ops mixer_ops = {
-       /* manager */
-       .enable_vblank          = mixer_enable_vblank,
-       .disable_vblank         = mixer_disable_vblank,
-
-       /* overlay */
-       .win_mode_set           = mixer_win_mode_set,
-       .win_commit             = mixer_win_commit,
-       .win_disable            = mixer_win_disable,
-};
-
 /* for pageflip event */
 static irqreturn_t mixer_irq_handler(int irq, void *arg)
 {
-       struct exynos_drm_hdmi_context *drm_hdmi_ctx = arg;
-       struct mixer_context *ctx = drm_hdmi_ctx->ctx;
-       struct mixer_resources *res = &ctx->mixer_res;
+       struct mixer_context *mctx = arg;
+       struct mixer_resources *res = &mctx->mixer_res;
        u32 val, base, shadow;
+       bool flip_complete = false;
+       int i;
 
        spin_lock(&res->reg_slock);
 
+       WARN_ON(!mctx->is_mixer_powered_on);
+
        /* read interrupt status for handling and clearing flags for VSYNC */
        val = mixer_reg_read(res, MXR_INT_STATUS);
 
        /* handling VSYNC */
        if (val & MXR_INT_STATUS_VSYNC) {
-
-               if (ctx->event_flags & MXR_EVENT_VSYNC) {
-                       DRM_DEBUG_KMS("ctx->event_flags & MXR_EVENT_VSYNC");
-
-
-                       mixer_reg_write(res, MXR_GRAPHIC_WH(1), 0);
-                       mixer_reg_write(res, MXR_GRAPHIC_SPAN(1), 0);
-                       mixer_reg_write(res, MXR_GRAPHIC_SXY(1), 0);
-                       mixer_reg_write(res, MXR_GRAPHIC_DXY(1), 0);
-
-                       ctx->event_flags &= ~MXR_EVENT_VSYNC;
-                       wake_up(&ctx->mixer_res.event_queue);
-                       goto out;
-               }
-               /* layer update mandatory for exynos5 soc,and not present
-               * in exynos4 */
-               if (res->is_soc_exynos5)
-                       mixer_reg_writemask(res, MXR_CFG, ~0, MXR_CFG_LAYER_UPDATE);
-
                /* interlace scan need to check shadow register */
-               if (ctx->interlace) {
+               if (mctx->interlace && !res->is_soc_exynos5) {
                        base = mixer_reg_read(res, MXR_GRAPHIC_BASE(0));
                        shadow = mixer_reg_read(res, MXR_GRAPHIC_BASE_S(0));
                        if (base != shadow)
@@ -823,10 +1009,23 @@ static irqreturn_t mixer_irq_handler(int irq, void *arg)
                                goto out;
                }
 
-               drm_handle_vblank(drm_hdmi_ctx->drm_dev, ctx->pipe);
-               exynos_drm_crtc_finish_pageflip(drm_hdmi_ctx->drm_dev,
-                                               ctx->pipe);
+               drm_handle_vblank(mctx->drm_dev, mctx->pipe);
+
+               /* Bail out if a layer update is pending */
+               if (mixer_get_layer_update_count(mctx))
+                       goto out;
+
+               for (i = 0; i < MIXER_WIN_NR; i++)
+                       mctx->win_data[i].updated = false;
+
+               flip_complete = true;
 
+               if (mctx->event_flags & MXR_EVENT_VSYNC) {
+                       DRM_DEBUG_KMS("mctx->event_flags & MXR_EVENT_VSYNC");
+
+                       mctx->event_flags &= ~MXR_EVENT_VSYNC;
+                       wake_up(&mctx->mixer_res.event_queue);
+               }
        }
 
 out:
@@ -840,18 +1039,23 @@ out:
 
        spin_unlock(&res->reg_slock);
 
+       if (flip_complete)
+               exynos_drm_crtc_finish_pageflip(mctx->drm_dev, mctx->pipe);
+
        return IRQ_HANDLED;
 }
 
-static void mixer_win_reset(struct mixer_context *ctx)
+static void mixer_win_reset(struct mixer_context *mctx)
 {
-       struct mixer_resources *res = &ctx->mixer_res;
+       struct mixer_resources *res = &mctx->mixer_res;
        unsigned long flags;
        u32 val; /* value stored to register */
 
+       DRM_DEBUG_KMS("\n");
+
        spin_lock_irqsave(&res->reg_slock, flags);
        mixer_reg_writemask(res, MXR_STATUS, ~0, MXR_STATUS_SOFT_RESET);
-       mixer_vsync_set_update(ctx, false);
+       mixer_vsync_set_update(mctx, false);
 
        mixer_reg_writemask(res, MXR_CFG, MXR_CFG_DST_HDMI, MXR_CFG_DST_MASK);
 
@@ -893,7 +1097,7 @@ static void mixer_win_reset(struct mixer_context *ctx)
 
        if (!(res->is_soc_exynos5)) {
                /* configuration of Video Processor for Exynos4 soc */
-               vp_win_reset(ctx);
+               vp_win_reset(mctx);
                vp_default_filter(res);
        }
 
@@ -902,17 +1106,18 @@ static void mixer_win_reset(struct mixer_context *ctx)
        mixer_reg_writemask(res, MXR_CFG, 0, MXR_CFG_GRP1_ENABLE);
        mixer_reg_writemask(res, MXR_CFG, 0, MXR_CFG_VP_ENABLE);
 
-       mixer_reg_writemask(res, MXR_INT_EN, ~0, MXR_INT_EN_ALL);
-
-       mixer_vsync_set_update(ctx, true);
+       mixer_vsync_set_update(mctx, true);
        spin_unlock_irqrestore(&res->reg_slock, flags);
 }
 
-static void mixer_resource_poweron(struct mixer_context *ctx)
+static void mixer_resource_poweron(struct mixer_context *mctx)
 {
-       struct mixer_resources *res = &ctx->mixer_res;
+       struct mixer_resources *res = &mctx->mixer_res;
+
+       DRM_DEBUG_KMS("is_mixer_powered_on: %d\n", mctx->is_mixer_powered_on);
 
-       DRM_DEBUG_KMS("[%d] %s\n", __LINE__, __func__);
+       if (mctx->is_mixer_powered_on)
+               return;
 
        clk_enable(res->mixer);
        if (!(res->is_soc_exynos5)) {
@@ -920,47 +1125,77 @@ static void mixer_resource_poweron(struct mixer_context *ctx)
                clk_enable(res->sclk_mixer);
        }
 
-       mixer_win_reset(ctx);
+       mctx->is_mixer_powered_on = true;
+
+       mixer_win_reset(mctx);
+       mixer_enable_vblank(mctx, mctx->pipe);
+       mixer_apply(mctx);
 }
 
-static void mixer_resource_poweroff(struct mixer_context *ctx)
+static void mixer_resource_poweroff(struct mixer_context *mctx)
 {
-       struct mixer_resources *res = &ctx->mixer_res;
+       struct mixer_resources *res = &mctx->mixer_res;
 
-       DRM_DEBUG_KMS("[%d] %s\n", __LINE__, __func__);
+       DRM_DEBUG_KMS("is_mixer_powered_on: %d\n", mctx->is_mixer_powered_on);
+
+       if (!mctx->is_mixer_powered_on)
+               return;
 
        clk_disable(res->mixer);
        if (!(res->is_soc_exynos5)) {
                clk_disable(res->vp);
                clk_disable(res->sclk_mixer);
        }
+       mixer_win_reset(mctx);
+       mctx->is_mixer_powered_on = false;
 }
 
-static int mixer_runtime_resume(struct device *dev)
+static int mixer_dpms(void *ctx, int mode)
 {
-       struct exynos_drm_hdmi_context *ctx = get_mixer_context(dev);
+       struct mixer_context *mctx = ctx;
 
-       DRM_DEBUG_KMS("resume - start\n");
+       DRM_DEBUG_KMS("[DPMS:%s]\n", drm_get_dpms_name(mode));
 
-       mixer_resource_poweron(ctx->ctx);
+       switch (mode) {
+       case DRM_MODE_DPMS_ON:
+               mixer_resource_poweron(mctx);
+               break;
+       case DRM_MODE_DPMS_STANDBY:
+       case DRM_MODE_DPMS_SUSPEND:
+       case DRM_MODE_DPMS_OFF:
+               mixer_resource_poweroff(mctx);
+               break;
+       default:
+               DRM_DEBUG_KMS("unknown dpms mode: %d\n", mode);
+               break;
+       }
 
        return 0;
 }
 
-static int mixer_runtime_suspend(struct device *dev)
+static int mixer_subdrv_probe(void *ctx, struct drm_device *drm_dev)
 {
-       struct exynos_drm_hdmi_context *ctx = get_mixer_context(dev);
+       struct mixer_context *mctx = ctx;
 
-       DRM_DEBUG_KMS("suspend - start\n");
+       DRM_DEBUG("[DEV:%s]\n", drm_dev->devname);
 
-       mixer_resource_poweroff(ctx->ctx);
+       mctx->drm_dev = drm_dev;
 
        return 0;
 }
 
-static const struct dev_pm_ops mixer_pm_ops = {
-       .runtime_suspend = mixer_runtime_suspend,
-       .runtime_resume  = mixer_runtime_resume,
+static struct exynos_controller_ops mixer_ops = {
+       /* manager */
+       .adjust_modes           = mixer_adjust_modes,
+       .subdrv_probe           = mixer_subdrv_probe,
+       .enable_vblank          = mixer_enable_vblank,
+       .disable_vblank         = mixer_disable_vblank,
+       .dpms                   = mixer_dpms,
+
+       /* overlay */
+       .mode_set               = mixer_win_mode_set,
+       .win_commit             = mixer_win_commit,
+       .win_disable            = mixer_win_disable,
 };
 
 #ifdef CONFIG_EXYNOS_IOMMU
@@ -968,6 +1203,8 @@ static int iommu_init(struct platform_device *pdev)
 {
        struct platform_device *pds;
 
+       DRM_DEBUG("[PDEV:%s]\n", pdev->name);
+
        pds = find_sysmmu_dt(pdev, "sysmmu");
        if (pds == NULL) {
                printk(KERN_ERR "No sysmmu found  :\n");
@@ -975,8 +1212,14 @@ static int iommu_init(struct platform_device *pdev)
        }
 
        platform_set_sysmmu(&pds->dev, &pdev->dev);
+       /*
+        * The ordering in Makefile warrants that this is initialized after
+        * FIMD, so only just ensure that it works as expected and we are
+        * reusing the mapping originally created in exynos_drm_fimd.c.
+        */
+       WARN_ON(!exynos_drm_common_mapping);
        exynos_drm_common_mapping = s5p_create_iommu_mapping(&pdev->dev,
-                       0x20000000, SZ_128M, 4, exynos_drm_common_mapping);
+                                       0, 0, 0, exynos_drm_common_mapping);
        if(exynos_drm_common_mapping == NULL) {
                printk(KERN_ERR"Failed to create iommu mapping for Mixer\n");
                return -EINVAL;
@@ -984,20 +1227,25 @@ static int iommu_init(struct platform_device *pdev)
 
        return 0;
 }
+
+static void iommu_deinit(struct platform_device *pdev)
+{
+       s5p_destroy_iommu_mapping(&pdev->dev);
+       DRM_DEBUG("released the IOMMU mapping\n");
+}
 #endif
 
 static int __devinit mixer_resources_init_exynos(
-                       struct exynos_drm_hdmi_context *ctx,
+                       struct mixer_context *mctx,
                        struct platform_device *pdev,
                        int is_exynos5)
 {
-       struct mixer_context *mixer_ctx = ctx->ctx;
        struct device *dev = &pdev->dev;
-       struct mixer_resources *mixer_res = &mixer_ctx->mixer_res;
+       struct mixer_resources *mixer_res = &mctx->mixer_res;
        struct resource *res;
        int ret;
 
-       DRM_DEBUG_KMS("Mixer resources init\n");
+       DRM_DEBUG("[PDEV:%s] is_exynos5: %d\n", pdev->name, is_exynos5);
 
        mixer_res->is_soc_exynos5 = is_exynos5;
        mixer_res->dev = dev;
@@ -1090,7 +1338,7 @@ static int __devinit mixer_resources_init_exynos(
                }
        }
 
-       ret = request_irq(res->start, mixer_irq_handler, 0, "drm_mixer", ctx);
+       ret = request_irq(res->start, mixer_irq_handler, 0, "drm_mixer", mctx);
        if (ret) {
                dev_err(dev, "request interrupt failed.\n");
                goto fail_mixer_regs;
@@ -1127,12 +1375,15 @@ fail:
        return ret;
 }
 
-static void mixer_resources_cleanup(struct mixer_context *ctx)
+static void mixer_resources_cleanup(struct device *dev,
+               struct mixer_context *mctx)
 {
-       struct mixer_resources *res = &ctx->mixer_res;
+       struct mixer_resources *res = &mctx->mixer_res;
+
+       DRM_DEBUG("\n");
 
        disable_irq(res->irq);
-       free_irq(res->irq, ctx);
+       free_irq(res->irq, dev);
 
        iounmap(res->vp_regs);
        iounmap(res->mixer_regs);
@@ -1141,45 +1392,38 @@ static void mixer_resources_cleanup(struct mixer_context *ctx)
 static int __devinit mixer_probe(struct platform_device *pdev)
 {
        struct device *dev = &pdev->dev;
-       struct exynos_drm_hdmi_context *drm_hdmi_ctx;
        struct exynos_drm_hdmi_pdata *pdata;
-       struct mixer_context *ctx;
+       struct mixer_context *mctx;
        int ret;
 
-       dev_info(dev, "probe start\n");
+       DRM_DEBUG("[PDEV:%s]\n", pdev->name);
 
-       drm_hdmi_ctx = kzalloc(sizeof(*drm_hdmi_ctx), GFP_KERNEL);
-       if (!drm_hdmi_ctx) {
-               DRM_ERROR("failed to allocate common hdmi context.\n");
-               return -ENOMEM;
-       }
+       dev_info(dev, "probe start\n");
 
-       ctx = kzalloc(sizeof(*ctx), GFP_KERNEL);
-       if (!ctx) {
+       mctx = kzalloc(sizeof(*mctx), GFP_KERNEL);
+       if (!mctx) {
                DRM_ERROR("failed to alloc mixer context.\n");
-               kfree(drm_hdmi_ctx);
                return -ENOMEM;
        }
 
-       drm_hdmi_ctx->ctx = (void *)ctx;
+       mctx->dev = &pdev->dev;
+       mctx->pipe = -1;
 
-       platform_set_drvdata(pdev, drm_hdmi_ctx);
+       platform_set_drvdata(pdev, mctx);
 
        /* Get from Platform soc deatils */
        pdata = pdev->dev.platform_data;
 
        /* acquire resources: regs, irqs, clocks */
-       ret = mixer_resources_init_exynos(drm_hdmi_ctx, pdev,pdata->is_soc_exynos5);
+       ret = mixer_resources_init_exynos(mctx, pdev, pdata->is_soc_exynos5);
        if (ret)
                goto fail;
 
-       /* attach mixer driver to common hdmi. */
-       exynos_mixer_drv_attach(drm_hdmi_ctx);
-
-       /* register specific callback point to common hdmi. */
-       exynos_mixer_ops_register(&mixer_ops);
+       mctx->is_mixer_powered_on = false;
+       pm_runtime_enable(dev);
 
-       mixer_resource_poweron(ctx);
+       exynos_display_attach_controller(EXYNOS_DRM_DISPLAY_TYPE_MIXER,
+                       &mixer_ops, mctx);
 
        return 0;
 
@@ -1192,14 +1436,20 @@ fail:
 static int mixer_remove(struct platform_device *pdev)
 {
        struct device *dev = &pdev->dev;
-       struct exynos_drm_hdmi_context *drm_hdmi_ctx =
-                                       platform_get_drvdata(pdev);
-       struct mixer_context *ctx = drm_hdmi_ctx->ctx;
+       struct mixer_context *mctx = platform_get_drvdata(pdev);
+
+       DRM_DEBUG("[PDEV:%s]\n", pdev->name);
 
        dev_info(dev, "remove successful\n");
 
-       mixer_resource_poweroff(ctx);
-       mixer_resources_cleanup(ctx);
+       mixer_resource_poweroff(mctx);
+       mixer_resources_cleanup(dev, mctx);
+
+#ifdef CONFIG_EXYNOS_IOMMU
+       iommu_deinit(pdev);
+#endif
+
+       kfree(mctx);
 
        return 0;
 }
@@ -1208,7 +1458,6 @@ struct platform_driver mixer_driver = {
        .driver = {
                .name = "s5p-mixer",
                .owner = THIS_MODULE,
-               .pm = &mixer_pm_ops,
        },
        .probe = mixer_probe,
        .remove = __devexit_p(mixer_remove),