video: mmp fb support

Add fb support for Marvell mmp display subsystem.  This driver is
configured using "buffer driver mach info".  With configured name of path,
this driver get path using using exported interface of mmp display driver.
Then this driver get overlay using configured id and operates on this
overlay to show buffers on display devices.

Signed-off-by: Zhou Zhu <zzhu3@marvell.com>
Signed-off-by: Lisa Du <cldu@marvell.com>
Cc: Guoqing Li <ligq@marvell.com>
Acked-by: Haojian Zhuang <haojian.zhuang@gmail.com>
Cc: Florian Tobias Schandinat <FlorianSchandinat@gmx.de>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>

6 files changed, 757 insertions, 1 deletions

diff --git a/drivers/video/mmp/Kconfig b/drivers/video/mmp/Kconfig
index 055433624526..6a0b0566ed32 100644
--- a/drivers/video/mmp/Kconfig
+++ b/drivers/video/mmp/Kconfig
@@ -3,3 +3,7 @@ menuconfig MMP_DISP
         depends on CPU_PXA910 || CPU_MMP2 || CPU_MMP3 || CPU_PXA988
         help
           Marvell Display Subsystem support.
+
+if MMP_DISP
+source "drivers/video/mmp/fb/Kconfig"
+endif
diff --git a/drivers/video/mmp/Makefile b/drivers/video/mmp/Makefile
index 820eb10ac2dd..fdcd833150bd 100644
--- a/drivers/video/mmp/Makefile
+++ b/drivers/video/mmp/Makefile
@@ -1 +1 @@
-obj-y += core.o
+obj-y += core.o fb/
diff --git a/drivers/video/mmp/fb/Kconfig b/drivers/video/mmp/fb/Kconfig
new file mode 100644
index 000000000000..9b0141f105f5
--- /dev/null
+++ b/drivers/video/mmp/fb/Kconfig
@@ -0,0 +1,13 @@
+if MMP_DISP
+
+config MMP_FB
+        bool "fb driver for Marvell MMP Display Subsystem"
+        depends on FB
+        select FB_CFB_FILLRECT
+        select FB_CFB_COPYAREA
+        select FB_CFB_IMAGEBLIT
+        default y
+        help
+                fb driver for Marvell MMP Display Subsystem
+
+endif
diff --git a/drivers/video/mmp/fb/Makefile b/drivers/video/mmp/fb/Makefile
new file mode 100644
index 000000000000..709fd1f76abe
--- /dev/null
+++ b/drivers/video/mmp/fb/Makefile
@@ -0,0 +1 @@
+obj-$(CONFIG_MMP_FB)  += mmpfb.o
diff --git a/drivers/video/mmp/fb/mmpfb.c b/drivers/video/mmp/fb/mmpfb.c
new file mode 100644
index 000000000000..f34a3a907f1b
--- /dev/null
+++ b/drivers/video/mmp/fb/mmpfb.c
@@ -0,0 +1,684 @@
+/*
+ * linux/drivers/video/mmp/fb/mmpfb.c
+ * Framebuffer driver for Marvell Display controller.
+ *
+ * Copyright (C) 2012 Marvell Technology Group Ltd.
+ * Authors: Zhou Zhu <zzhu3@marvell.com>
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License as published by the
+ * Free Software Foundation; either version 2 of the License, or (at your
+ * option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful, but WITHOUT
+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
+ * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
+ * more details.
+ *
+ * You should have received a copy of the GNU General Public License along with
+ * this program.  If not, see <http://www.gnu.org/licenses/>.
+ *
+ */
+#include <linux/module.h>
+#include <linux/dma-mapping.h>
+#include "mmpfb.h"
+
+static int var_to_pixfmt(struct fb_var_screeninfo *var)
+{
+        /*
+         * Pseudocolor mode?
+         */
+        if (var->bits_per_pixel == 8)
+                return PIXFMT_PSEUDOCOLOR;
+
+        /*
+         * Check for YUV422PLANAR.
+         */
+        if (var->bits_per_pixel == 16 && var->red.length == 8 &&
+                        var->green.length == 4 && var->blue.length == 4) {
+                if (var->green.offset >= var->blue.offset)
+                        return PIXFMT_YUV422P;
+                else
+                        return PIXFMT_YVU422P;
+        }
+
+        /*
+         * Check for YUV420PLANAR.
+         */
+        if (var->bits_per_pixel == 12 && var->red.length == 8 &&
+                        var->green.length == 2 && var->blue.length == 2) {
+                if (var->green.offset >= var->blue.offset)
+                        return PIXFMT_YUV420P;
+                else
+                        return PIXFMT_YVU420P;
+        }
+
+        /*
+         * Check for YUV422PACK.
+         */
+        if (var->bits_per_pixel == 16 && var->red.length == 16 &&
+                        var->green.length == 16 && var->blue.length == 16) {
+                if (var->red.offset == 0)
+                        return PIXFMT_YUYV;
+                else if (var->green.offset >= var->blue.offset)
+                        return PIXFMT_UYVY;
+                else
+                        return PIXFMT_VYUY;
+        }
+
+        /*
+         * Check for 565/1555.
+         */
+        if (var->bits_per_pixel == 16 && var->red.length <= 5 &&
+                        var->green.length <= 6 && var->blue.length <= 5) {
+                if (var->transp.length == 0) {
+                        if (var->red.offset >= var->blue.offset)
+                                return PIXFMT_RGB565;
+                        else
+                                return PIXFMT_BGR565;
+                }
+        }
+
+        /*
+         * Check for 888/A888.
+         */
+        if (var->bits_per_pixel <= 32 && var->red.length <= 8 &&
+                        var->green.length <= 8 && var->blue.length <= 8) {
+                if (var->bits_per_pixel == 24 && var->transp.length == 0) {
+                        if (var->red.offset >= var->blue.offset)
+                                return PIXFMT_RGB888PACK;
+                        else
+                                return PIXFMT_BGR888PACK;
+                }
+
+                if (var->bits_per_pixel == 32 && var->transp.offset == 24) {
+                        if (var->red.offset >= var->blue.offset)
+                                return PIXFMT_RGBA888;
+                        else
+                                return PIXFMT_BGRA888;
+                } else {
+                        if (var->red.offset >= var->blue.offset)
+                                return PIXFMT_RGB888UNPACK;
+                        else
+                                return PIXFMT_BGR888UNPACK;
+                }
+
+                /* fall through */
+        }
+
+        return -EINVAL;
+}
+
+static void pixfmt_to_var(struct fb_var_screeninfo *var, int pix_fmt)
+{
+        switch (pix_fmt) {
+        case PIXFMT_RGB565:
+                var->bits_per_pixel = 16;
+                var->red.offset = 11;   var->red.length = 5;
+                var->green.offset = 5;   var->green.length = 6;
+                var->blue.offset = 0;   var->blue.length = 5;
+                var->transp.offset = 0;  var->transp.length = 0;
+                break;
+        case PIXFMT_BGR565:
+                var->bits_per_pixel = 16;
+                var->red.offset = 0;    var->red.length = 5;
+                var->green.offset = 5;   var->green.length = 6;
+                var->blue.offset = 11;  var->blue.length = 5;
+                var->transp.offset = 0;  var->transp.length = 0;
+                break;
+        case PIXFMT_RGB888UNPACK:
+                var->bits_per_pixel = 32;
+                var->red.offset = 16;   var->red.length = 8;
+                var->green.offset = 8;   var->green.length = 8;
+                var->blue.offset = 0;   var->blue.length = 8;
+                var->transp.offset = 0;  var->transp.length = 0;
+                break;
+        case PIXFMT_BGR888UNPACK:
+                var->bits_per_pixel = 32;
+                var->red.offset = 0;    var->red.length = 8;
+                var->green.offset = 8;   var->green.length = 8;
+                var->blue.offset = 16;  var->blue.length = 8;
+                var->transp.offset = 0;  var->transp.length = 0;
+                break;
+        case PIXFMT_RGBA888:
+                var->bits_per_pixel = 32;
+                var->red.offset = 16;   var->red.length = 8;
+                var->green.offset = 8;   var->green.length = 8;
+                var->blue.offset = 0;   var->blue.length = 8;
+                var->transp.offset = 24; var->transp.length = 8;
+                break;
+        case PIXFMT_BGRA888:
+                var->bits_per_pixel = 32;
+                var->red.offset = 0;    var->red.length = 8;