int rk3066b_lcdc_early_suspend(struct rk_lcdc_device_driver *dev_drv) { struct rk3066b_lcdc_device *lcdc_dev = container_of(dev_drv,struct rk3066b_lcdc_device,driver); spin_lock(&lcdc_dev->reg_lock); if(likely(lcdc_dev->clk_on)) { lcdc_dev->clk_on = 0; LcdMskReg(lcdc_dev, INT_STATUS, m_FRM_STARTCLEAR, v_FRM_STARTCLEAR(1)); LcdMskReg(lcdc_dev, SYS_CFG,m_LCDC_STANDBY,v_LCDC_STANDBY(1)); LCDC_REG_CFG_DONE(); spin_unlock(&lcdc_dev->reg_lock); } else //clk already disabled { spin_unlock(&lcdc_dev->reg_lock); return 0; } mdelay(1); clk_disable(lcdc_dev->dclk); clk_disable(lcdc_dev->hclk); clk_disable(lcdc_dev->aclk); clk_disable(lcdc_dev->pd); return 0; }
int rk3066b_lcdc_pan_display(struct rk_lcdc_device_driver * dev_drv,int layer_id) { struct rk3066b_lcdc_device *lcdc_dev = container_of(dev_drv,struct rk3066b_lcdc_device,driver); struct layer_par *par = NULL; rk_screen *screen = dev_drv->cur_screen; unsigned long flags; int timeout; if(!screen) { printk(KERN_ERR "screen is null!\n"); return -ENOENT; } if(layer_id==0) { par = dev_drv->layer_par[0]; win0_display(lcdc_dev,par); } else if(layer_id==1) { par = dev_drv->layer_par[1]; win1_display(lcdc_dev,par); } if((dev_drv->first_frame)) //this is the first frame of the system ,enable frame start interrupt { dev_drv->first_frame = 0; LcdMskReg(lcdc_dev,INT_STATUS,m_HOR_STARTMASK | m_FRM_STARTMASK | m_SCANNING_MASK | m_HOR_STARTCLEAR | m_FRM_STARTCLEAR |m_SCANNING_CLEAR | m_SCAN_LINE_NUM, v_HOR_STARTMASK(1) | v_FRM_STARTMASK(0) | v_SCANNING_MASK(0) | v_HOR_STARTCLEAR(1) | v_FRM_STARTCLEAR(1) | v_SCANNING_CLEAR(1) | //v_SCANNING_CLEAR(screen->vsync_len + screen->upper_margin+screen->y_res -1)); v_SCAN_LINE_NUM(screen->vsync_len + screen->upper_margin+screen->y_res -1)); LCDC_REG_CFG_DONE(); // write any value to REG_CFG_DONE let config become effective } #if 0 if(dev_drv->num_buf < 3) //3buffer ,no need to wait for sysn { spin_lock_irqsave(&dev_drv->cpl_lock,flags); init_completion(&dev_drv->frame_done); spin_unlock_irqrestore(&dev_drv->cpl_lock,flags); timeout = wait_for_completion_timeout(&dev_drv->frame_done,msecs_to_jiffies(dev_drv->cur_screen->ft+5)); if(!timeout&&(!dev_drv->frame_done.done)) { printk(KERN_ERR "wait for new frame start time out!\n"); return -ETIMEDOUT; } } #endif return 0; }
static int rk3066b_lcdc_open(struct rk_lcdc_device_driver *dev_drv,int layer_id,bool open) { int i=0; int __iomem *c; int v; struct rk3066b_lcdc_device *lcdc_dev = container_of(dev_drv,struct rk3066b_lcdc_device,driver); if((open) && (!lcdc_dev->atv_layer_cnt)) //enable clk,when first layer open { rk3066b_lcdc_clk_enable(lcdc_dev); rk3066b_lcdc_reg_resume(lcdc_dev); //resume reg LcdMskReg(lcdc_dev, SYS_CFG,m_LCDC_STANDBY,v_LCDC_STANDBY(0)); rk3066b_load_screen(dev_drv,1); spin_lock(&lcdc_dev->reg_lock); if(dev_drv->cur_screen->dsp_lut) //resume dsp lut { LcdMskReg(lcdc_dev,SYS_CFG,m_DSIP_LUT_CTL,v_DSIP_LUT_CTL(0)); LCDC_REG_CFG_DONE(); mdelay(25); //wait for dsp lut disabled for(i=0;i<256;i++) { v = dev_drv->cur_screen->dsp_lut[i]; c = lcdc_dev->dsp_lut_addr_base+i; writel_relaxed(v,c); } LcdMskReg(lcdc_dev,SYS_CFG,m_DSIP_LUT_CTL,v_DSIP_LUT_CTL(1));//enable dsp lut } spin_unlock(&lcdc_dev->reg_lock); } if(layer_id == 0) { win0_open(lcdc_dev,open); } else if(layer_id == 1) { win1_open(lcdc_dev,open); } if((!open) && (!lcdc_dev->atv_layer_cnt)) //when all layer closed,disable clk { LcdMskReg(lcdc_dev, INT_STATUS, m_FRM_STARTCLEAR, v_FRM_STARTCLEAR(1)); LcdMskReg(lcdc_dev, SYS_CFG,m_LCDC_STANDBY,v_LCDC_STANDBY(1)); LCDC_REG_CFG_DONE(); rk3066b_lcdc_clk_disable(lcdc_dev); } return 0; }
static irqreturn_t rk3066b_lcdc_isr(int irq, void *dev_id) { struct rk3066b_lcdc_device *lcdc_dev = (struct rk3066b_lcdc_device *)dev_id; LcdMskReg(lcdc_dev, INT_STATUS, m_FRM_STARTCLEAR, v_FRM_STARTCLEAR(1)); LCDC_REG_CFG_DONE(); //LcdMskReg(lcdc_dev, INT_STATUS, m_LINE_FLAG_INT_CLEAR, v_LINE_FLAG_INT_CLEAR(1)); if(lcdc_dev->driver.num_buf < 3) //three buffer ,no need to wait for sync { spin_lock(&(lcdc_dev->driver.cpl_lock)); complete(&(lcdc_dev->driver.frame_done)); spin_unlock(&(lcdc_dev->driver.cpl_lock)); } return IRQ_HANDLED; }
static int rk3066b_lcdc_deinit(struct rk3066b_lcdc_device *lcdc_dev) { spin_lock(&lcdc_dev->reg_lock); if(likely(lcdc_dev->clk_on)) { lcdc_dev->clk_on = 0; LcdMskReg(lcdc_dev, INT_STATUS, m_FRM_STARTCLEAR, v_FRM_STARTCLEAR(1)); LcdMskReg(lcdc_dev, INT_STATUS,m_HOR_STARTMASK| m_FRM_STARTMASK | m_SCANNING_MASK, v_HOR_STARTMASK(1) | v_FRM_STARTMASK(1) | v_SCANNING_MASK(1)); //mask all interrupt in init LcdSetBit(lcdc_dev,SYS_CFG,m_LCDC_STANDBY); LCDC_REG_CFG_DONE(); spin_unlock(&lcdc_dev->reg_lock); } else //clk already disabled { spin_unlock(&lcdc_dev->reg_lock); return 0; } mdelay(1); return 0; }