//enable layer,open:1,enable;0 disable
static int win0_open(struct rk3188_lcdc_device *lcdc_dev,bool open)
{
spin_lock(&lcdc_dev->reg_lock);
if(likely(lcdc_dev->clk_on))
{
if(open)
{
if(!lcdc_dev->atv_layer_cnt)
{
printk(KERN_INFO "lcdc%d wakeup from standby!\n",lcdc_dev->id);
lcdc_msk_reg(lcdc_dev, SYS_CTRL,m_LCDC_STANDBY,v_LCDC_STANDBY(0));
}
lcdc_dev->atv_layer_cnt++;
}
else if((lcdc_dev->atv_layer_cnt > 0) && (!open))
{
lcdc_dev->atv_layer_cnt--;
}
lcdc_dev->driver.layer_par[0]->state = open;
lcdc_msk_reg(lcdc_dev, SYS_CTRL, m_WIN0_EN, v_WIN0_EN(open));
#ifdef CONFIG_LCDC_OVERLAY_ENABLE
lcdc_msk_reg(lcdc_dev, DSP_CTRL0, m_ALPHA_MODE_SEL0 | m_WIN1_ALPHA_MODE, v_ALPHA_MODE_SEL0(1) | v_WIN1_ALPHA_MODE(1));
lcdc_msk_reg(lcdc_dev, ALPHA_CTRL, m_WIN1_ALPHA_EN, v_WIN1_ALPHA_EN(open));
#endif
if(!lcdc_dev->atv_layer_cnt) //if no layer used,disable lcdc
{
printk(KERN_INFO "no layer of lcdc%d is used,go to standby!\n",lcdc_dev->id);
lcdc_msk_reg(lcdc_dev, SYS_CTRL,m_LCDC_STANDBY,v_LCDC_STANDBY(1));
}
lcdc_cfg_done(lcdc_dev);
}
spin_unlock(&lcdc_dev->reg_lock);
return 0;
}
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 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;
}
