staging: drm/imx: ipu-dc: add 24-bit GBR support to DC

[karo-tx-linux.git] / drivers / staging / imx-drm / ipu-v3 / ipu-dc.c

diff --git a/drivers/staging/imx-drm/ipu-v3/ipu-dc.c b/drivers/staging/imx-drm/ipu-v3/ipu-dc.c
index 93c7579417be753081aa9be5d6c87d8fc79d5c65..fad50576cd7cd1d431c4bee668bae1871c1867bd 100644 (file)
--- a/drivers/staging/imx-drm/ipu-v3/ipu-dc.c
+++ b/drivers/staging/imx-drm/ipu-v3/ipu-dc.c
@@ -20,6 +20,7 @@
 #include <linux/delay.h>
 #include <linux/io.h>
 
+#include "../imx-drm.h"
 #include "imx-ipu-v3.h"
 #include "ipu-prv.h"
 
@@ -86,6 +87,7 @@ struct ipu_dc_priv;
 enum ipu_dc_map {
        IPU_DC_MAP_RGB24,
        IPU_DC_MAP_RGB565,
+       IPU_DC_MAP_GBR24, /* TVEv2 */
 };
 
 struct ipu_dc {
@@ -136,6 +138,8 @@ static int ipu_pixfmt_to_map(u32 fmt)
                return IPU_DC_MAP_RGB24;
        case V4L2_PIX_FMT_RGB565:
                return IPU_DC_MAP_RGB565;
+       case IPU_PIX_FMT_GBR24:
+               return IPU_DC_MAP_GBR24;
        default:
                return -EINVAL;
        }
@@ -364,6 +368,12 @@ int ipu_dc_init(struct ipu_soc *ipu, struct device *dev,
        ipu_dc_map_config(priv, IPU_DC_MAP_RGB565, 1, 10, 0xfc); /* green */
        ipu_dc_map_config(priv, IPU_DC_MAP_RGB565, 2, 15, 0xf8); /* red */
 
+       /* gbr24 */
+       ipu_dc_map_clear(priv, IPU_DC_MAP_GBR24);
+       ipu_dc_map_config(priv, IPU_DC_MAP_GBR24, 2, 15, 0xff); /* green */
+       ipu_dc_map_config(priv, IPU_DC_MAP_GBR24, 1, 7, 0xff); /* blue */
+       ipu_dc_map_config(priv, IPU_DC_MAP_GBR24, 0, 23, 0xff); /* red */
+
        return 0;
 }