video: Add S3C24xx framebuffer support

Add basic framebuffer driver for the S3C24xx family of CPUs.

Signed-off-by: Marek Vasut <marex@denx.de>
Cc: Anatolij Gustschin <agust@denx.de>
Cc: Kyungmin Park <kyungmin.park@samsung.com>
Cc: Lukasz Majewski <l.majewski@samsung.com>
Cc: Minkyu Kang <mk7.kang@samsung.com>
Cc: Vladimir Zapolskiy <vz@mleia.com>
V2: Keep the Makefile sorted.
Acked-by: Anatolij Gustschin <agust@denx.de>

diff --git a/drivers/video/Makefile b/drivers/video/Makefile
index d19a1d9042b779c7d39c8e11fa3995b290138c37..9b635fc4037250537d0a141141605ad9fe79157a 100644 (file)
--- a/drivers/video/Makefile
+++ b/drivers/video/Makefile
@@ -52,6 +52,7 @@ obj-$(CONFIG_VIDEO_IPUV3) += mxc_ipuv3_fb.o ipu_common.o ipu_disp.o
 obj-$(CONFIG_VIDEO_MVEBU) += mvebu_lcd.o
 obj-$(CONFIG_VIDEO_MXS) += mxsfb.o videomodes.o
 obj-$(CONFIG_VIDEO_OMAP3) += omap3_dss.o
+obj-$(CONFIG_VIDEO_S3C) += s3c-fb.o videomodes.o
 obj-$(CONFIG_VIDEO_SANDBOX_SDL) += sandbox_sdl.o
 obj-$(CONFIG_VIDEO_SED13806) += sed13806.o
 obj-$(CONFIG_VIDEO_SM501) += sm501.o

diff --git a/drivers/video/cfb_console.c b/drivers/video/cfb_console.c
index f15c9645464ea13798a6058b9e337496da1f34ae..ef4984becb48283e5b9aee5e42220dda583b92b1 100644 (file)
--- a/drivers/video/cfb_console.c
+++ b/drivers/video/cfb_console.c
@@ -117,7 +117,7 @@
 #define VIDEO_HW_BITBLT
 #endif
 
-#ifdef CONFIG_VIDEO_MXS
+#if defined(CONFIG_VIDEO_MXS) || defined(CONFIG_VIDEO_S3C)
 #define VIDEO_FB_16BPP_WORD_SWAP
 #endif
 

diff --git a/drivers/video/s3c-fb.c b/drivers/video/s3c-fb.c
new file mode 100644 (file)
index 0000000..521eb75
--- /dev/null
+++ b/drivers/video/s3c-fb.c
@@ -0,0 +1,172 @@
+/*
+ * S3C24x0 LCD driver
+ *
+ * NOTE: Only 16/24 bpp operation with TFT LCD is supported.
+ *
+ * Copyright (C) 2014 Marek Vasut <marex@denx.de>
+ *
+ * SPDX-License-Identifier:    GPL-2.0+
+ */
+#include <common.h>
+#include <malloc.h>
+#include <video_fb.h>
+
+#include <asm/errno.h>
+#include <asm/io.h>
+#include <asm/arch/s3c24x0_cpu.h>
+
+#include "videomodes.h"
+
+static GraphicDevice panel;
+
+/* S3C requires the FB to be 4MiB aligned. */
+#define S3CFB_ALIGN                    (4 << 20)
+
+#define S3CFB_LCDCON1_CLKVAL(x)                ((x) << 8)
+#define S3CFB_LCDCON1_PNRMODE_TFT      (0x3 << 5)
+#define S3CFB_LCDCON1_BPPMODE_TFT_16BPP        (0xc << 1)
+#define S3CFB_LCDCON1_BPPMODE_TFT_24BPP        (0xd << 1)
+
+#define S3CFB_LCDCON2_VBPD(x)          ((x) << 24)
+#define S3CFB_LCDCON2_LINEVAL(x)       ((x) << 14)
+#define S3CFB_LCDCON2_VFPD(x)          ((x) << 6)
+#define S3CFB_LCDCON2_VSPW(x)          ((x) << 0)
+
+#define S3CFB_LCDCON3_HBPD(x)          ((x) << 19)
+#define S3CFB_LCDCON3_HOZVAL(x)                ((x) << 8)
+#define S3CFB_LCDCON3_HFPD(x)          ((x) << 0)
+
+#define S3CFB_LCDCON4_HSPW(x)          ((x) << 0)
+
+#define S3CFB_LCDCON5_BPP24BL          (1 << 12)
+#define S3CFB_LCDCON5_FRM565           (1 << 11)
+#define S3CFB_LCDCON5_HWSWP            (1 << 0)
+
+#define        PS2KHZ(ps)                      (1000000000UL / (ps))
+
+/*
+ * Example:
+ * setenv videomode video=ctfb:x:800,y:480,depth:16,mode:0,\
+ *            pclk:30066,le:41,ri:89,up:45,lo:12,
+ *            hs:1,vs:1,sync:100663296,vmode:0
+ */
+static void s3c_lcd_init(GraphicDevice *panel,
+                       struct ctfb_res_modes *mode, int bpp)
+{
+       uint32_t clk_divider;
+       struct s3c24x0_lcd *regs = s3c24x0_get_base_lcd();
+
+       /* Stop the controller. */
+       clrbits_le32(&regs->lcdcon1, 1);
+
+       /* Calculate clock divider. */
+       clk_divider = (get_HCLK() / PS2KHZ(mode->pixclock)) / 1000;
+       clk_divider = DIV_ROUND_UP(clk_divider, 2);
+       if (clk_divider)
+               clk_divider -= 1;
+
+       /* Program LCD configuration. */
+       switch (bpp) {
+       case 16:
+               writel(S3CFB_LCDCON1_BPPMODE_TFT_16BPP |
+                      S3CFB_LCDCON1_PNRMODE_TFT |
+                      S3CFB_LCDCON1_CLKVAL(clk_divider),
+                      &regs->lcdcon1);
+               writel(S3CFB_LCDCON5_HWSWP | S3CFB_LCDCON5_FRM565,
+                      &regs->lcdcon5);
+               break;
+       case 24:
+               writel(S3CFB_LCDCON1_BPPMODE_TFT_24BPP |
+                      S3CFB_LCDCON1_PNRMODE_TFT |
+                      S3CFB_LCDCON1_CLKVAL(clk_divider),
+                      &regs->lcdcon1);
+               writel(S3CFB_LCDCON5_BPP24BL, &regs->lcdcon5);
+               break;
+       }
+
+       writel(S3CFB_LCDCON2_LINEVAL(mode->yres - 1) |
+              S3CFB_LCDCON2_VBPD(mode->upper_margin - 1) |
+              S3CFB_LCDCON2_VFPD(mode->lower_margin - 1) |
+              S3CFB_LCDCON2_VSPW(mode->vsync_len - 1),
+              &regs->lcdcon2);
+
+       writel(S3CFB_LCDCON3_HBPD(mode->right_margin - 1) |
+              S3CFB_LCDCON3_HFPD(mode->left_margin - 1) |
+              S3CFB_LCDCON3_HOZVAL(mode->xres - 1),
+              &regs->lcdcon3);
+
+       writel(S3CFB_LCDCON4_HSPW(mode->hsync_len - 1),
+              &regs->lcdcon4);
+
+       /* Write FB address. */
+       writel(panel->frameAdrs >> 1, &regs->lcdsaddr1);
+       writel((panel->frameAdrs +
+              (mode->xres * mode->yres * panel->gdfBytesPP)) >> 1,
+              &regs->lcdsaddr2);
+       writel(mode->xres * bpp / 16, &regs->lcdsaddr3);
+
+       /* Start the controller. */
+       setbits_le32(&regs->lcdcon1, 1);
+}
+
+void *video_hw_init(void)
+{
+       int bpp = -1;
+       char *penv;
+       void *fb;
+       struct ctfb_res_modes mode;
+
+       puts("Video: ");
+
+       /* Suck display configuration from "videomode" variable */
+       penv = getenv("videomode");
+       if (!penv) {
+               puts("S3CFB: 'videomode' variable not set!\n");
+               return NULL;
+       }
+
+       bpp = video_get_params(&mode, penv);
+
+       /* fill in Graphic device struct */
+       sprintf(panel.modeIdent, "%dx%dx%d", mode.xres, mode.yres, bpp);
+
+       panel.winSizeX = mode.xres;
+       panel.winSizeY = mode.yres;
+       panel.plnSizeX = mode.xres;
+       panel.plnSizeY = mode.yres;
+
+       switch (bpp) {
+       case 24:
+               panel.gdfBytesPP = 4;
+               panel.gdfIndex = GDF_32BIT_X888RGB;
+               break;
+       case 16:
+               panel.gdfBytesPP = 2;
+               panel.gdfIndex = GDF_16BIT_565RGB;
+               break;
+       default:
+               printf("S3CFB: Invalid BPP specified! (bpp = %i)\n", bpp);
+               return NULL;
+       }
+
+       panel.memSize = mode.xres * mode.yres * panel.gdfBytesPP;
+
+       /* Allocate framebuffer */
+       fb = memalign(S3CFB_ALIGN, roundup(panel.memSize, S3CFB_ALIGN));
+       if (!fb) {
+               printf("S3CFB: Error allocating framebuffer!\n");
+               return NULL;
+       }
+
+       /* Wipe framebuffer */
+       memset(fb, 0, panel.memSize);
+
+       panel.frameAdrs = (u32)fb;
+
+       printf("%s\n", panel.modeIdent);
+
+       /* Start framebuffer */
+       s3c_lcd_init(&panel, &mode, bpp);
+
+       return (void *)&panel;
+}