#include <linux/mm.h>
#include <linux/slab.h>
#include <linux/device.h>
+#include <linux/kthread.h>
#include <linux/delay.h>
#include <linux/init.h>
#include <linux/interrupt.h>
return 0;
}
+
+
+static void rk3188_lcdc_reg_dump(struct rk3188_lcdc_device *lcdc_dev)
+{
+ int *cbase = (int *)lcdc_dev->regs;
+ int *regsbak = (int*)lcdc_dev->regsbak;
+ int i,j;
+
+ printk("back up reg:\n");
+ for(i=0; i<=(0x90>>4);i++)
+ {
+ for(j=0;j<4;j++)
+ printk("%08x ",*(regsbak+i*4 +j));
+ printk("\n");
+ }
+
+ printk("lcdc reg:\n");
+ for(i=0; i<=(0x90>>4);i++)
+ {
+ for(j=0;j<4;j++)
+ printk("%08x ",readl_relaxed(cbase+i*4 +j));
+ printk("\n");
+ }
+
+}
+
+
static int rk3188_lcdc_reg_resume(struct rk3188_lcdc_device *lcdc_dev)
{
memcpy((u8*)lcdc_dev->regs, (u8*)lcdc_dev->regsbak, 0x84);
{
screen->init();
}
+
+ if(screen->sscreen_set)
+ {
+ screen->sscreen_set(screen,!initscreen);
+ }
dev_info(dev_drv->dev,"%s for lcdc%d ok!\n",__func__,lcdc_dev->id);
return 0;
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
ScaleYrgbY = CalScale(yact, par->ysize);
switch (par->format)
{
+ case ARGB888:
+ case XRGB888:
+ 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;
{
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(par->format)); //(inf->video_mode==0)
+ 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));
switch(par->format)
{
- case ARGB888:
+ case XRGB888:
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));
+ 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,v_WIN0_ALPHA_MODE(1));//default set to per-pixel alpha
//lcdc_msk_reg(lcdc_dev,SYS_CTRL1,m_W0_RGB_RB_SWAP,v_W0_RGB_RB_SWAP(1));
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_CTRL1,m_W0_RGB_RB_SWAP,v_W0_RGB_RB_SWAP(1));
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));
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));
break;
default:
- dev_err(lcdc_dev->driver.dev,"un supported format!\n");
+ dev_err(lcdc_dev->driver.dev,"%s:un supported format!\n",__func__);
break;
}
struct layer_par *par )
{
u32 xact, yact, xvir, yvir, xpos, ypos;
+ u8 fmt_cfg;
xact = par->xact;
yact = par->yact;
spin_lock(&lcdc_dev->reg_lock);
if(likely(lcdc_dev->clk_on))
{
- lcdc_msk_reg(lcdc_dev,SYS_CTRL,m_WIN1_FORMAT, v_WIN1_FORMAT(par->format));
+
lcdc_writel(lcdc_dev, WIN1_DSP_INFO,v_DSP_WIDTH(par->xsize) | v_DSP_HEIGHT(par->ysize));
lcdc_writel(lcdc_dev, WIN1_DSP_ST,v_DSP_STX(xpos) | v_DSP_STY(ypos));
// disable win1 color key and set the color to black(rgb=0)
lcdc_msk_reg(lcdc_dev, WIN1_COLOR_KEY,m_COLOR_KEY_EN,v_COLOR_KEY_EN(0));
switch(par->format)
{
+ case XRGB888:
+ fmt_cfg = 0;
+ lcdc_msk_reg(lcdc_dev, WIN_VIR,m_WIN1_VIR,v_WIN1_ARGB888_VIRWIDTH(xvir));
+ lcdc_msk_reg(lcdc_dev,ALPHA_CTRL,m_WIN1_ALPHA_EN,v_WIN1_ALPHA_EN(0));
+ break;
case ARGB888:
+ fmt_cfg = 0;
lcdc_msk_reg(lcdc_dev, WIN_VIR,m_WIN1_VIR,v_WIN1_ARGB888_VIRWIDTH(xvir));
+ lcdc_msk_reg(lcdc_dev,ALPHA_CTRL,m_WIN1_ALPHA_EN,v_WIN1_ALPHA_EN(1));
+ lcdc_msk_reg(lcdc_dev,DSP_CTRL0,m_WIN1_ALPHA_MODE,v_WIN1_ALPHA_MODE(1));//default set to per-pixel alpha
//lcdc_msk_reg(lcdc_dev,SYS_CTRL1,m_W1_RGB_RB_SWAP,v_W1_RGB_RB_SWAP(1));
break;
case RGB888: //rgb888
+ fmt_cfg = 1;
lcdc_msk_reg(lcdc_dev, WIN_VIR,m_WIN1_VIR,v_WIN1_RGB888_VIRWIDTH(xvir));
+ lcdc_msk_reg(lcdc_dev,ALPHA_CTRL,m_WIN1_ALPHA_EN,v_WIN1_ALPHA_EN(0));
// lcdc_msk_reg(lcdc_dev,SYS_CTRL1,m_W1_RGB_RB_SWAP,v_W1_RGB_RB_SWAP(1));
break;
case RGB565: //rgb565
+ fmt_cfg = 2;
lcdc_msk_reg(lcdc_dev, WIN_VIR,m_WIN1_VIR,v_WIN1_RGB565_VIRWIDTH(xvir));
+ lcdc_msk_reg(lcdc_dev,ALPHA_CTRL,m_WIN1_ALPHA_EN,v_WIN1_ALPHA_EN(0));
break;
default:
- dev_err(lcdc_dev->driver.dev,"un supported format!\n");
+ dev_err(lcdc_dev->driver.dev,"%s:un supported format!\n",__func__);
break;
}
+ lcdc_msk_reg(lcdc_dev,SYS_CTRL,m_WIN1_FORMAT, v_WIN1_FORMAT(fmt_cfg));
}
spin_unlock(&lcdc_dev->reg_lock);
static int rk3188_lcdc_ioctl(struct rk_lcdc_device_driver *dev_drv, unsigned int cmd,unsigned long arg,int layer_id)
{
+ struct rk3188_lcdc_device *lcdc_dev =
+ container_of(dev_drv,struct rk3188_lcdc_device,driver);
+ u32 panel_size[2];
+ void __user *argp = (void __user *)arg;
+ int enable;
+ switch(cmd)
+ {
+ case FBIOGET_PANEL_SIZE: //get panel size
+ panel_size[0] = lcdc_dev->screen->x_res;
+ panel_size[1] = lcdc_dev->screen->y_res;
+ if(copy_to_user(argp, panel_size, 8))
+ return -EFAULT;
+ break;
+ case RK_FBIOSET_CONFIG_DONE:
+ lcdc_cfg_done(lcdc_dev);
+ break;
+ case RK_FBIOSET_VSYNC_ENABLE:
+ if (copy_from_user(&enable, argp, sizeof(enable)))
+ return -EFAULT;
+ lcdc_dev->vsync_info.active = enable;
+ break;
+ default:
+ break;
+ }
return 0;
}
return ret;
}
+
+static int lcdc_wait_for_vsync_thread(void *data)
+{
+ struct rk3188_lcdc_device *lcdc_dev = data;
+
+ while (!kthread_should_stop()) {
+ ktime_t timestamp = lcdc_dev->vsync_info.timestamp;
+ int ret = wait_event_interruptible(lcdc_dev->vsync_info.wait,
+ !ktime_equal(timestamp, lcdc_dev->vsync_info.timestamp) &&
+ lcdc_dev->vsync_info.active);
+
+ if (!ret) {
+ sysfs_notify(&lcdc_dev->driver.dev->kobj, NULL, "vsync");
+ }
+ }
+
+ return 0;
+}
+
+static ssize_t rk3188_lcdc_vsync_show(struct device *dev,
+ struct device_attribute *attr, char *buf)
+{
+ struct rk3188_lcdc_device *lcdc_dev = dev_get_drvdata(dev);
+ return scnprintf(buf, PAGE_SIZE, "%llu\n",
+ ktime_to_ns(lcdc_dev->vsync_info.timestamp));
+}
+
+static DEVICE_ATTR(vsync, S_IRUGO, rk3188_lcdc_vsync_show, NULL);
+
static struct layer_par lcdc_layer[] = {
[0] = {
.name = "win0",
{
struct rk3188_lcdc_device *lcdc_dev =
(struct rk3188_lcdc_device *)dev_id;
+ ktime_t timestamp = ktime_get();
lcdc_msk_reg(lcdc_dev, INT_STATUS, m_FS_INT_CLEAR, v_FS_INT_CLEAR(1));
spin_unlock(&(lcdc_dev->driver.cpl_lock));
}
#endif
+ lcdc_dev->vsync_info.timestamp = timestamp;
+ wake_up_interruptible_all(&lcdc_dev->vsync_info.wait);
+
return IRQ_HANDLED;
}
struct rk3188_lcdc_device *lcdc_dev = NULL;
struct device *dev = &pdev->dev;
rk_screen *screen;
+ rk_screen *screen1;
struct rk29fb_info *screen_ctr_info;
struct resource *res = NULL;
struct resource *mem = NULL;
platform_set_drvdata(pdev, lcdc_dev);
lcdc_dev->id = pdev->id;
screen_ctr_info = (struct rk29fb_info * )pdev->dev.platform_data;
+ screen = kzalloc(sizeof(rk_screen), GFP_KERNEL);
if(!screen_ctr_info)
{
dev_err(dev, "no platform data specified for screen control info!\n");
ret = -EINVAL;
goto err0;
}
- screen = kzalloc(sizeof(rk_screen), GFP_KERNEL);
if(!screen)
{
dev_err(&pdev->dev, "rk screen kmalloc fail!");
ret = -ENOMEM;
goto err0;
}
+ else
+ {
+ lcdc_dev->screen = screen;
+ }
+ screen->lcdc_id = lcdc_dev->id;
+ screen->screen_id = 0;
+#if defined(CONFIG_ONE_LCDC_DUAL_OUTPUT_INF)&& defined(CONFIG_RK610_LVDS)
+ screen1 = kzalloc(sizeof(rk_screen), GFP_KERNEL);
+ if(!screen1)
+ {
+ dev_err(&pdev->dev, ">>rk3066b lcdc screen1 kmalloc fail!");
+ ret = -ENOMEM;
+ goto err0;
+ }
+ screen1->lcdc_id = 1;
+ screen1->screen_id = 1;
+ printk("use lcdc%d and rk610 implemention dual display!\n",lcdc_dev->id);
+
+#endif
res = platform_get_resource(pdev, IORESOURCE_MEM,0);
if (res == NULL)
printk("lcdc%d:reg_phy_base = 0x%08x,reg_vir_base:0x%p\n",pdev->id,lcdc_dev->reg_phy_base, lcdc_dev->regs);
lcdc_dev->driver.dev = dev;
lcdc_dev->driver.screen0 = screen;
+#if defined(CONFIG_ONE_LCDC_DUAL_OUTPUT_INF)&& defined(CONFIG_RK610_LVDS)
+ lcdc_dev->driver.screen1 = screen1;
+#endif
lcdc_dev->driver.cur_screen = screen;
lcdc_dev->driver.screen_ctr_info = screen_ctr_info;
ret = -ENODEV;
goto err4;
}
+
+ init_waitqueue_head(&lcdc_dev->vsync_info.wait);
+ ret = device_create_file(&pdev->dev, &dev_attr_vsync);
+ if (ret) {
+ dev_err(&pdev->dev, "failed to create vsync file\n");
+ }
+ lcdc_dev->vsync_info.thread = kthread_run(lcdc_wait_for_vsync_thread,
+ lcdc_dev, "lcdc-vsync");
+
+
+ if (lcdc_dev->vsync_info.thread == ERR_PTR(-ENOMEM)) {
+ dev_err(&pdev->dev, "failed to run vsync thread\n");
+ lcdc_dev->vsync_info.thread = NULL;
+ }
+ lcdc_dev->vsync_info.active = 1;
ret = rk_fb_register(&(lcdc_dev->driver),&lcdc_driver,lcdc_dev->id);
if(ret < 0)
.probe = rk3188_lcdc_probe,
.remove = __devexit_p(rk3188_lcdc_remove),
.driver = {
- .name = "rk3188-lcdc",
+ .name = "rk30-lcdc",
.owner = THIS_MODULE,
},
.suspend = rk3188_lcdc_suspend,
projects / firefly-linux-kernel-4.4.55.git / blobdiff