video: rockchip: fb: fix inconsistent returns 'mutex:&dev_drv->front_lock'

[firefly-linux-kernel-4.4.55.git] / drivers / video / rockchip / rkfb_sysfs.c

diff --git a/drivers/video/rockchip/rkfb_sysfs.c b/drivers/video/rockchip/rkfb_sysfs.c
index 894ed23cd7b83e850c66e8ea79d0f8e103a52b0d..81a1b759d8036de0b8189c23ad3bd666b4c8b86a 100644 (file)
--- a/drivers/video/rockchip/rkfb_sysfs.c
+++ b/drivers/video/rockchip/rkfb_sysfs.c
@@ -110,6 +110,32 @@ static ssize_t show_screen_info(struct device *dev,
                        fps, screen->type, screen->mode.vmode);
 }
 
+static ssize_t set_screen_info(struct device *dev,
+                              struct device_attribute *attr,
+                              const char *buf, size_t count)
+{
+       struct fb_info *fbi = dev_get_drvdata(dev);
+       struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
+       struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
+       int xmirror = 0, ymirror = 0, ret = 0, rotate = 0;
+
+       ret = kstrtoint(buf, 0, &rotate);
+       if (ret)
+               return ret;
+       xmirror = !!(rotate & X_MIRROR);
+       ymirror = !!(rotate & Y_MIRROR);
+       dev_drv->cur_screen->x_mirror = xmirror;
+       dev_drv->cur_screen->y_mirror = ymirror;
+       mutex_lock(&dev_drv->output_lock);
+       mutex_lock(&dev_drv->win_config);
+       if (dev_drv->ops->extern_func)
+               dev_drv->ops->extern_func(dev_drv, SET_DSP_MIRROR);
+       mutex_unlock(&dev_drv->win_config);
+       mutex_unlock(&dev_drv->output_lock);
+
+       return count;
+}
+
 static ssize_t show_disp_info(struct device *dev,
                              struct device_attribute *attr, char *buf)
 {
@@ -405,17 +431,14 @@ static ssize_t set_dump_buffer(struct device *dev,
                return PTR_ERR(dentry);
        }
 
+       mutex_lock(&dev_drv->front_lock);
        if (!num_frames) {
-               mutex_lock(&dev_drv->front_lock);
-
                if (!dev_drv->front_regs) {
                        u16 xact, yact;
                        int data_format;
                        u32 dsp_addr;
                        int ymirror;
 
-                       mutex_unlock(&dev_drv->front_lock);
-
                        if (dev_drv->ops->get_dspbuf_info)
                                dev_drv->ops->get_dspbuf_info(dev_drv, &xact,
                                                &yact, &data_format, &dsp_addr,
@@ -426,8 +449,10 @@ static ssize_t set_dump_buffer(struct device *dev,
                        goto out;
                }
                front_regs = kmalloc(sizeof(*front_regs), GFP_KERNEL);
-               if (!front_regs)
+               if (!front_regs) {
+                       mutex_unlock(&dev_drv->front_lock);
                        return -ENOMEM;
+               }
                memcpy(front_regs, dev_drv->front_regs, sizeof(*front_regs));
 
                for (i = 0; i < front_regs->win_num; i++) {
@@ -465,8 +490,6 @@ static ssize_t set_dump_buffer(struct device *dev,
                }
 
                kfree(front_regs);
-
-               mutex_unlock(&dev_drv->front_lock);
        } else {
                trace->num_frames = num_frames;
                trace->count_frame = 0;
@@ -476,7 +499,7 @@ static ssize_t set_dump_buffer(struct device *dev,
                trace->mask_area = mask_area;
        }
 out:
-
+       mutex_unlock(&dev_drv->front_lock);
        return count;
 }
 
@@ -1262,7 +1285,8 @@ static struct device_attribute rkfb_attrs[] = {
        __ATTR(disp_info, S_IRUGO, show_disp_info, NULL),
        __ATTR(dump_buf, S_IRUGO | S_IWUSR, show_dump_buffer, set_dump_buffer),
        __ATTR(dsp_buf, S_IRUGO | S_IWUSR, show_dsp_buffer, set_dsp_buffer),
-       __ATTR(screen_info, S_IRUGO, show_screen_info, NULL),
+       __ATTR(screen_info, S_IRUGO | S_IWUSR,
+              show_screen_info, set_screen_info),
        __ATTR(dual_mode, S_IRUGO, show_dual_mode, NULL),
        __ATTR(enable, S_IRUGO | S_IWUSR, show_fb_state, set_fb_state),
        __ATTR(overlay, S_IRUGO | S_IWUSR, show_overlay, set_overlay),