int s3cfb_set_buffer_address(struct s3cfb_global *ctrl, int id)
{
struct fb_fix_screeninfo *fix = &ctrl->fb[id]->fix;
struct fb_var_screeninfo *var = &ctrl->fb[id]->var;
struct s3c_platform_fb *pdata = to_fb_plat(ctrl->dev);
dma_addr_t start_addr = 0, end_addr = 0;
u32 shw;
if (fix->smem_start) {
start_addr = fix->smem_start + (var->xres_virtual *
(var->bits_per_pixel / 8) * var->yoffset);
end_addr = start_addr + fix->line_length * var->yres;
}
if (pdata->hw_ver == 0x62) {
shw = readl(ctrl->regs + S3C_WINSHMAP);
shw |= S3C_WINSHMAP_PROTECT(id);
writel(shw, ctrl->regs + S3C_WINSHMAP);
}
writel(start_addr, ctrl->regs + S3C_VIDADDR_START0(id));
writel(end_addr, ctrl->regs + S3C_VIDADDR_END0(id));
if (pdata->hw_ver == 0x62) {
shw = readl(ctrl->regs + S3C_WINSHMAP);
shw &= ~(S3C_WINSHMAP_PROTECT(id));
writel(shw, ctrl->regs + S3C_WINSHMAP);
}
dev_dbg(ctrl->dev, "[fb%d] start_addr: 0x%08x, end_addr: 0x%08x\n",
id, start_addr, end_addr);
return 0;
}
int s3cfb_set_window_position(struct s3cfb_global *ctrl, int id)
{
struct fb_var_screeninfo *var = &ctrl->fb[id]->var;
struct s3cfb_window *win = ctrl->fb[id]->par;
u32 cfg, shw;
shw = readl(ctrl->regs + S3C_WINSHMAP);
shw |= S3C_WINSHMAP_PROTECT(id);
writel(shw, ctrl->regs + S3C_WINSHMAP);
cfg = S3C_VIDOSD_LEFT_X(win->x) | S3C_VIDOSD_TOP_Y(win->y);
writel(cfg, ctrl->regs + S3C_VIDOSD_A(id));
cfg = S3C_VIDOSD_RIGHT_X(win->x + var->xres - 1) |
S3C_VIDOSD_BOTTOM_Y(win->y + var->yres - 1);
writel(cfg, ctrl->regs + S3C_VIDOSD_B(id));
shw = readl(ctrl->regs + S3C_WINSHMAP);
shw &= ~(S3C_WINSHMAP_PROTECT(id));
writel(shw, ctrl->regs + S3C_WINSHMAP);
dev_dbg(ctrl->dev, "[fb%d] offset: (%d, %d, %d, %d)\n", id,
win->x, win->y, win->x + var->xres - 1, win->y + var->yres - 1);
return 0;
}
int s3cfb_set_buffer_size(struct s3cfb_global *ctrl, int id)
{
struct s3c_platform_fb *pdata = to_fb_plat(ctrl->dev);
struct fb_var_screeninfo *var = &ctrl->fb[id]->var;
u32 offset = (var->xres_virtual - var->xres) * var->bits_per_pixel / 8;
u32 cfg = 0;
u32 shw;
cfg = S3C_VIDADDR_PAGEWIDTH(var->xres * var->bits_per_pixel / 8);
cfg |= S3C_VIDADDR_OFFSIZE(offset);
if ((pdata->hw_ver == 0x62) || (pdata->hw_ver == 0x70)) {
shw = readl(ctrl->regs + S3C_WINSHMAP);
shw |= S3C_WINSHMAP_PROTECT(id);
writel(shw, ctrl->regs + S3C_WINSHMAP);
}
writel(cfg, ctrl->regs + S3C_VIDADDR_SIZE(id));
if ((pdata->hw_ver == 0x62) || (pdata->hw_ver == 0x70)) {
shw = readl(ctrl->regs + S3C_WINSHMAP);
shw &= ~(S3C_WINSHMAP_PROTECT(id));
writel(shw, ctrl->regs + S3C_WINSHMAP);
}
return 0;
}
int s3cfb_set_alpha_blending(struct s3cfb_global *ctrl, int id)
{
struct s3c_platform_fb *pdata = to_fb_plat(ctrl->dev);
struct s3cfb_window *win = ctrl->fb[id]->par;
struct s3cfb_alpha *alpha = &win->alpha;
u32 avalue = 0, cfg;
u32 shw;
if (id == 0) {
dev_err(ctrl->dev, "[fb%d] does not support alpha blending\n",
id);
return -EINVAL;
}
if ((pdata->hw_ver == 0x62) || (pdata->hw_ver == 0x70)) {
shw = readl(ctrl->regs + S3C_WINSHMAP);
shw |= S3C_WINSHMAP_PROTECT(id);
writel(shw, ctrl->regs + S3C_WINSHMAP);
}
cfg = readl(ctrl->regs + S3C_WINCON(id));
cfg &= ~(S3C_WINCON_BLD_MASK | S3C_WINCON_ALPHA_SEL_MASK);
if (alpha->mode == PIXEL_BLENDING) {
dev_dbg(ctrl->dev, "[fb%d] alpha mode: pixel blending\n", id);
/* fixing to DATA[31:24] for alpha value */
cfg |= (S3C_WINCON_BLD_PIXEL | S3C_WINCON_ALPHA1_SEL);
} else {
dev_dbg(ctrl->dev, "[fb%d] alpha mode: plane %d blending\n",
id, alpha->channel);
cfg |= S3C_WINCON_BLD_PLANE;
if (alpha->channel == 0) {
cfg |= S3C_WINCON_ALPHA0_SEL;
avalue = (alpha->value << S3C_VIDOSD_ALPHA0_SHIFT);
} else {
cfg |= S3C_WINCON_ALPHA1_SEL;
avalue = (alpha->value << S3C_VIDOSD_ALPHA1_SHIFT);
}
}
writel(cfg, ctrl->regs + S3C_WINCON(id));
writel(avalue, ctrl->regs + S3C_VIDOSD_C(id));
if ((pdata->hw_ver == 0x62) || (pdata->hw_ver == 0x70)) {
shw = readl(ctrl->regs + S3C_WINSHMAP);
shw &= ~(S3C_WINSHMAP_PROTECT(id));
writel(shw, ctrl->regs + S3C_WINSHMAP);
}
return 0;
}
int s3cfb_set_oneshot(struct s3cfb_global *ctrl, int id)
{
/* s3cfb_set_window_position */
struct s3c_platform_fb *pdata = to_fb_plat(ctrl->dev);
struct fb_var_screeninfo *var = &ctrl->fb[id]->var;
struct s3cfb_window *win = ctrl->fb[id]->par;
u32 cfg, shw;
u32 offset = (var->xres_virtual - var->xres) * var->bits_per_pixel / 8;
/* Shadow Register Protection */
if ((pdata->hw_ver == 0x62) || (pdata->hw_ver == 0x70)) {
shw = readl(ctrl->regs + S3C_WINSHMAP);
shw |= S3C_WINSHMAP_PROTECT(id);
writel(shw, ctrl->regs + S3C_WINSHMAP);
}
cfg = S3C_VIDOSD_LEFT_X(win->x) | S3C_VIDOSD_TOP_Y(win->y);
writel(cfg, ctrl->regs + S3C_VIDOSD_A(id));
cfg = S3C_VIDOSD_RIGHT_X(win->x + var->xres - 1) |
S3C_VIDOSD_BOTTOM_Y(win->y + var->yres - 1);
writel(cfg, ctrl->regs + S3C_VIDOSD_B(id));
dev_dbg(ctrl->dev, "[fb%d] offset: (%d, %d, %d, %d)\n", id,
win->x, win->y, win->x + var->xres - 1, win->y + var->yres - 1);
/* s3cfb_set_window_size */
if (id <= 2) {
cfg = S3C_VIDOSD_SIZE(var->xres * var->yres);
if (id == 0)
writel(cfg, ctrl->regs + S3C_VIDOSD_C(id));
else
writel(cfg, ctrl->regs + S3C_VIDOSD_D(id));
dev_dbg(ctrl->dev, "[fb%d] resolution: %d x %d\n", id,
var->xres, var->yres);
}
/* s3cfb_set_buffer_size */
cfg = S3C_VIDADDR_PAGEWIDTH(var->xres * var->bits_per_pixel / 8);
cfg |= S3C_VIDADDR_OFFSIZE(offset);
writel(cfg, ctrl->regs + S3C_VIDADDR_SIZE(id));
/* Shadow Register Un-Protection */
if ((pdata->hw_ver == 0x62) || (pdata->hw_ver == 0x70)) {
shw = readl(ctrl->regs + S3C_WINSHMAP);
shw &= ~(S3C_WINSHMAP_PROTECT(id));
writel(shw, ctrl->regs + S3C_WINSHMAP);
}
return 0;
}
int s3cfb_set_chroma_key(struct s3cfb_global *ctrl, int id)
{
struct s3c_platform_fb *pdata = to_fb_plat(ctrl->dev);
struct s3cfb_window *win = ctrl->fb[id]->par;
struct s3cfb_chroma *chroma = &win->chroma;
u32 cfg = 0;
u32 shw;
if (id == 0) {
dev_err(ctrl->dev, "[fb%d] does not support chroma key\n", id);
return -EINVAL;
}
cfg = (S3C_KEYCON0_KEYBLEN_DISABLE | S3C_KEYCON0_DIRCON_MATCH_FG);
if (chroma->enabled)
cfg |= S3C_KEYCON0_KEY_ENABLE;
if ((pdata->hw_ver == 0x62) || (pdata->hw_ver == 0x70)) {
shw = readl(ctrl->regs + S3C_WINSHMAP);
shw |= S3C_WINSHMAP_PROTECT(id);
writel(shw, ctrl->regs + S3C_WINSHMAP);
}
writel(cfg, ctrl->regs + S3C_KEYCON(id));
cfg = S3C_KEYCON1_COLVAL(chroma->key);
writel(cfg, ctrl->regs + S3C_KEYVAL(id));
if ((pdata->hw_ver == 0x62) || (pdata->hw_ver == 0x70)) {
shw = readl(ctrl->regs + S3C_WINSHMAP);
shw &= ~(S3C_WINSHMAP_PROTECT(id));
writel(shw, ctrl->regs + S3C_WINSHMAP);
}
dev_dbg(ctrl->dev, "[fb%d] chroma key: 0x%08x, %s\n", id, cfg,
chroma->enabled ? "enabled" : "disabled");
return 0;
}
int s3cfb_set_buffer_address(struct s3cfb_global *ctrl, int id)
{
struct fb_fix_screeninfo *fix = &ctrl->fb[id]->fix;
struct fb_var_screeninfo *var = &ctrl->fb[id]->var;
struct s3c_platform_fb *pdata = to_fb_plat(ctrl->dev);
dma_addr_t start_addr = 0, end_addr = 0;
u32 shw;
if (fix->smem_start) {
// namko: Page-align for odd resolutions.
// This works as long as yoffset is a multiple of yres.
unsigned int frame_size = ALIGN(fix->line_length * var->yres, PAGE_SIZE);
start_addr = fix->smem_start + (var->yoffset / var->yres) * frame_size;
end_addr = start_addr + fix->line_length * var->yres;
}
if (pdata->hw_ver == 0x62) {
shw = readl(ctrl->regs + S3C_WINSHMAP);
shw |= S3C_WINSHMAP_PROTECT(id);
writel(shw, ctrl->regs + S3C_WINSHMAP);
}
writel(start_addr, ctrl->regs + S3C_VIDADDR_START0(id));
writel(end_addr, ctrl->regs + S3C_VIDADDR_END0(id));
if (pdata->hw_ver == 0x62) {
shw = readl(ctrl->regs + S3C_WINSHMAP);
shw &= ~(S3C_WINSHMAP_PROTECT(id));
writel(shw, ctrl->regs + S3C_WINSHMAP);
}
dev_dbg(ctrl->dev, "[fb%d] start_addr: 0x%08x, end_addr: 0x%08x\n",
id, start_addr, end_addr);
return 0;
}
int s3cfb_set_oneshot(struct s3cfb_global *ctrl, int id)
{
struct s3c_platform_fb *pdata = to_fb_plat(ctrl->dev);
struct fb_var_screeninfo *var = &ctrl->fb[id]->var;
struct fb_fix_screeninfo *fix = &ctrl->fb[id]->fix;
struct s3cfb_window *win = ctrl->fb[id]->par;
u32 cfg, shw;
u32 offset = (var->xres_virtual - var->xres) * var->bits_per_pixel / 8;
dma_addr_t start_addr = 0, end_addr = 0;
/* Shadow Register Protection */
if ((pdata->hw_ver == 0x62) || (pdata->hw_ver == 0x70)) {
shw = readl(ctrl->regs + S3C_WINSHMAP);
shw |= S3C_WINSHMAP_PROTECT(id);
writel(shw, ctrl->regs + S3C_WINSHMAP);
}
/* s3cfb_set_window_position */
cfg = S3C_VIDOSD_LEFT_X(win->x) | S3C_VIDOSD_TOP_Y(win->y);
writel(cfg, ctrl->regs + S3C_VIDOSD_A(id));
cfg = S3C_VIDOSD_RIGHT_X(win->x + var->xres - 1) |
S3C_VIDOSD_BOTTOM_Y(win->y + var->yres - 1);
writel(cfg, ctrl->regs + S3C_VIDOSD_B(id));
dev_dbg(ctrl->dev, "[fb%d] offset: (%d, %d, %d, %d)\n", id,
win->x, win->y, win->x + var->xres - 1, win->y + var->yres - 1);
/* s3cfb_set_buffer_address */
if (fix->smem_start) {
start_addr = fix->smem_start + ((var->xres_virtual *
var->yoffset + var->xoffset) *
(var->bits_per_pixel / 8));
end_addr = start_addr + fix->line_length * var->yres;
}
writel(start_addr, ctrl->regs + S3C_VIDADDR_START0(id));
writel(end_addr, ctrl->regs + S3C_VIDADDR_END0(id));
dev_dbg(ctrl->dev, "[fb%d] start_addr: 0x%08x, end_addr: 0x%08x\n",
id, start_addr, end_addr);
/* s3cfb_set_window_size */
if (id <= 2) {
cfg = S3C_VIDOSD_SIZE(var->xres * var->yres);
if (id == 0)
writel(cfg, ctrl->regs + S3C_VIDOSD_C(id));
else
writel(cfg, ctrl->regs + S3C_VIDOSD_D(id));
dev_dbg(ctrl->dev, "[fb%d] resolution: %d x %d\n", id,
var->xres, var->yres);
}
/* s3cfb_set_buffer_size */
cfg = S3C_VIDADDR_PAGEWIDTH(var->xres * var->bits_per_pixel / 8);
cfg |= S3C_VIDADDR_OFFSIZE(offset);
writel(cfg, ctrl->regs + S3C_VIDADDR_SIZE(id));
/* Shadow Register Un-Protection */
if ((pdata->hw_ver == 0x62) || (pdata->hw_ver == 0x70)) {
shw = readl(ctrl->regs + S3C_WINSHMAP);
shw &= ~(S3C_WINSHMAP_PROTECT(id));
writel(shw, ctrl->regs + S3C_WINSHMAP);
}
return 0;
}
int s3cfb_set_window_control(struct s3cfb_global *ctrl, int id)
{
struct s3c_platform_fb *pdata = to_fb_plat(ctrl->dev);
struct fb_info *fb = ctrl->fb[id];
struct fb_var_screeninfo *var = &fb->var;
struct s3cfb_window *win = fb->par;
u32 cfg;
u32 shw;
if ((pdata->hw_ver == 0x62) || (pdata->hw_ver == 0x70)) {
shw = readl(ctrl->regs + S3C_WINSHMAP);
shw |= S3C_WINSHMAP_PROTECT(id);
writel(shw, ctrl->regs + S3C_WINSHMAP);
}
cfg = readl(ctrl->regs + S3C_WINCON(id));
cfg &= ~(S3C_WINCON_BITSWP_ENABLE | S3C_WINCON_BYTESWP_ENABLE |
S3C_WINCON_HAWSWP_ENABLE | S3C_WINCON_WSWP_ENABLE |
S3C_WINCON_BURSTLEN_MASK | S3C_WINCON_BPPMODE_MASK |
S3C_WINCON_INRGB_MASK | S3C_WINCON_DATAPATH_MASK);
if (win->path != DATA_PATH_DMA) {
dev_dbg(ctrl->dev, "[fb%d] data path: fifo\n", id);
cfg |= S3C_WINCON_DATAPATH_LOCAL;
if (win->path == DATA_PATH_FIFO) {
cfg |= S3C_WINCON_INRGB_RGB;
cfg |= S3C_WINCON_BPPMODE_24BPP_888;
} else if (win->path == DATA_PATH_IPC) {
cfg |= S3C_WINCON_INRGB_YUV;
cfg |= S3C_WINCON_BPPMODE_24BPP_888;
}
if (id == 1) {
cfg &= ~(S3C_WINCON1_LOCALSEL_MASK |
S3C_WINCON1_VP_ENABLE);
if (win->local_channel == 0) {
cfg |= S3C_WINCON1_LOCALSEL_FIMC1;
} else {
cfg |= (S3C_WINCON1_LOCALSEL_VP |
S3C_WINCON1_VP_ENABLE);
}
}
} else {
dev_dbg(ctrl->dev, "[fb%d] data path: dma\n", id);
cfg |= S3C_WINCON_DATAPATH_DMA;
if (fb->var.bits_per_pixel == 16 && pdata->swap & FB_SWAP_HWORD)
cfg |= S3C_WINCON_HAWSWP_ENABLE;
if (fb->var.bits_per_pixel == 32 && pdata->swap & FB_SWAP_WORD)
cfg |= S3C_WINCON_WSWP_ENABLE;
/* dma burst */
if (win->dma_burst == 4)
cfg |= S3C_WINCON_BURSTLEN_4WORD;
else if (win->dma_burst == 8)
cfg |= S3C_WINCON_BURSTLEN_8WORD;
else
cfg |= S3C_WINCON_BURSTLEN_16WORD;
/* bpp mode set */
switch (fb->var.bits_per_pixel) {
case 16:
if (var->transp.length == 1) {
dev_dbg(ctrl->dev,
"[fb%d] bpp mode: A1-R5-G5-B5\n", id);
cfg |= S3C_WINCON_BPPMODE_16BPP_A555;
} else if (var->transp.length == 4) {
dev_dbg(ctrl->dev,
"[fb%d] bpp mode: A4-R4-G4-B4\n", id);
cfg |= S3C_WINCON_BPPMODE_16BPP_A444;
} else {
dev_dbg(ctrl->dev,
"[fb%d] bpp mode: R5-G6-B5\n", id);
cfg |= S3C_WINCON_BPPMODE_16BPP_565;
}
break;
case 24: /* packed 24 bpp: nothing to do for 6.x fimd */
break;
case 32:
if (var->transp.length == 0) {
dev_dbg(ctrl->dev,
"[fb%d] bpp mode: R8-G8-B8\n", id);
cfg |= S3C_WINCON_BPPMODE_24BPP_888;
} else {
dev_dbg(ctrl->dev,
"[fb%d] bpp mode: A8-R8-G8-B8\n", id);
cfg |= S3C_WINCON_BPPMODE_32BPP;
}
break;
}
}
writel(cfg, ctrl->regs + S3C_WINCON(id));
if ((pdata->hw_ver == 0x62) || (pdata->hw_ver == 0x70)) {
shw = readl(ctrl->regs + S3C_WINSHMAP);
shw &= ~(S3C_WINSHMAP_PROTECT(id));
writel(shw, ctrl->regs + S3C_WINSHMAP);
}
return 0;
}
