video: rockchip: hdmi: v2: improved the hdmi nlpcm_mode for bitstream output
[firefly-linux-kernel-4.4.55.git] / drivers / video / rockchip / rk_fb.c
index 8e703de9db2adf66418387a74dc90de6eb56c40c..4a838803dc1ed809d5992c836a78b2f9d7badee6 100644 (file)
@@ -31,6 +31,8 @@
 #include <linux/linux_logo.h>
 #include <linux/dma-mapping.h>
 #include <linux/regulator/consumer.h>
+#include <linux/of_address.h>
+#include <linux/memblock.h>
 
 #include "bmp_helper.h"
 
@@ -88,6 +90,12 @@ module_param(rk_fb_iommu_debug, int, S_IRUGO | S_IWUSR);
 static int rk_fb_config_debug(struct rk_lcdc_driver *dev_drv,
                              struct rk_fb_win_cfg_data *win_data,
                              struct rk_fb_reg_data *regs, u32 cmd);
+static int car_reversing;
+
+static int is_car_camcap(void) {
+       return car_reversing && strcmp("camcap", current->comm);
+}
+
 int support_uboot_display(void)
 {
        return uboot_logo_on;
@@ -495,6 +503,8 @@ int rk_fb_video_mode_from_timing(const struct display_timing *dt,
        screen->lvds_format = dt->lvds_format;
        screen->face = dt->face;
        screen->color_mode = dt->color_mode;
+       screen->width = dt->screen_widt;
+       screen->height = dt->screen_hight;
        screen->dsp_lut = dt->dsp_lut;
        screen->cabc_lut = dt->cabc_lut;
        screen->cabc_gamma_base = dt->cabc_gamma_base;
@@ -640,6 +650,34 @@ char *get_format_string(enum data_format format, char *fmt)
        return fmt;
 }
 
+int rk_fb_set_vop_pwm(void)
+{
+       int i = 0;
+       struct rk_fb *inf = NULL;
+       struct rk_lcdc_driver *dev_drv = NULL;
+
+       if (likely(fb_pdev))
+               inf = platform_get_drvdata(fb_pdev);
+       else
+               return -1;
+
+       for (i = 0; i < inf->num_lcdc; i++) {
+               if (inf->lcdc_dev_drv[i]->cabc_mode == 1) {
+                       dev_drv = inf->lcdc_dev_drv[i];
+                       break;
+               }
+       }
+
+       if (!dev_drv)
+               return -1;
+
+       mutex_lock(&dev_drv->win_config);
+       dev_drv->ops->cfg_done(dev_drv);
+       mutex_unlock(&dev_drv->win_config);
+
+       return 0;
+}
+
 /*
  * this is for hdmi
  * name: lcdc device name ,lcdc0 , lcdc1
@@ -1342,7 +1380,7 @@ static int rk_fb_pan_display(struct fb_var_screeninfo *var,
        u16 uv_x_off, uv_y_off, uv_y_act;
        u8 is_pic_yuv = 0;
 
-       if (dev_drv->suspend_flag)
+       if (dev_drv->suspend_flag || is_car_camcap())
                return 0;
        win_id = dev_drv->ops->fb_get_win_id(dev_drv, info->fix.id);
        if (win_id < 0)
@@ -1895,16 +1933,15 @@ static void rk_fb_update_reg(struct rk_lcdc_driver *dev_drv,
                }
        }
 
+       mutex_lock(&dev_drv->win_config);
        for (i = 0; i < dev_drv->lcdc_win_num; i++) {
                win = dev_drv->win[i];
                win_data = rk_fb_get_win_data(regs, i);
                if (win_data) {
-                       mutex_lock(&dev_drv->win_config);
                        rk_fb_update_win(dev_drv, win, win_data);
                        win->state = 1;
                        dev_drv->ops->set_par(dev_drv, i);
                        dev_drv->ops->pan_display(dev_drv, i);
-                       mutex_unlock(&dev_drv->win_config);
                } else {
                        win->z_order = -1;
                        win->state = 0;
@@ -1936,6 +1973,7 @@ static void rk_fb_update_reg(struct rk_lcdc_driver *dev_drv,
                dev_drv->ops->cfg_done(dev_drv);
        else
                sw_sync_timeline_inc(dev_drv->timeline, 1);
+       mutex_unlock(&dev_drv->win_config);
 
        do {
                timestamp = dev_drv->vsync_info.timestamp;
@@ -2225,8 +2263,10 @@ static int rk_fb_set_win_buffer(struct fb_info *info,
                                    ion_import_dma_buf(rk_fb->ion_client,
                                                       ion_fd);
                                if (IS_ERR(hdl)) {
-                                       pr_info("%s: Could not import handle:"
-                                               " %ld\n", __func__, (long)hdl);
+                                       pr_info("%s: win[%d]area[%d] can't import handle\n",
+                                               __func__, win_par->win_id, i);
+                                       pr_info("fd: %d, hdl: 0x%p, ion_client: 0x%p\n",
+                                               ion_fd, hdl, rk_fb->ion_client);
                                        return -EINVAL;
                                        break;
                                }
@@ -2646,6 +2686,7 @@ err_null_frame:
        win_data->ret_fence_fd = -1;
        pr_info("win num = %d,null frame\n", regs->win_num);
 err2:
+       rk_fb_config_debug(dev_drv, win_data, regs, 0);
        kfree(regs);
        mutex_unlock(&dev_drv->output_lock);
 
@@ -2872,9 +2913,11 @@ static int rk_fb_ioctl(struct fb_info *info, unsigned int cmd,
        case RK_FBIOSET_VSYNC_ENABLE:
                if (copy_from_user(&enable, argp, sizeof(enable)))
                        return -EFAULT;
-               dev_drv->vsync_info.active = enable;
+               if (enable)
+                       dev_drv->vsync_info.active++;
+               else
+                       dev_drv->vsync_info.active--;
                break;
-
        case RK_FBIOGET_DSP_ADDR:
                dev_drv->ops->get_dsp_addr(dev_drv, dsp_addr);
                if (copy_to_user(argp, &dsp_addr, sizeof(dsp_addr)))
@@ -2944,6 +2987,15 @@ static int rk_fb_ioctl(struct fb_info *info, unsigned int cmd,
                        if (cfgdone_index >= 10)
                                cfgdone_index = 0;
                }
+               if (is_car_camcap()) {
+                       int i = 0;
+
+                       for (i = 0; i < RK_MAX_BUF_NUM; i++)
+                               win_data.rel_fence_fd[i] = -1;
+
+                       win_data.ret_fence_fd = -1;
+                       goto cam_exit;
+               }
                if (copy_from_user(&win_data,
                                   (struct rk_fb_win_cfg_data __user *)argp,
                                   sizeof(win_data))) {
@@ -2954,6 +3006,7 @@ static int rk_fb_ioctl(struct fb_info *info, unsigned int cmd,
                dev_drv->wait_fs = win_data.wait_fs;
                ret = rk_fb_set_win_config(info, &win_data);
 
+cam_exit:
                if (copy_to_user((struct rk_fb_win_cfg_data __user *)arg,
                                 &win_data, sizeof(win_data))) {
                        ret = -EFAULT;
@@ -2983,6 +3036,8 @@ static int rk_fb_blank(int blank_mode, struct fb_info *info)
        struct rk_fb *rk_fb = dev_get_drvdata(info->device);
 #endif
 
+       if (is_car_camcap())
+               return 0;
        win_id = dev_drv->ops->fb_get_win_id(dev_drv, fix->id);
        if (win_id < 0)
                return -ENODEV;
@@ -3194,7 +3249,7 @@ static int rk_fb_set_par(struct fb_info *info)
        u16 uv_x_off, uv_y_off, uv_y_act;
        u8 is_pic_yuv = 0;
        /*var->pixclock = dev_drv->pixclock;*/
-       if (dev_drv->suspend_flag)
+       if (dev_drv->suspend_flag || is_car_camcap())
                return 0;
        win_id = dev_drv->ops->fb_get_win_id(dev_drv, info->fix.id);
        if (win_id < 0)
@@ -3414,7 +3469,7 @@ static int rk_fb_wait_for_vsync_thread(void *data)
                ktime_t timestamp = dev_drv->vsync_info.timestamp;
                int ret = wait_event_interruptible(dev_drv->vsync_info.wait,
                                !ktime_equal(timestamp, dev_drv->vsync_info.timestamp) &&
-                               (dev_drv->vsync_info.active || dev_drv->vsync_info.irq_stop));
+                               (dev_drv->vsync_info.active > 0 || dev_drv->vsync_info.irq_stop));
 
                if (!ret)
                        sysfs_notify(&fbi->dev->kobj, NULL, "vsync");
@@ -3625,7 +3680,6 @@ int rk_fb_switch_screen(struct rk_screen *screen, int enable, int lcdc_id)
                        /* If there is more than one lcdc device, we disable
                         *  the layer which attached to this device
                         */
-                       dev_drv->suspend_flag = 1;
                        flush_kthread_worker(&dev_drv->update_regs_worker);
                        for (i = 0; i < dev_drv->lcdc_win_num; i++) {
                                if (dev_drv->win[i] && dev_drv->win[i]->state)
@@ -3639,6 +3693,13 @@ int rk_fb_switch_screen(struct rk_screen *screen, int enable, int lcdc_id)
                mutex_unlock(&dev_drv->switch_screen);
                return 0;
        } else {
+               if (load_screen || (rk_fb->disp_policy != DISPLAY_POLICY_BOX)) {
+                       for (i = 0; i < dev_drv->lcdc_win_num; i++) {
+                               if (dev_drv->win[i] && dev_drv->win[i]->state &&
+                                       dev_drv->ops->win_direct_en)
+                                       dev_drv->ops->win_direct_en(dev_drv, i, 0);
+                       }
+               }
                if (dev_drv->uboot_logo) {
                        if (dev_drv->cur_screen->mode.xres !=
                                screen->mode.xres ||
@@ -3655,52 +3716,40 @@ int rk_fb_switch_screen(struct rk_screen *screen, int enable, int lcdc_id)
                dev_drv->cur_screen->x_mirror = dev_drv->rotate_mode & X_MIRROR;
                dev_drv->cur_screen->y_mirror = dev_drv->rotate_mode & Y_MIRROR;
        }
+
        if (!dev_drv->uboot_logo || load_screen ||
            (rk_fb->disp_policy != DISPLAY_POLICY_BOX)) {
-               for (i = 0; i < dev_drv->lcdc_win_num; i++) {
-                       info = rk_fb->fb[dev_drv->fb_index_base + i];
-                       fb_par = (struct rk_fb_par *)info->par;
-                       win_id = dev_drv->ops->fb_get_win_id(dev_drv, info->fix.id);
-                       win = dev_drv->win[win_id];
-                       if (win && fb_par->state) {
-                               dev_drv->ops->load_screen(dev_drv, 1);
-
-                               info->var.activate |= FB_ACTIVATE_FORCE;
-                               if (rk_fb->disp_mode == ONE_DUAL) {
-                                       info->var.grayscale &= 0xff;
-                                       info->var.grayscale |=
-                                               (dev_drv->cur_screen->xsize << 8) +
-                                               (dev_drv->cur_screen->ysize << 20);
-                               }
-                               if (dev_drv->uboot_logo && win->state) {
-                                       if (win->area[0].xpos ||
-                                           win->area[0].ypos) {
-                                               win->area[0].xpos =
-                                                       (screen->mode.xres -
-                                                        win->area[0].xsize) / 2;
-                                               win->area[0].ypos =
-                                                       (screen->mode.yres -
-                                                        win->area[0].ysize) / 2;
-                                       } else {
-                                               win->area[0].xsize =
-                                                       screen->mode.xres;
-                                               win->area[0].ysize =
-                                                       screen->mode.yres;
-                                       }
-                                       dev_drv->ops->set_par(dev_drv, i);
-                                       dev_drv->ops->cfg_done(dev_drv);
-                               } else if (!dev_drv->win[win_id]->state) {
-                                       dev_drv->ops->open(dev_drv, win_id, 1);
-                                       dev_drv->suspend_flag = 0;
-                                       /* mutex_lock(&dev_drv->win_config);
-                                        * info->var.xoffset = 0;
-                                        * info->var.yoffset = 0;
-                                        * info->fbops->fb_set_par(info);
-                                        * info->fbops->fb_pan_display(&info->var,
-                                        *                          info);
-                                        * mutex_unlock(&dev_drv->win_config);
-                                        */
+               info = rk_fb->fb[dev_drv->fb_index_base];
+               fb_par = (struct rk_fb_par *)info->par;
+               win_id = 0;
+               win = dev_drv->win[win_id];
+               if (win && fb_par->state) {
+                       dev_drv->ops->load_screen(dev_drv, 1);
+                       info->var.activate |= FB_ACTIVATE_FORCE;
+                       if (rk_fb->disp_mode == ONE_DUAL) {
+                               info->var.grayscale &= 0xff;
+                               info->var.grayscale |=
+                                       (dev_drv->cur_screen->xsize << 8) +
+                                       (dev_drv->cur_screen->ysize << 20);
+                       }
+                       if (dev_drv->uboot_logo && win->state) {
+                               if (win->area[0].xpos ||
+                                   win->area[0].ypos) {
+                                       win->area[0].xpos =
+                                               (screen->mode.xres -
+                                                win->area[0].xsize) / 2;
+                                       win->area[0].ypos =
+                                               (screen->mode.yres -
+                                                win->area[0].ysize) / 2;
+                               } else {
+                                       win->area[0].xsize = screen->mode.xres;
+                                       win->area[0].ysize = screen->mode.yres;
                                }
+                               dev_drv->ops->set_par(dev_drv, i);
+                               dev_drv->ops->cfg_done(dev_drv);
+                       } else if (!dev_drv->win[win_id]->state) {
+                               dev_drv->ops->open(dev_drv, win_id, 1);
+                               info->fbops->fb_pan_display(&info->var, info);
                        }
                }
        } else {
@@ -4125,9 +4174,28 @@ bool is_prmry_rk_lcdc_registered(void)
                return false;
 }
 
-__weak phys_addr_t uboot_logo_base;
-__weak phys_addr_t uboot_logo_size;
-__weak phys_addr_t uboot_logo_offset;
+phys_addr_t uboot_logo_base;
+phys_addr_t uboot_logo_size;
+phys_addr_t uboot_logo_offset;
+
+static int __init rockchip_uboot_mem_late_init(void)
+{
+       int err;
+
+       if (uboot_logo_size) {
+               void *start = phys_to_virt(uboot_logo_base);
+               void *end = phys_to_virt(uboot_logo_base + uboot_logo_size);
+
+               err = memblock_free(uboot_logo_base, uboot_logo_size);
+               if (err < 0)
+                       pr_err("%s: freeing memblock failed: %d\n",
+                              __func__, err);
+               free_reserved_area(start, end, -1, "logo");
+       }
+       return 0;
+}
+
+late_initcall(rockchip_uboot_mem_late_init);
 
 int rk_fb_register(struct rk_lcdc_driver *dev_drv,
                   struct rk_lcdc_win *win, int id)
@@ -4174,6 +4242,14 @@ int rk_fb_register(struct rk_lcdc_driver *dev_drv,
                fbi->fix = def_fix;
                sprintf(fbi->fix.id, "fb%d", rk_fb->num_fb);
                fb_videomode_to_var(&fbi->var, &dev_drv->cur_screen->mode);
+               if (dev_drv->dsp_mode == ONE_VOP_DUAL_MIPI_VER_SCAN) {
+                       fbi->var.xres /= 2;
+                       fbi->var.yres *= 2;
+                       fbi->var.xres_virtual /= 2;
+                       fbi->var.yres_virtual *= 2;
+               }
+               fbi->var.width = dev_drv->cur_screen->width;
+               fbi->var.height = dev_drv->cur_screen->height;
                fbi->var.grayscale |=
                    (fbi->var.xres << 8) + (fbi->var.yres << 20);
 #if defined(CONFIG_LOGO_LINUX_BMP)
@@ -4183,8 +4259,6 @@ int rk_fb_register(struct rk_lcdc_driver *dev_drv,
 #endif
                fbi->fix.line_length =
                    (fbi->var.xres_virtual) * (fbi->var.bits_per_pixel >> 3);
-               fbi->var.width = dev_drv->cur_screen->width;
-               fbi->var.height = dev_drv->cur_screen->height;
                if (dev_drv->iommu_enabled)
                        fb_ops.fb_mmap = rk_fb_mmap;
                fbi->fbops = &fb_ops;
@@ -4289,8 +4363,7 @@ int rk_fb_register(struct rk_lcdc_driver *dev_drv,
                                start += PAGE_SIZE;
                                i++;
                        }
-                       vaddr = vmap(pages, nr_pages, VM_MAP,
-                                    pgprot_writecombine(PAGE_KERNEL));
+                       vaddr = vmap(pages, nr_pages, VM_MAP, PAGE_KERNEL);
                        if (!vaddr) {
                                pr_err("failed to vmap phy addr 0x%lx\n",
                                       (long)(uboot_logo_base +
@@ -4364,8 +4437,7 @@ int rk_fb_register(struct rk_lcdc_driver *dev_drv,
                                start += PAGE_SIZE;
                                i++;
                        }
-                       vaddr = vmap(pages, nr_pages, VM_MAP,
-                                    pgprot_writecombine(PAGE_KERNEL));
+                       vaddr = vmap(pages, nr_pages, VM_MAP, PAGE_KERNEL);
                        if (!vaddr) {
                                pr_err("failed to vmap phy addr 0x%x\n",
                                       start);
@@ -4463,11 +4535,35 @@ int rk_fb_unregister(struct rk_lcdc_driver *dev_drv)
        return 0;
 }
 
+int rk_fb_set_car_reverse_status(struct rk_lcdc_driver *dev_drv,
+                                int status)
+{
+       char *envp[3] = {"Request", "FORCE UPDATE", NULL};
+
+       if (status) {
+               car_reversing = 1;
+               flush_kthread_worker(&dev_drv->update_regs_worker);
+               dev_drv->timeline_max++;
+#ifdef H_USE_FENCE
+               sw_sync_timeline_inc(dev_drv->timeline, 1);
+#endif
+               pr_debug("%s: camcap reverse start...\n", __func__);
+       } else {
+               car_reversing = 0;
+               kobject_uevent_env(&dev_drv->dev->kobj,
+                                  KOBJ_CHANGE, envp);
+               pr_debug("%s: camcap reverse finish...\n", __func__);
+       }
+
+       return 0;
+}
+
 static int rk_fb_probe(struct platform_device *pdev)
 {
        struct rk_fb *rk_fb = NULL;
        struct device_node *np = pdev->dev.of_node;
-       u32 mode;
+       u32 mode, ret;
+       struct device_node *node;
 
        if (!np) {
                dev_err(&pdev->dev, "Missing device tree node.\n");
@@ -4509,6 +4605,27 @@ static int rk_fb_probe(struct platform_device *pdev)
        }
 #endif
 
+       node = of_parse_phandle(np, "memory-region", 0);
+       if (node) {
+               struct resource r;
+
+               ret = of_address_to_resource(node, 0, &r);
+               if (ret)
+                       return ret;
+
+               if (uboot_logo_on) {
+                       uboot_logo_base = r.start;
+                       uboot_logo_size = resource_size(&r);
+
+                       if (uboot_logo_size > SZ_16M)
+                               uboot_logo_offset = SZ_16M;
+                       else
+                               uboot_logo_offset = 0;
+               }
+               pr_info("logo: base=0x%llx, size=0x%llx, offset=0x%llx\n",
+                       uboot_logo_base, uboot_logo_size, uboot_logo_offset);
+       }
+
        fb_pdev = pdev;
        dev_info(&pdev->dev, "rockchip framebuffer driver probe\n");
        return 0;