static int win0_set_par(struct lcdc_device *lcdc_dev,
struct fb_dsp_info *fb_info,
vidinfo_t *vid)
{
struct rk_lcdc_win win;
struct rk_screen *screen = lcdc_dev->screen;
memset(&win, 0, sizeof(struct rk_lcdc_win));
rk_fb_vidinfo_to_win(fb_info, &win);
//win.csc_mode = rk3368_lcdc_csc_mode(lcdc_dev, fb_info, vid);
if (fb_info->yaddr)
win.state = 1;
else
win.state = 0;
win.mirror_en = 0;
win.area[0].dsp_stx = dsp_x_pos(win.mirror_en, screen, win.area);
win.area[0].dsp_sty = dsp_y_pos(win.mirror_en, screen, win.area);
rk3288_lcdc_calc_scl_fac(&win, screen);
switch (fb_info->format) {
case ARGB888:
win.area[0].y_vir_stride = v_ARGB888_VIRWIDTH(fb_info->xvir);
break;
case RGB888:
win.area[0].y_vir_stride = v_RGB888_VIRWIDTH(fb_info->xvir);
break;
case RGB565:
win.area[0].y_vir_stride = v_RGB565_VIRWIDTH(fb_info->xvir);
break;
default:
win.area[0].y_vir_stride = v_RGB888_VIRWIDTH(fb_info->xvir);
break;
}
rk3288_win_0_1_reg_update(lcdc_dev, &win, fb_info->layer_id);
lcdc_writel(lcdc_dev, WIN0_YRGB_MST, fb_info->yaddr);
#if 0
lcdc_writel(lcdc_dev, WIN0_SCL_FACTOR_YRGB,
v_WIN0_HS_FACTOR_YRGB(0x1000) |
v_WIN0_VS_FACTOR_YRGB(0x1000));
lcdc_writel(lcdc_dev, WIN0_SCL_FACTOR_CBR,
v_WIN0_HS_FACTOR_CBR(0x1000) |
v_WIN0_VS_FACTOR_CBR(0x1000));
msk = m_WIN0_RB_SWAP | m_WIN0_ALPHA_SWAP | m_WIN0_LB_MODE |
m_WIN0_DATA_FMT | m_WIN0_EN;
val = v_WIN0_RB_SWAP(0) | v_WIN0_ALPHA_SWAP(0) | v_WIN0_LB_MODE(5) |
v_WIN0_DATA_FMT(fb_info->format) | v_WIN0_EN(1);
lcdc_msk_reg(lcdc_dev, WIN0_CTRL0, msk, val);
msk = m_WIN0_CBR_VSU_MODE | m_WIN0_YRGB_VSU_MODE;
val = v_WIN0_CBR_VSU_MODE(1) | v_WIN0_YRGB_VSU_MODE(1);
lcdc_msk_reg(lcdc_dev, WIN0_CTRL1, msk, val);
val = v_WIN0_ACT_WIDTH(fb_info->xact) |
v_WIN0_ACT_HEIGHT(fb_info->yact);
lcdc_writel(lcdc_dev, WIN0_ACT_INFO, val);
val = v_WIN0_DSP_XST(fb_info->xpos + vid->vl_hspw + vid->vl_hbpd) |
v_WIN0_DSP_YST(fb_info->ypos + vid->vl_vspw + vid->vl_vbpd);
lcdc_writel(lcdc_dev, WIN0_DSP_ST, val);
val = v_WIN0_DSP_WIDTH(fb_info->xsize) | v_WIN0_DSP_HEIGHT(fb_info->ysize);
lcdc_writel(lcdc_dev, WIN0_DSP_INFO, val);
msk = m_WIN0_COLOR_KEY_EN | m_WIN0_COLOR_KEY;
val = v_WIN0_COLOR_KEY_EN(0) | v_WIN0_COLOR_KEY(0);
lcdc_msk_reg(lcdc_dev, WIN0_COLOR_KEY, msk, val);
if(fb_info->xsize > 2560) {
lcdc_msk_reg(lcdc_dev, WIN0_CTRL0, m_WIN0_LB_MODE,
v_WIN0_LB_MODE(LB_RGB_3840X2));
} else if(fb_info->xsize > 1920) {
lcdc_msk_reg(lcdc_dev, WIN0_CTRL0, m_WIN0_LB_MODE,
v_WIN0_LB_MODE(LB_RGB_2560X4));
} else if(fb_info->xsize > 1280){
lcdc_msk_reg(lcdc_dev, WIN0_CTRL0, m_WIN0_LB_MODE,
v_WIN0_LB_MODE(LB_RGB_1920X5));
} else {
lcdc_msk_reg(lcdc_dev, WIN0_CTRL0, m_WIN0_LB_MODE,
v_WIN0_LB_MODE(LB_RGB_1280X8));
}
switch (fb_info->format) {
case ARGB888:
lcdc_writel(lcdc_dev, WIN0_VIR, v_ARGB888_VIRWIDTH(fb_info->xvir));
break;
case RGB888:
lcdc_writel(lcdc_dev, WIN0_VIR, v_RGB888_VIRWIDTH(fb_info->xvir));
break;
case RGB565:
lcdc_writel(lcdc_dev, WIN0_VIR, v_RGB565_VIRWIDTH(fb_info->xvir));
break;
case YUV422:
case YUV420:
lcdc_writel(lcdc_dev, WIN0_VIR, v_YUV_VIRWIDTH(fb_info->xvir));
if(fb_info->xsize > 1280) {
lcdc_msk_reg(lcdc_dev, WIN0_CTRL0, m_WIN0_LB_MODE,
v_WIN0_LB_MODE(LB_YUV_3840X5));
} else {
lcdc_msk_reg(lcdc_dev, WIN0_CTRL0, m_WIN0_LB_MODE,
v_WIN0_LB_MODE(LB_YUV_2560X8));
}
break;
default:
lcdc_writel(lcdc_dev, WIN0_VIR, v_RGB888_VIRWIDTH(fb_info->xvir));
break;
}
lcdc_writel(lcdc_dev, WIN0_YRGB_MST, fb_info->yaddr);
#endif
return 0;
}
static int win0_set_par(struct rk3188_lcdc_device *lcdc_dev,rk_screen *screen,
struct layer_par *par )
{
u32 xact, yact, xvir, yvir, xpos, ypos;
u32 ScaleYrgbX = 0x1000;
u32 ScaleYrgbY = 0x1000;
u32 ScaleCbrX = 0x1000;
u32 ScaleCbrY = 0x1000;
u8 fmt_cfg =0 ; //data format register config value
xact = par->xact; //active (origin) picture window width/height
yact = par->yact;
xvir = par->xvir; // virtual resolution
yvir = par->yvir;
xpos = par->xpos+screen->left_margin + screen->hsync_len;
ypos = par->ypos+screen->upper_margin + screen->vsync_len;
ScaleYrgbX = CalScale(xact, par->xsize); //both RGB and yuv need this two factor
ScaleYrgbY = CalScale(yact, par->ysize);
switch (par->format)
{
case ARGB888:
case XBGR888:
case ABGR888:
fmt_cfg = 0;
break;
case RGB888:
fmt_cfg = 1;
break;
case RGB565:
fmt_cfg = 2;
break;
case YUV422:// yuv422
fmt_cfg = 5;
ScaleCbrX = CalScale((xact/2), par->xsize);
ScaleCbrY = CalScale(yact, par->ysize);
break;
case YUV420: // yuv420
fmt_cfg = 4;
ScaleCbrX = CalScale(xact/2, par->xsize);
ScaleCbrY = CalScale(yact/2, par->ysize);
break;
case YUV444:// yuv444
fmt_cfg = 6;
ScaleCbrX = CalScale(xact, par->xsize);
ScaleCbrY = CalScale(yact, par->ysize);
break;
default:
dev_err(lcdc_dev->driver.dev,"%s:un supported format!\n",__func__);
break;
}
DBG(1,"lcdc%d>>%s>>format:%d>>>xact:%d>>yact:%d>>xsize:%d>>ysize:%d>>xvir:%d>>yvir:%d>>xpos:%d>>ypos:%d>>\n",
lcdc_dev->id,__func__,par->format,xact,yact,par->xsize,par->ysize,xvir,yvir,xpos,ypos);
spin_lock(&lcdc_dev->reg_lock);
if(likely(lcdc_dev->clk_on))
{
lcdc_writel(lcdc_dev,WIN0_SCL_FACTOR_YRGB,v_X_SCL_FACTOR(ScaleYrgbX) | v_Y_SCL_FACTOR(ScaleYrgbY));
lcdc_writel(lcdc_dev,WIN0_SCL_FACTOR_CBR,v_X_SCL_FACTOR(ScaleCbrX) | v_Y_SCL_FACTOR(ScaleCbrY));
lcdc_msk_reg(lcdc_dev,SYS_CTRL,m_WIN0_FORMAT,v_WIN0_FORMAT(fmt_cfg)); //(inf->video_mode==0)
lcdc_writel(lcdc_dev,WIN0_ACT_INFO,v_ACT_WIDTH(xact) | v_ACT_HEIGHT(yact));
lcdc_writel(lcdc_dev,WIN0_DSP_ST,v_DSP_STX(xpos) | v_DSP_STY(ypos));
lcdc_writel(lcdc_dev,WIN0_DSP_INFO,v_DSP_WIDTH(par->xsize) | v_DSP_HEIGHT(par->ysize));
lcdc_msk_reg(lcdc_dev,WIN0_COLOR_KEY,m_COLOR_KEY_EN,v_COLOR_KEY_EN(0));
switch(par->format)
{
case XBGR888:
lcdc_msk_reg(lcdc_dev, WIN_VIR,m_WIN0_VIR,v_ARGB888_VIRWIDTH(xvir));
//lcdc_msk_reg(lcdc_dev,ALPHA_CTRL,m_WIN0_ALPHA_EN,v_WIN0_ALPHA_EN(0));
lcdc_msk_reg(lcdc_dev,SYS_CTRL,m_WIN0_RB_SWAP,v_WIN0_RB_SWAP(1));
break;
case ABGR888:
lcdc_msk_reg(lcdc_dev,WIN_VIR,m_WIN0_VIR,v_ARGB888_VIRWIDTH(xvir));
//lcdc_msk_reg(lcdc_dev,ALPHA_CTRL,m_WIN0_ALPHA_EN,v_WIN0_ALPHA_EN(1));
//lcdc_msk_reg(lcdc_dev,DSP_CTRL0,m_WIN0_ALPHA_MODE | m_ALPHA_MODE_SEL0 |
// m_ALPHA_MODE_SEL1,v_WIN0_ALPHA_MODE(1) | v_ALPHA_MODE_SEL0(1) |
// v_ALPHA_MODE_SEL1(0));//default set to per-pixel alpha
lcdc_msk_reg(lcdc_dev,SYS_CTRL,m_WIN0_RB_SWAP,v_WIN0_RB_SWAP(1));
break;
case ARGB888:
lcdc_msk_reg(lcdc_dev,WIN_VIR,m_WIN0_VIR,v_ARGB888_VIRWIDTH(xvir));
//lcdc_msk_reg(lcdc_dev,ALPHA_CTRL,m_WIN0_ALPHA_EN,v_WIN0_ALPHA_EN(1));
//lcdc_msk_reg(lcdc_dev,DSP_CTRL0,m_WIN0_ALPHA_MODE | m_ALPHA_MODE_SEL0,
// v_WIN0_ALPHA_MODE(1) | v_ALPHA_MODE_SEL0(1));//default set to per-pixel alpha
lcdc_msk_reg(lcdc_dev,SYS_CTRL,m_WIN0_RB_SWAP,v_WIN0_RB_SWAP(0));
break;
case RGB888: //rgb888
lcdc_msk_reg(lcdc_dev, WIN_VIR,m_WIN0_VIR,v_RGB888_VIRWIDTH(xvir));
//lcdc_msk_reg(lcdc_dev,ALPHA_CTRL,m_WIN0_ALPHA_EN,v_WIN0_ALPHA_EN(0));
lcdc_msk_reg(lcdc_dev,SYS_CTRL,m_WIN0_RB_SWAP,v_WIN0_RB_SWAP(0));
break;
case RGB565: //rgb565
lcdc_msk_reg(lcdc_dev, WIN_VIR,m_WIN0_VIR,v_RGB565_VIRWIDTH(xvir));
//lcdc_msk_reg(lcdc_dev,ALPHA_CTRL,m_WIN0_ALPHA_EN,v_WIN0_ALPHA_EN(0));
lcdc_msk_reg(lcdc_dev,SYS_CTRL,m_WIN0_RB_SWAP,v_WIN0_RB_SWAP(0));
break;
case YUV422:
case YUV420:
case YUV444:
lcdc_msk_reg(lcdc_dev, WIN_VIR,m_WIN0_VIR,v_YUV_VIRWIDTH(xvir));
//lcdc_msk_reg(lcdc_dev,ALPHA_CTRL,m_WIN0_ALPHA_EN,v_WIN0_ALPHA_EN(0));
lcdc_msk_reg(lcdc_dev,SYS_CTRL,m_WIN0_RB_SWAP,v_WIN0_RB_SWAP(0));
break;
default:
dev_err(lcdc_dev->driver.dev,"%s:un supported format!\n",__func__);
break;
}
lcdc_cfg_done(lcdc_dev);
}
spin_unlock(&lcdc_dev->reg_lock);
return 0;
}
static int rk3288_win_0_1_reg_update(struct lcdc_device *lcdc_dev,
struct rk_lcdc_win *win,
int win_id)
{
unsigned int mask, val, off;
off = win_id * 0x40;
if(win->win_lb_mode == 5)
win->win_lb_mode = 4;
if (win->state == 1) {
mask = m_WIN0_EN | m_WIN0_DATA_FMT | m_WIN0_FMT_10 |
m_WIN0_LB_MODE | m_WIN0_RB_SWAP | m_WIN0_UV_SWAP;
val = v_WIN0_EN(win->state) |
v_WIN0_DATA_FMT(win->area[0].format) |
v_WIN0_FMT_10(win->fmt_10) |
v_WIN0_LB_MODE(win->win_lb_mode) |
v_WIN0_RB_SWAP(0) |
v_WIN0_UV_SWAP(0);
lcdc_msk_reg(lcdc_dev, WIN0_CTRL0+off, mask,val);
mask = m_WIN0_BIC_COE_SEL |
m_WIN0_VSD_YRGB_GT4 | m_WIN0_VSD_YRGB_GT2 |
m_WIN0_VSD_CBR_GT4 | m_WIN0_VSD_CBR_GT2 |
m_WIN0_YRGB_HOR_SCL_MODE | m_WIN0_YRGB_VER_SCL_MODE |
m_WIN0_YRGB_HSD_MODE | m_WIN0_YRGB_VSU_MODE |
m_WIN0_YRGB_VSD_MODE | m_WIN0_CBR_HOR_SCL_MODE |
m_WIN0_CBR_VER_SCL_MODE | m_WIN0_CBR_HSD_MODE |
m_WIN0_CBR_VSU_MODE | m_WIN0_CBR_VSD_MODE;
val = v_WIN0_BIC_COE_SEL(win->bic_coe_el) |
v_WIN0_VSD_YRGB_GT4(win->vsd_yrgb_gt4) |
v_WIN0_VSD_YRGB_GT2(win->vsd_yrgb_gt2) |
v_WIN0_VSD_CBR_GT4(win->vsd_cbr_gt4) |
v_WIN0_VSD_CBR_GT2(win->vsd_cbr_gt2) |
v_WIN0_YRGB_HOR_SCL_MODE(win->yrgb_hor_scl_mode) |
v_WIN0_YRGB_VER_SCL_MODE(win->yrgb_ver_scl_mode) |
v_WIN0_YRGB_HSD_MODE(win->yrgb_hsd_mode) |
v_WIN0_YRGB_VSU_MODE(win->yrgb_vsu_mode) |
v_WIN0_YRGB_VSD_MODE(win->yrgb_vsd_mode) |
v_WIN0_CBR_HOR_SCL_MODE(win->cbr_hor_scl_mode) |
v_WIN0_CBR_VER_SCL_MODE(win->cbr_ver_scl_mode) |
v_WIN0_CBR_HSD_MODE(win->cbr_hsd_mode) |
v_WIN0_CBR_VSU_MODE(win->cbr_vsu_mode) |
v_WIN0_CBR_VSD_MODE(win->cbr_vsd_mode);
lcdc_msk_reg(lcdc_dev, WIN0_CTRL1+off, mask,val);
val = v_WIN0_VIR_STRIDE(win->area[0].y_vir_stride);
lcdc_writel(lcdc_dev, WIN0_VIR+off, val);
/*lcdc_writel(lcdc_dev, WIN0_YRGB_MST+off, win->area[0].y_addr);
lcdc_writel(lcdc_dev, WIN0_CBR_MST+off, win->area[0].uv_addr);*/
val = v_WIN0_ACT_WIDTH(win->area[0].xact) |
v_WIN0_ACT_HEIGHT(win->area[0].yact);
lcdc_writel(lcdc_dev, WIN0_ACT_INFO+off, val);
val = v_WIN0_DSP_WIDTH(win->area[0].xsize) |
v_WIN0_DSP_HEIGHT(win->area[0].ysize);
lcdc_writel(lcdc_dev, WIN0_DSP_INFO+off, val);
val = v_WIN0_DSP_XST(win->area[0].dsp_stx) |
v_WIN0_DSP_YST(win->area[0].dsp_sty);
lcdc_writel(lcdc_dev, WIN0_DSP_ST+off, val);
val = v_WIN0_HS_FACTOR_YRGB(win->scale_yrgb_x) |
v_WIN0_VS_FACTOR_YRGB(win->scale_yrgb_y);
lcdc_writel(lcdc_dev, WIN0_SCL_FACTOR_YRGB+off, val);
val = v_WIN0_HS_FACTOR_CBR(win->scale_cbcr_x) |
v_WIN0_VS_FACTOR_CBR(win->scale_cbcr_y);
lcdc_writel(lcdc_dev, WIN0_SCL_FACTOR_CBR+off, val);
mask = m_WIN0_SRC_ALPHA_EN;
val = v_WIN0_SRC_ALPHA_EN(0);
lcdc_msk_reg(lcdc_dev,WIN0_SRC_ALPHA_CTRL+off,mask,val);
} else {
mask = m_WIN0_EN;
val = v_WIN0_EN(win->state);
lcdc_msk_reg(lcdc_dev, WIN0_CTRL0 + off, mask, val);
}
return 0;
}
