drivers/video/rockchip/rkfb_sysfs.c

   1 /*
   2  * linux/drivers/video/rockchip/rkfb-sysfs.c
   3  *
   4  * Copyright (C) 2012 Rockchip Corporation
   5  * Author: yxj<yxj@rock-chips.com>
   6  *
   7  * Some code and ideas taken from
   8  *drivers/video/omap2/omapfb/omapfb-sys.c
   9  *driver by Tomi Valkeinen.
  10  *
  11  *
  12  * This program is free software; you can redistribute it and/or modify it
  13  * under the terms of the GNU General Public License version 2 as published by
  14  * the Free Software Foundation.
  15  *
  16  * This program is distributed in the hope that it will be useful, but WITHOUT
  17  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  18  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  19  * more details.
  20  *
  21  * You should have received a copy of the GNU General Public License along with
  22  * this program.  If not, see <http://www.gnu.org/licenses/>.
  23  */
  24
  25 #include <linux/fb.h>
  26 #include <linux/namei.h>
  27 #include <linux/sysfs.h>
  28 #include <linux/device.h>
  29 #include <linux/uaccess.h>
  30 #include <linux/platform_device.h>
  31 #include <linux/kernel.h>
  32 #include <linux/mm.h>
  33 #include <linux/vmalloc.h>
  34 #include <asm/div64.h>
  35 #include <linux/rk_screen.h>
  36 #include <linux/rk_fb.h>
  37 #if defined(CONFIG_ION_ROCKCHIP)
  38 #include <linux/rockchip_ion.h>
  39 #endif
  40 #include "bmp_helper.h"
  41 #include <linux/delay.h>
  42 struct rkfb_sys_trace {
  43         int num_frames;
  44         int count_frame;
  45         int mask_win;
  46         int mask_area;
  47         bool is_bmp;
  48         bool is_append;
  49 };
  50 #define DUMP_BUF_PATH           "/data/dmp_buf"
  51
  52 static char *get_format_str(enum data_format format)
  53 {
  54         switch (format) {
  55         case ARGB888:
  56                 return "ARGB888";
  57         case RGB888:
  58                 return "RGB888";
  59         case RGB565:
  60                 return "RGB565";
  61         case YUV420:
  62         case YUV420_NV21:
  63                 return "YUV420";
  64         case YUV422:
  65                 return "YUV422";
  66         case YUV444:
  67                 return "YUV444";
  68         case YUV420_A:
  69                 return "YUV420_A";
  70         case YUV422_A:
  71                 return "YUV422_A";
  72         case YUV444_A:
  73                 return "YUV444_A";
  74         case XRGB888:
  75                 return "XRGB888";
  76         case XBGR888:
  77                 return "XBGR888";
  78         case ABGR888:
  79                 return "ABGR888";
  80         case FBDC_RGB_565:
  81                 return "FBDC_RGB_565";
  82         case FBDC_ARGB_888:
  83                 return "FBDC_ARGB_888";
  84         case FBDC_RGBX_888:
  85                 return "FBDC_RGBX_888";
  86         default:
  87                 return "invalid";
  88         }
  89 }
  90
  91 static ssize_t show_screen_info(struct device *dev,
  92                                 struct device_attribute *attr, char *buf)
  93 {
  94         struct fb_info *fbi = dev_get_drvdata(dev);
  95         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
  96         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
  97         struct rk_screen *screen = dev_drv->cur_screen;
  98         int fps = 0;
  99         u32 x = screen->mode.left_margin + screen->mode.right_margin +
 100                 screen->mode.xres + screen->mode.hsync_len;
 101         u32 y = screen->mode.upper_margin + screen->mode.lower_margin +
 102                 screen->mode.yres + screen->mode.vsync_len;
 103         u64 ft = (u64)x * y * (dev_drv->pixclock);
 104
 105         if (ft > 0)
 106                 fps = div64_u64(1000000000000llu, ft);
 107         return snprintf(buf, PAGE_SIZE,
 108                         "xres:%d\nyres:%d\nfps:%d\ntype:%d\ninterlace:%d\n",
 109                         screen->mode.xres, screen->mode.yres,
 110                         fps, screen->type, screen->mode.vmode);
 111 }
 112
 113 static ssize_t set_screen_info(struct device *dev,
 114                                struct device_attribute *attr,
 115                                const char *buf, size_t count)
 116 {
 117         struct fb_info *fbi = dev_get_drvdata(dev);
 118         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
 119         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
 120         int xmirror = 0, ymirror = 0, ret = 0, rotate = 0;
 121
 122         ret = kstrtoint(buf, 0, &rotate);
 123         if (ret)
 124                 return ret;
 125         xmirror = !!(rotate & X_MIRROR);
 126         ymirror = !!(rotate & Y_MIRROR);
 127         dev_drv->cur_screen->x_mirror = xmirror;
 128         dev_drv->cur_screen->y_mirror = ymirror;
 129         dev_drv->rotate_mode = rotate;
 130         mutex_lock(&dev_drv->output_lock);
 131         mutex_lock(&dev_drv->win_config);
 132         if (dev_drv->ops->extern_func)
 133                 dev_drv->ops->extern_func(dev_drv, SET_DSP_MIRROR);
 134         mutex_unlock(&dev_drv->win_config);
 135         mutex_unlock(&dev_drv->output_lock);
 136
 137         return count;
 138 }
 139
 140 static ssize_t show_disp_info(struct device *dev,
 141                               struct device_attribute *attr, char *buf)
 142 {
 143         struct fb_info *fbi = dev_get_drvdata(dev);
 144         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
 145         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
 146         int win_id = dev_drv->ops->fb_get_win_id(dev_drv, fbi->fix.id);
 147
 148         if (dev_drv->ops->get_disp_info)
 149                 return dev_drv->ops->get_disp_info(dev_drv, buf, win_id);
 150
 151         return 0;
 152 }
 153
 154 static void fill_buffer(void *handle, void *vaddr, int size)
 155 {
 156         struct file *filp = handle;
 157
 158         if (filp)
 159                 vfs_write(filp, vaddr, size, &filp->f_pos);
 160 }
 161
 162 static void read_buffer(void *handle, void *vaddr, int size, loff_t pos)
 163 {
 164         struct file *filp = handle;
 165
 166         if (filp)
 167                 vfs_read(filp, vaddr, size, &pos);
 168 }
 169
 170 static int dump_win(struct ion_client *ion_client,
 171                     struct ion_handle *ion_handle, phys_addr_t phys_addr,
 172                     int width, int height, u8 data_format, uint32_t frameid,
 173                     int win_id, int area_id, bool is_bmp, bool is_append)
 174 {
 175         void __iomem *vaddr = NULL;
 176         struct file *filp;
 177         mm_segment_t old_fs;
 178         char name[100];
 179         int flags;
 180         int bits;
 181
 182         switch (data_format) {
 183         case XRGB888:
 184         case XBGR888:
 185         case ARGB888:
 186         case ABGR888:
 187         case FBDC_RGBX_888:
 188                 bits = 32;
 189                 break;
 190         case YUV444_A:
 191         case YUV444:
 192         case RGB888:
 193         case FBDC_ARGB_888:
 194                 bits = 24;
 195                 break;
 196         case RGB565:
 197         case FBDC_RGB_565:
 198         case YUV422:
 199         case YUV422_A:
 200                 bits = 16;
 201                 break;
 202         case YUV420_A:
 203         case YUV420:
 204         case YUV420_NV21:
 205                 bits = 12;
 206                 break;
 207         default:
 208                 return 0;
 209         }
 210
 211         if (ion_handle) {
 212                 vaddr = ion_map_kernel(ion_client, ion_handle);
 213         } else if (phys_addr) {
 214                 unsigned long start;
 215                 unsigned int nr_pages;
 216                 struct page **pages;
 217                 int i = 0;
 218
 219                 start = phys_addr;
 220                 nr_pages = roundup(width * height * (bits >> 3), PAGE_SIZE);
 221                 nr_pages /= PAGE_SIZE;
 222                 pages = kzalloc(sizeof(struct page) * nr_pages, GFP_KERNEL);
 223                 if (!pages)
 224                         return -ENOMEM;
 225                 while (i < nr_pages) {
 226                         pages[i] = phys_to_page(start);
 227                         start += PAGE_SIZE;
 228                         i++;
 229                 }
 230                 vaddr = vmap(pages, nr_pages, VM_MAP,
 231                              pgprot_writecombine(PAGE_KERNEL));
 232                 if (!vaddr) {
 233                         pr_err("failed to vmap phy addr %lx\n",
 234                                start);
 235                         return -1;
 236                 }
 237         } else {
 238                 return 0;
 239         }
 240
 241         flags = O_RDWR | O_CREAT | O_NONBLOCK;
 242         if (is_append) {
 243                 snprintf(name, 100, "%s/append_win%d_%d_%dx%d_%s.%s",
 244                          DUMP_BUF_PATH, win_id, area_id, width, height,
 245                          get_format_str(data_format), is_bmp ? "bmp" : "bin");
 246                 flags |= O_APPEND;
 247         } else {
 248                 snprintf(name, 100, "%s/frame%d_win%d_%d_%dx%d_%s.%s",
 249                          DUMP_BUF_PATH, frameid, win_id, area_id, width, height,
 250                          get_format_str(data_format), is_bmp ? "bmp" : "bin");
 251         }
 252
 253         pr_info("dump win == > %s\n", name);
 254         filp = filp_open(name, flags, 0x600);
 255         if (!filp)
 256                 pr_err("fail to create %s\n", name);
 257
 258         old_fs = get_fs();
 259         set_fs(KERNEL_DS);
 260
 261         if (is_bmp)
 262                 bmpencoder(vaddr, width, height,
 263                            data_format, filp, fill_buffer);
 264         else
 265                 fill_buffer(filp, vaddr, width * height * bits >> 3);
 266
 267         set_fs(old_fs);
 268
 269         if (ion_handle)
 270                 ion_unmap_kernel(ion_client, ion_handle);
 271         else if (vaddr)
 272                 vunmap(vaddr);
 273
 274         filp_close(filp, NULL);
 275
 276         return 0;
 277 }
 278
 279 static ssize_t show_dump_buffer(struct device *dev,
 280                                 struct device_attribute *attr, char *buf)
 281 {
 282         ssize_t size;
 283
 284         size = snprintf(buf, PAGE_SIZE,
 285                         "bmp       -- dump buffer to bmp image\n"
 286                         "             can't support dump to single file\n"
 287                         "bin       -- dump buffer to bin image\n"
 288                         "multi     -- each dump will create new file\n"
 289                         "             only works on trace context\n"
 290                         "win=num   -- mask win to dump, default mask all\n"
 291                         "             win=1, will dump win1 buffer\n"
 292                         "             win=23, will dump win2 area3 buffer\n"
 293                         "trace=num -- trace num frames buffer dump\n"
 294                         "             this option will block buffer switch\n"
 295                         "             so recommend use with bin and win=xx\n"
 296                         "\nExample:\n"
 297                         "echo bmp > dump_buf; -- dump current buf to bmp file\n"
 298                         "echo bin > dump_buf; -- dump current buf to bin file\n"
 299                         "echo trace=50:win=1:win=23 > dump_buf\n"
 300                         "         -- dump 50 frames, dump win1 and win2 area3\n"
 301                         "         -- dump all buffer to single file\n"
 302                         "You can found dump files at %s\n"
 303                         , DUMP_BUF_PATH);
 304
 305         return size;
 306 }
 307
 308 void trace_buffer_dump(struct device *dev, struct rk_lcdc_driver *dev_drv)
 309 {
 310         struct rk_fb *rk_fb = dev_get_drvdata(dev);
 311         struct rk_fb_reg_data *front_regs;
 312         struct rk_fb_reg_win_data *win_data;
 313         struct rk_fb_reg_area_data *area_data;
 314         struct rkfb_sys_trace *trace = dev_drv->trace_buf;
 315         int i, j;
 316
 317         if (!trace)
 318                 return;
 319         if (trace->num_frames <= trace->count_frame)
 320                 return;
 321
 322         if (!dev_drv->front_regs)
 323                 return;
 324         front_regs = dev_drv->front_regs;
 325
 326         for (i = 0; i < front_regs->win_num; i++) {
 327                 if (trace->mask_win && !(trace->mask_win & (1 << i)))
 328                         continue;
 329                 for (j = 0; j < RK_WIN_MAX_AREA; j++) {
 330                         win_data = &front_regs->reg_win_data[i];
 331                         area_data = &win_data->reg_area_data[j];
 332                         if (trace->mask_area && !(trace->mask_area & (1 << j)))
 333                                 continue;
 334
 335                         dump_win(rk_fb->ion_client, area_data->ion_handle,
 336                                  area_data->smem_start,
 337                                  area_data->xvir, area_data->yvir,
 338                                  area_data->data_format, trace->count_frame,
 339                                  i, j, trace->is_bmp, trace->is_append);
 340                 }
 341         }
 342         trace->count_frame++;
 343 }
 344
 345 static ssize_t set_dump_buffer(struct device *dev,
 346                                struct device_attribute *attr,
 347                                const char *buf, size_t count)
 348 {
 349         struct fb_info *fbi = dev_get_drvdata(dev);
 350         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
 351         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
 352         struct rk_fb *rk_fb = dev_get_drvdata(fbi->device);
 353         struct rk_fb_reg_data *front_regs;
 354         struct rk_fb_reg_win_data *win_data;
 355         struct rk_fb_reg_area_data *area_data;
 356         struct rkfb_sys_trace *trace;
 357         struct dentry *dentry;
 358         struct path path;
 359         int err = 0;
 360         int num_frames = 0;
 361         int mask_win = 0;
 362         int mask_area = 0;
 363         bool is_bmp = false;
 364         bool is_append = true;
 365         char *p;
 366         int i, j;
 367
 368         if (!rk_fb->ion_client)
 369                 return 0;
 370
 371         if (!dev_drv->trace_buf) {
 372                 dev_drv->trace_buf = devm_kmalloc(dev_drv->dev,
 373                                                   sizeof(struct rkfb_sys_trace),
 374                                                   GFP_KERNEL);
 375                 if (!dev_drv->trace_buf)
 376                         return -ENOMEM;
 377         }
 378         trace = dev_drv->trace_buf;
 379         /*
 380          * Stop buffer trace.
 381          */
 382         trace->num_frames = 0;
 383
 384         while ((p = strsep((char **)&buf, ":")) != NULL) {
 385                 if (!*p)
 386                         continue;
 387                 if (!strncmp(p, "trace=", 6)) {
 388                         if (kstrtoint(p + 6, 0, &num_frames))
 389                                 dev_err(dev, "can't found trace frames\n");
 390                         continue;
 391                 }
 392                 if (!strncmp(p, "win=", 4)) {
 393                         int win;
 394
 395                         if (kstrtoint(p + 4, 0, &win))
 396                                 dev_err(dev, "can't found trace frames\n");
 397                         if (win < 10) {
 398                                mask_win |= 1 << win;
 399                         } else {
 400                                 mask_win |= 1 << (win / 10);
 401                                 mask_area |= 1 << (win % 10);
 402                         }
 403
 404                         continue;
 405                 }
 406                 if (!strncmp(p, "bmp", 3)) {
 407                         is_bmp = true;
 408                         is_append = false;
 409                         continue;
 410                 }
 411                 if (!strncmp(p, "bin", 3)) {
 412                         is_bmp = false;
 413                         continue;
 414                 }
 415                 if (!strncmp(p, "multi", 5)) {
 416                         is_append = false;
 417                         continue;
 418                 }
 419
 420                 dev_err(dev, "unknown option %s\n", p);
 421         }
 422
 423         dentry = kern_path_create(AT_FDCWD, DUMP_BUF_PATH, &path,
 424                                   LOOKUP_DIRECTORY);
 425         if (!IS_ERR(dentry)) {
 426                 err = vfs_mkdir(path.dentry->d_inode, dentry, 700);
 427                 if (err)
 428                         dev_err(dev, "can't create %s err%d\n",
 429                                 DUMP_BUF_PATH, err);
 430                 done_path_create(&path, dentry);
 431         } else if (PTR_ERR(dentry) != -EEXIST) {
 432                 dev_err(dev, "can't create PATH %s err%d\n",
 433                                 DUMP_BUF_PATH, err);
 434                 return PTR_ERR(dentry);
 435         }
 436
 437         mutex_lock(&dev_drv->front_lock);
 438         if (!num_frames) {
 439                 if (!dev_drv->front_regs) {
 440                         u16 xact, yact;
 441                         int data_format;
 442                         u32 dsp_addr;
 443                         int ymirror;
 444
 445                         if (dev_drv->ops->get_dspbuf_info)
 446                                 dev_drv->ops->get_dspbuf_info(dev_drv, &xact,
 447                                                 &yact, &data_format, &dsp_addr,
 448                                                 &ymirror);
 449
 450                         dump_win(NULL, NULL, dsp_addr, xact, yact, data_format,
 451                                  0, 0, 0, is_bmp, false);
 452                         goto out;
 453                 }
 454                 front_regs = kmalloc(sizeof(*front_regs), GFP_KERNEL);
 455                 if (!front_regs) {
 456                         mutex_unlock(&dev_drv->front_lock);
 457                         return -ENOMEM;
 458                 }
 459                 memcpy(front_regs, dev_drv->front_regs, sizeof(*front_regs));
 460
 461                 for (i = 0; i < front_regs->win_num; i++) {
 462                         if (mask_win && !(mask_win & (1 << i)))
 463                                 continue;
 464                         for (j = 0; j < RK_WIN_MAX_AREA; j++) {
 465                                 if (mask_area && !(mask_area & (1 << j)))
 466                                         continue;
 467                                 win_data = &front_regs->reg_win_data[i];
 468                                 area_data = &win_data->reg_area_data[j];
 469                                 if (area_data->ion_handle)
 470                                         ion_handle_get(area_data->ion_handle);
 471                         }
 472                 }
 473
 474                 for (i = 0; i < front_regs->win_num; i++) {
 475                         if (mask_win && !(mask_win & (1 << i)))
 476                                 continue;
 477                         for (j = 0; j < RK_WIN_MAX_AREA; j++) {
 478                                 if (mask_area && !(mask_area & (1 << j)))
 479                                         continue;
 480
 481                                 win_data = &front_regs->reg_win_data[i];
 482                                 area_data = &win_data->reg_area_data[j];
 483
 484                                 dump_win(rk_fb->ion_client,
 485                                          area_data->ion_handle,
 486                                          area_data->smem_start,
 487                                          area_data->xvir, area_data->yvir,
 488                                          area_data->data_format,
 489                                          0, i, j, is_bmp, false);
 490                                 if (area_data->ion_handle)
 491                                         ion_handle_put(area_data->ion_handle);
 492                         }
 493                 }
 494
 495                 kfree(front_regs);
 496         } else {
 497                 trace->num_frames = num_frames;
 498                 trace->count_frame = 0;
 499                 trace->is_bmp = is_bmp;
 500                 trace->is_append = is_append;
 501                 trace->mask_win = mask_win;
 502                 trace->mask_area = mask_area;
 503         }
 504 out:
 505         mutex_unlock(&dev_drv->front_lock);
 506         return count;
 507 }
 508
 509 static ssize_t show_dsp_buffer(struct device *dev,
 510                                struct device_attribute *attr, char *buf)
 511 {
 512         ssize_t size;
 513
 514         size = snprintf(buf, PAGE_SIZE,
 515                         "you can display a picture store in "
 516                         "/data/fb0.bin use the following cmd:\n"
 517                         "echo n xsize ysize format > dsp_buf\n"
 518                         "n: picture number"
 519                         "xsize: picture horizontal size\n"
 520                         "ysize: picture vertical size\n"
 521                         "format:\n"
 522                         "    RGBA=1,RGBX=2,RGB=3,YUV420SP=17");
 523
 524         return size;
 525 }
 526 extern int __close_fd(struct files_struct *files, unsigned fd);
 527
 528 static ssize_t set_dsp_buffer(struct device *dev,
 529                               struct device_attribute *attr,
 530                               const char *buf, size_t count)
 531 {
 532         struct fb_info *fbi = dev_get_drvdata(dev);
 533         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
 534         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
 535         struct rk_fb *rk_fb = dev_get_drvdata(fbi->device);
 536         struct file *filp;
 537         mm_segment_t old_fs;
 538         int width, height, frame_num;
 539         int i, j, flags, fd;
 540         const char *start = buf;
 541         struct ion_handle *handle = NULL;
 542         char __iomem *screen_base;
 543         struct rk_fb_win_cfg_data *win_config = NULL;
 544         struct rk_screen *screen = dev_drv->cur_screen;
 545         int space_max = 10;
 546         int format;
 547         size_t mem_size = 0;
 548         char *name = "/data/fb0.bin";
 549         struct sync_fence *acq_fence;
 550         struct files_struct *files = current->files;
 551
 552         frame_num = simple_strtoul(start, NULL, 10);
 553         do {
 554                 start++;
 555                 space_max--;
 556         } while ((*start != ' ') && space_max);
 557         start++;
 558         width = simple_strtoul(start, NULL, 10);
 559         do {
 560                 start++;
 561                 space_max--;
 562         } while ((*start != ' ') && space_max);
 563         start++;
 564         height = simple_strtoul(start, NULL, 10);
 565
 566         do {
 567                 start++;
 568                 space_max--;
 569         } while ((*start != ' ') && space_max);
 570         start++;
 571         format = simple_strtoul(start, NULL, 10);
 572
 573         pr_info("frame_num=%d,w=%d,h=%d,file=%s,format=%d\n",
 574                 frame_num, width, height, name, format);
 575         flags = O_RDWR | O_CREAT | O_NONBLOCK;
 576         filp = filp_open(name, flags, 0x600);
 577         if (!filp)
 578                 pr_err("fail to create %s\n", name);
 579
 580         old_fs = get_fs();
 581         set_fs(KERNEL_DS);
 582
 583         mem_size = width * height * 4 * frame_num;
 584         if (dev_drv->iommu_enabled)
 585                 handle = ion_alloc(rk_fb->ion_client, mem_size, 0,
 586                                    ION_HEAP_SYSTEM_MASK, 0);
 587         else
 588                 handle = ion_alloc(rk_fb->ion_client, mem_size, 0,
 589                                    ION_HEAP_TYPE_DMA_MASK, 0);
 590         if (IS_ERR(handle)) {
 591                 pr_err("failed to ion_alloc:%ld\n", PTR_ERR(handle));
 592                 return -ENOMEM;
 593         }
 594         fd = ion_share_dma_buf_fd(rk_fb->ion_client, handle);
 595         if (fd < 0) {
 596                 pr_err("ion_share_dma_buf_fd failed, fd=%d\n", fd);
 597                 return fd;
 598         }
 599         screen_base = ion_map_kernel(rk_fb->ion_client, handle);
 600         read_buffer(filp, screen_base, mem_size, 0);
 601         win_config =
 602                 kzalloc(sizeof(*win_config), GFP_KERNEL);
 603         if (!win_config)
 604                 return -ENOMEM;
 605
 606         memset(win_config, 0, sizeof(struct rk_fb_win_cfg_data));
 607         win_config->wait_fs = 0;
 608         win_config->win_par[0].win_id = 0;
 609         win_config->win_par[0].z_order = 0;
 610         win_config->win_par[0].area_par[0].data_format = format;
 611         win_config->win_par[0].area_par[0].ion_fd = fd;
 612         win_config->win_par[0].area_par[0].x_offset = 0;
 613         win_config->win_par[0].area_par[0].y_offset = 0;
 614         win_config->win_par[0].area_par[0].xpos = 0;
 615         win_config->win_par[0].area_par[0].ypos = 0;
 616         win_config->win_par[0].area_par[0].xsize = screen->mode.xres;
 617         win_config->win_par[0].area_par[0].ysize = screen->mode.yres;
 618         win_config->win_par[0].area_par[0].xact = width;
 619         win_config->win_par[0].area_par[0].yact = height;
 620         win_config->win_par[0].area_par[0].xvir = width;
 621         win_config->win_par[0].area_par[0].yvir = height;
 622
 623         for (i = 0; i < frame_num; i++) {
 624                 win_config->win_par[0].area_par[0].y_offset = height * i;
 625                 fbi->fbops->fb_ioctl(fbi, RK_FBIOSET_CONFIG_DONE,
 626                                      (unsigned long)(win_config));
 627                 for (j = 0; j < RK_MAX_BUF_NUM; j++) {
 628                         if (win_config->rel_fence_fd[j] > 0) {
 629                                 acq_fence =
 630                                 sync_fence_fdget(win_config->rel_fence_fd[j]);
 631                                 sync_fence_put(acq_fence);
 632                         }
 633                 }
 634
 635                 if (win_config->ret_fence_fd > 0) {
 636                         acq_fence =
 637                         sync_fence_fdget(win_config->ret_fence_fd);
 638                         sync_fence_put(acq_fence);
 639                 }
 640         }
 641
 642         ion_unmap_kernel(rk_fb->ion_client, handle);
 643         ion_free(rk_fb->ion_client, handle);
 644         __close_fd(files, fd);
 645
 646         set_fs(old_fs);
 647         filp_close(filp, NULL);
 648         kfree(win_config);
 649         return count;
 650 }
 651
 652 static ssize_t show_phys(struct device *dev,
 653                          struct device_attribute *attr, char *buf)
 654 {
 655         struct fb_info *fbi = dev_get_drvdata(dev);
 656
 657         return snprintf(buf, PAGE_SIZE, "0x%lx-----0x%x\n",
 658                         fbi->fix.smem_start, fbi->fix.smem_len);
 659 }
 660
 661 static ssize_t show_virt(struct device *dev,
 662                          struct device_attribute *attr, char *buf)
 663 {
 664         struct fb_info *fbi = dev_get_drvdata(dev);
 665
 666         return snprintf(buf, PAGE_SIZE, "0x%p-----0x%x\n",
 667                         fbi->screen_base, fbi->fix.smem_len);
 668 }
 669
 670 static ssize_t show_fb_state(struct device *dev,
 671                              struct device_attribute *attr, char *buf)
 672 {
 673         struct fb_info *fbi = dev_get_drvdata(dev);
 674         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
 675         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
 676
 677         int win_id = dev_drv->ops->fb_get_win_id(dev_drv, fbi->fix.id);
 678         int state = dev_drv->ops->get_win_state(dev_drv, win_id, 0);
 679
 680         return snprintf(buf, PAGE_SIZE, "%s\n", state ? "enabled" : "disabled");
 681 }
 682
 683 static ssize_t show_dual_mode(struct device *dev,
 684                               struct device_attribute *attr, char *buf)
 685 {
 686         struct fb_info *fbi = dev_get_drvdata(dev);
 687         struct rk_fb *rk_fb = dev_get_drvdata(fbi->device);
 688         int mode = rk_fb->disp_mode;
 689
 690         return snprintf(buf, PAGE_SIZE, "%d\n", mode);
 691 }
 692
 693 static ssize_t set_fb_state(struct device *dev, struct device_attribute *attr,
 694                             const char *buf, size_t count)
 695 {
 696         struct fb_info *fbi = dev_get_drvdata(dev);
 697         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
 698         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
 699         int win_id = dev_drv->ops->fb_get_win_id(dev_drv, fbi->fix.id);
 700         int state;
 701         int ret;
 702
 703         ret = kstrtoint(buf, 0, &state);
 704         if (ret)
 705                 return ret;
 706         dev_drv->ops->open(dev_drv, win_id, state);
 707         if (state) {
 708                 dev_drv->ops->set_par(dev_drv, win_id);
 709                 dev_drv->ops->pan_display(dev_drv, win_id);
 710                 dev_drv->ops->cfg_done(dev_drv);
 711         }
 712         return count;
 713 }
 714
 715 static ssize_t show_overlay(struct device *dev,
 716                             struct device_attribute *attr, char *buf)
 717 {
 718         struct fb_info *fbi = dev_get_drvdata(dev);
 719         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
 720         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
 721         int ovl = 0;
 722
 723         if (dev_drv->ops->ovl_mgr)
 724                 ovl = dev_drv->ops->ovl_mgr(dev_drv, 0, 0);
 725
 726         if (ovl < 0)
 727                 return ovl;
 728
 729         return snprintf(buf, PAGE_SIZE, "%s\n",
 730                         ovl ? "win0 on the top of win1" :
 731                         "win1 on the top of win0");
 732 }
 733
 734 static ssize_t set_overlay(struct device *dev, struct device_attribute *attr,
 735                            const char *buf, size_t count)
 736 {
 737         struct fb_info *fbi = dev_get_drvdata(dev);
 738         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
 739         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
 740         u32 ovl;
 741         int ret;
 742
 743         ret = kstrtou32(buf, 0, &ovl);
 744         if (ret)
 745                 return ret;
 746         if (dev_drv->ops->ovl_mgr)
 747                 ret = dev_drv->ops->ovl_mgr(dev_drv, ovl, 1);
 748         if (ret < 0)
 749                 return ret;
 750
 751         return count;
 752 }
 753
 754 static ssize_t show_fps(struct device *dev,
 755                         struct device_attribute *attr, char *buf)
 756 {
 757         struct fb_info *fbi = dev_get_drvdata(dev);
 758         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
 759         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
 760         int fps = 0;
 761
 762         if (dev_drv->ops->fps_mgr)
 763                 fps = dev_drv->ops->fps_mgr(dev_drv, 0, 0);
 764         if (fps < 0)
 765                 return fps;
 766
 767         return snprintf(buf, PAGE_SIZE, "fps:%d\n", fps);
 768 }
 769
 770 static ssize_t set_fps(struct device *dev, struct device_attribute *attr,
 771                        const char *buf, size_t count)
 772 {
 773         struct fb_info *fbi = dev_get_drvdata(dev);
 774         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
 775         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
 776         struct rk_screen *screen = dev_drv->cur_screen;
 777         u32 fps, origin_fps;
 778         int ret;
 779
 780         ret = kstrtou32(buf, 0, &fps);
 781         if (ret)
 782                 return ret;
 783
 784         origin_fps = rk_fb_calc_fps(screen, dev_drv->pixclock);
 785
 786         /*
 787          * use too low or too high fps would make screen abnormal,
 788          * and maybe can't recovery, so limit the fps.
 789          */
 790         if (fps <= 40 || fps > origin_fps)
 791                 fps = origin_fps;
 792
 793         if (dev_drv->ops->fps_mgr)
 794                 ret = dev_drv->ops->fps_mgr(dev_drv, fps, 1);
 795         if (ret < 0)
 796                 return ret;
 797
 798         return count;
 799 }
 800
 801 static ssize_t show_fb_win_map(struct device *dev,
 802                                struct device_attribute *attr, char *buf)
 803 {
 804         int ret;
 805         struct fb_info *fbi = dev_get_drvdata(dev);
 806         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
 807         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
 808
 809         mutex_lock(&dev_drv->fb_win_id_mutex);
 810         ret =
 811             snprintf(buf, PAGE_SIZE, "fb0:win%d\nfb1:win%d\nfb2:win%d\n",
 812                      dev_drv->fb0_win_id, dev_drv->fb1_win_id,
 813                      dev_drv->fb2_win_id);
 814         mutex_unlock(&dev_drv->fb_win_id_mutex);
 815
 816         return ret;
 817 }
 818
 819 static ssize_t set_fb_win_map(struct device *dev, struct device_attribute *attr,
 820                               const char *buf, size_t count)
 821 {
 822         struct fb_info *fbi = dev_get_drvdata(dev);
 823         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
 824         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
 825         u32 order;
 826         int ret;
 827
 828         ret = kstrtou32(buf, 0, &order);
 829         if ((order != FB0_WIN2_FB1_WIN1_FB2_WIN0) &&
 830             (order != FB0_WIN1_FB1_WIN2_FB2_WIN0) &&
 831             (order != FB0_WIN2_FB1_WIN0_FB2_WIN1) &&
 832             (order != FB0_WIN0_FB1_WIN2_FB2_WIN1) &&
 833             (order != FB0_WIN0_FB1_WIN1_FB2_WIN2) &&
 834             (order != FB0_WIN1_FB1_WIN0_FB2_WIN2)) {
 835                 dev_info(dev, "un supported map\n"
 836                        "you can use the following order:\n" "201:\n"
 837                        "fb0-win1\n" "fb1-win0\n" "fb2-win2\n" "210:\n"
 838                        "fb0-win0\n" "fb1-win1\n" "fb2-win2\n" "120:\n"
 839                        "fb0-win0\n" "fb1-win2\n" "fb2-win1\n" "102:\n"
 840                        "fb0-win2\n" "fb1-win0\n" "fb2-win1\n" "021:\n"
 841                        "fb0-win1\n" "fb1-win2\n" "fb2-win0\n" "012:\n"
 842                        "fb0-win2\n" "fb1-win1\n" "fb2-win0\n");
 843                 return count;
 844         } else {
 845                 if (dev_drv->ops->fb_win_remap)
 846                         dev_drv->ops->fb_win_remap(dev_drv, order);
 847         }
 848
 849         return count;
 850 }
 851
 852 static ssize_t show_hwc_lut(struct device *dev,
 853                             struct device_attribute *attr, char *buf)
 854 {
 855         return 0;
 856 }
 857
 858 static ssize_t set_hwc_lut(struct device *dev, struct device_attribute *attr,
 859                            const char *buf, size_t count)
 860 {
 861         int *hwc_lut = NULL;
 862         const char *start = buf;
 863         int i = 256, temp;
 864         int space_max;
 865
 866         struct fb_info *fbi = dev_get_drvdata(dev);
 867         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
 868         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
 869
 870         hwc_lut = kzalloc(256 * 4, GFP_KERNEL);
 871         if (!hwc_lut)
 872                 return -ENOMEM;
 873         /*printk("count:%d\n>>%s\n\n",count,start);*/
 874         for (i = 0; i < 256; i++) {
 875                 space_max = 15; /*max space number 15*/
 876                 temp = simple_strtoul(start, NULL, 16);
 877                 hwc_lut[i] = temp;
 878                 do {
 879                         start++;
 880                         space_max--;
 881                 } while ((*start != ' ') && space_max);
 882
 883                 if (!space_max)
 884                         break;
 885                 else
 886                         start++;
 887         }
 888         if (dev_drv->ops->set_hwc_lut)
 889                 dev_drv->ops->set_hwc_lut(dev_drv, hwc_lut, 1);
 890         kfree(hwc_lut);
 891
 892         return count;
 893 }
 894
 895 static ssize_t show_cabc_lut(struct device *dev,
 896                              struct device_attribute *attr, char *buf)
 897 {
 898         return 0;
 899 }
 900
 901 static ssize_t set_cabc_lut(struct device *dev, struct device_attribute *attr,
 902                             const char *buf, size_t count)
 903 {
 904         int *cabc_lut = NULL;
 905         const char *start = buf;
 906         int i = 256, temp;
 907         int space_max = 10;
 908
 909         struct fb_info *fbi = dev_get_drvdata(dev);
 910         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
 911         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
 912
 913         cabc_lut = kzalloc(256 * 4, GFP_KERNEL);
 914         if (!cabc_lut)
 915                 return -ENOMEM;
 916         for (i = 0; i < 256; i++) {
 917                 temp = i;
 918                 /*init by default value*/
 919                 cabc_lut[i] = temp + (temp << 8) + (temp << 16);
 920         }
 921         for (i = 0; i < 256; i++) {
 922                 space_max = 10; /*max space number 10*/
 923                 temp = simple_strtoul(start, NULL, 10);
 924                 cabc_lut[i] = temp;
 925                 do {
 926                         start++;
 927                         space_max--;
 928                 } while ((*start != ' ') && space_max);
 929
 930                 if (!space_max)
 931                         break;
 932                 else
 933                         start++;
 934         }
 935         if (dev_drv->ops->set_cabc_lut)
 936                 dev_drv->ops->set_cabc_lut(dev_drv, cabc_lut);
 937
 938         kfree(cabc_lut);
 939         return count;
 940 }
 941
 942 static ssize_t show_dsp_lut(struct device *dev,
 943                             struct device_attribute *attr, char *buf)
 944 {
 945         return 0;
 946 }
 947
 948 static ssize_t set_dsp_lut(struct device *dev, struct device_attribute *attr,
 949                            const char *buf, size_t count)
 950 {
 951         int *dsp_lut = NULL;
 952         const char *start = buf;
 953         int i = 256, temp;
 954         int space_max = 10;
 955
 956         struct fb_info *fbi = dev_get_drvdata(dev);
 957         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
 958         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
 959
 960         dsp_lut = kzalloc(256 * 4, GFP_KERNEL);
 961         if (!dsp_lut)
 962                 return -ENOMEM;
 963         for (i = 0; i < 256; i++) {
 964                 temp = i;
 965                 /*init by default value*/
 966                 dsp_lut[i] = temp + (temp << 8) + (temp << 16);
 967         }
 968         /*printk("count:%d\n>>%s\n\n",count,start);*/
 969         for (i = 0; i < 256; i++) {
 970                 space_max = 10; /*max space number 10*/
 971                 temp = simple_strtoul(start, NULL, 10);
 972                 dsp_lut[i] = temp;
 973                 do {
 974                         start++;
 975                         space_max--;
 976                 } while ((*start != ' ') && space_max);
 977
 978                 if (!space_max)
 979                         break;
 980                 else
 981                         start++;
 982         }
 983         if (dev_drv->ops->set_dsp_lut)
 984                 dev_drv->ops->set_dsp_lut(dev_drv, dsp_lut);
 985
 986         kfree(dsp_lut);
 987         return count;
 988 }
 989
 990 static ssize_t show_dsp_cabc(struct device *dev,
 991                              struct device_attribute *attr, char *buf)
 992 {
 993         struct fb_info *fbi = dev_get_drvdata(dev);
 994         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
 995         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
 996
 997         return snprintf(buf, PAGE_SIZE, "cabc mode=%d\n",
 998                 dev_drv->cabc_mode);
 999         return 0;
1000 }
1001
1002 static ssize_t set_dsp_cabc(struct device *dev, struct device_attribute *attr,
1003                             const char *buf, size_t count)
1004 {
1005         struct fb_info *fbi = dev_get_drvdata(dev);
1006         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
1007         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
1008         int space_max, ret = 0;
1009         int mode = 0, calc = 0, up = 0, down = 0, global = 0;
1010         const char *start = buf;
1011
1012         space_max = 10; /*max space number 10*/
1013         mode = simple_strtoul(start, NULL, 10);
1014         do {
1015                 start++;
1016                 space_max--;
1017         } while ((*start != ' ') && space_max);
1018         start++;
1019         calc = simple_strtoul(start, NULL, 10);
1020
1021         do {
1022                 start++;
1023                 space_max--;
1024         } while ((*start != ' ') && space_max);
1025         start++;
1026         up  = simple_strtoul(start, NULL, 10);
1027
1028         do {
1029                 start++;
1030                 space_max--;
1031         } while ((*start != ' ') && space_max);
1032         start++;
1033         down = simple_strtoul(start, NULL, 10);
1034
1035         do {
1036                 start++;
1037                 space_max--;
1038         } while ((*start != ' ') && space_max);
1039         start++;
1040         global = simple_strtoul(start, NULL, 10);
1041
1042         if (dev_drv->ops->set_dsp_cabc)
1043                 ret = dev_drv->ops->set_dsp_cabc(dev_drv, mode,
1044                                                  calc, up, down, global);
1045         if (ret < 0)
1046                 return ret;
1047
1048         return count;
1049 }
1050
1051 static ssize_t show_dsp_bcsh(struct device *dev,
1052                              struct device_attribute *attr, char *buf)
1053 {
1054         struct fb_info *fbi = dev_get_drvdata(dev);
1055         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
1056         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
1057         int brightness = 0, contrast = 0, sat_con = 0, sin_hue = 0, cos_hue = 0;
1058
1059         if (dev_drv->ops->get_dsp_bcsh_bcs) {
1060                 brightness = dev_drv->ops->get_dsp_bcsh_bcs(dev_drv,
1061                                                             BRIGHTNESS);
1062                 contrast = dev_drv->ops->get_dsp_bcsh_bcs(dev_drv, CONTRAST);
1063                 sat_con = dev_drv->ops->get_dsp_bcsh_bcs(dev_drv, SAT_CON);
1064         }
1065         if (dev_drv->ops->get_dsp_bcsh_hue) {
1066                 sin_hue = dev_drv->ops->get_dsp_bcsh_hue(dev_drv, H_SIN);
1067                 cos_hue = dev_drv->ops->get_dsp_bcsh_hue(dev_drv, H_COS);
1068         }
1069         return snprintf(buf, PAGE_SIZE,
1070                         "brightness:%4d,contrast:%4d,sat_con:%4d,"
1071                         "sin_hue:%4d,cos_hue:%4d\n",
1072                         brightness, contrast, sat_con, sin_hue, cos_hue);
1073 }
1074
1075 static ssize_t set_dsp_bcsh(struct device *dev, struct device_attribute *attr,
1076                             const char *buf, size_t count)
1077 {
1078         struct fb_info *fbi = dev_get_drvdata(dev);
1079         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
1080         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
1081         int brightness, contrast, sat_con, ret = 0, sin_hue, cos_hue;
1082
1083         if (!strncmp(buf, "open", 4)) {
1084                 if (dev_drv->ops->open_bcsh)
1085                         ret = dev_drv->ops->open_bcsh(dev_drv, 1);
1086                 else
1087                         ret = -1;
1088         } else if (!strncmp(buf, "close", 5)) {
1089                 if (dev_drv->ops->open_bcsh)
1090                         ret = dev_drv->ops->open_bcsh(dev_drv, 0);
1091                 else
1092                         ret = -1;
1093         } else if (!strncmp(buf, "brightness", 10)) {
1094                 sscanf(buf, "brightness %d", &brightness);
1095                 if (unlikely(brightness > 255)) {
1096                         dev_err(fbi->dev,
1097                                 "brightness should be [0:255],now=%d\n\n",
1098                                 brightness);
1099                         brightness = 255;
1100                 }
1101                 if (dev_drv->ops->set_dsp_bcsh_bcs)
1102                         ret = dev_drv->ops->set_dsp_bcsh_bcs(dev_drv,
1103                                                              BRIGHTNESS,
1104                                                              brightness);
1105                 else
1106                         ret = -1;
1107         } else if (!strncmp(buf, "contrast", 8)) {
1108                 sscanf(buf, "contrast %d", &contrast);
1109                 if (unlikely(contrast > 510)) {
1110                         dev_err(fbi->dev,
1111                                 "contrast should be [0:510],now=%d\n",
1112                                 contrast);
1113                         contrast = 510;
1114                 }
1115                 if (dev_drv->ops->set_dsp_bcsh_bcs)
1116                         ret = dev_drv->ops->set_dsp_bcsh_bcs(dev_drv,
1117                                                              CONTRAST,
1118                                                              contrast);
1119                 else
1120                         ret = -1;
1121         } else if (!strncmp(buf, "sat_con", 7)) {
1122                 sscanf(buf, "sat_con %d", &sat_con);
1123                 if (unlikely(sat_con > 1015)) {
1124                         dev_err(fbi->dev,
1125                                 "sat_con should be [0:1015],now=%d\n",
1126                                 sat_con);
1127                         sat_con = 1015;
1128                 }
1129                 if (dev_drv->ops->set_dsp_bcsh_bcs)
1130                         ret = dev_drv->ops->set_dsp_bcsh_bcs(dev_drv,
1131                                                              SAT_CON,
1132                                                              sat_con);
1133                 else
1134                         ret = -1;
1135         } else if (!strncmp(buf, "hue", 3)) {
1136                 sscanf(buf, "hue %d %d", &sin_hue, &cos_hue);
1137                 if (unlikely(sin_hue > 511 || cos_hue > 511)) {
1138                         dev_err(fbi->dev, "sin_hue=%d,cos_hue=%d\n",
1139                                 sin_hue, cos_hue);
1140                 }
1141                 if (dev_drv->ops->set_dsp_bcsh_hue)
1142                         ret = dev_drv->ops->set_dsp_bcsh_hue(dev_drv,
1143                                                              sin_hue,
1144                                                              cos_hue);
1145                 else
1146                         ret = -1;
1147         } else {
1148                 dev_info(dev, "format error\n");
1149         }
1150
1151         if (ret < 0)
1152                 return ret;
1153
1154         return count;
1155 }
1156
1157 static ssize_t show_scale(struct device *dev,
1158                           struct device_attribute *attr, char *buf)
1159 {
1160         struct fb_info *fbi = dev_get_drvdata(dev);
1161         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
1162         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
1163
1164         return snprintf(buf, PAGE_SIZE,
1165                 "xscale=%d yscale=%d\nleft=%d top=%d right=%d bottom=%d\n",
1166                 (dev_drv->overscan.left + dev_drv->overscan.right) / 2,
1167                 (dev_drv->overscan.top + dev_drv->overscan.bottom) / 2,
1168                 dev_drv->overscan.left, dev_drv->overscan.top,
1169                 dev_drv->overscan.right, dev_drv->overscan.bottom);
1170 }
1171
1172 static ssize_t set_scale(struct device *dev, struct device_attribute *attr,
1173                          const char *buf, size_t count)
1174 {
1175         struct fb_info *fbi = dev_get_drvdata(dev);
1176         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
1177         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
1178         u32 left, top, right, bottom;
1179
1180         if (!strncmp(buf, "overscan", 8)) {
1181                 sscanf(buf,
1182                        "overscan %d,%d,%d,%d", &left, &top, &right, &bottom);
1183                 if (left > 0 && left <= 100)
1184                         dev_drv->overscan.left = left;
1185                 if (top > 0 && top <= 100)
1186                         dev_drv->overscan.top = top;
1187                 if (right > 0 && right <= 100)
1188                         dev_drv->overscan.right = right;
1189                 if (bottom > 0 && bottom <= 100)
1190                         dev_drv->overscan.bottom = bottom;
1191         } else if (!strncmp(buf, "left", 4)) {
1192                 sscanf(buf, "left=%d", &left);
1193                 if (left > 0 && left <= 100)
1194                         dev_drv->overscan.left = left;
1195         } else if (!strncmp(buf, "top", 3)) {
1196                 sscanf(buf, "top=%d", &top);
1197                 if (top > 0 && top <= 100)
1198                         dev_drv->overscan.top = top;
1199         } else if (!strncmp(buf, "right", 5)) {
1200                 sscanf(buf, "right=%d", &right);
1201                 if (right > 0 && right <= 100)
1202                         dev_drv->overscan.right = right;
1203         } else if (!strncmp(buf, "bottom", 6)) {
1204                 sscanf(buf, "bottom=%d", &bottom);
1205                 if (bottom > 0 && bottom <= 100)
1206                         dev_drv->overscan.bottom = bottom;
1207         } else if (!strncmp(buf, "xscale", 6)) {
1208                 sscanf(buf, "xscale=%d", &left);
1209                 if (left > 0 && left <= 100) {
1210                         dev_drv->overscan.left = left;
1211                         dev_drv->overscan.right = left;
1212                 }
1213         } else if (!strncmp(buf, "yscale", 6)) {
1214                 sscanf(buf, "yscale=%d", &left);
1215                 if (left > 0 && left <= 100) {
1216                         dev_drv->overscan.top = left;
1217                         dev_drv->overscan.bottom = left;
1218                 }
1219         } else {
1220                 sscanf(buf, "%d", &left);
1221                 if (left > 0 && left <= 100) {
1222                         dev_drv->overscan.left = left;
1223                         dev_drv->overscan.right = left;
1224                         dev_drv->overscan.top = left;
1225                         dev_drv->overscan.bottom = left;
1226                 }
1227         }
1228
1229         if (dev_drv->ops->set_overscan)
1230                 dev_drv->ops->set_overscan(dev_drv, &dev_drv->overscan);
1231
1232         return count;
1233 }
1234
1235 static ssize_t show_lcdc_id(struct device *dev,
1236                             struct device_attribute *attr,
1237                             char *buf)
1238 {
1239         struct fb_info *fbi = dev_get_drvdata(dev);
1240         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
1241         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
1242
1243         return snprintf(buf, PAGE_SIZE, "%d\n", dev_drv->id);
1244 }
1245
1246 static ssize_t show_dsp_mode(struct device *dev,
1247                             struct device_attribute *attr,
1248                             char *buf)
1249 {
1250         struct fb_info *fbi = dev_get_drvdata(dev);
1251         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
1252         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
1253
1254         return snprintf(buf, PAGE_SIZE, "%d\n", dev_drv->dsp_mode);
1255 }
1256
1257 static ssize_t show_hot_plug_state(struct device *dev,
1258                             struct device_attribute *attr,
1259                             char *buf)
1260 {
1261         struct fb_info *fbi = dev_get_drvdata(dev);
1262         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
1263         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
1264
1265         return snprintf(buf, PAGE_SIZE, "%d\n", dev_drv->hot_plug_state);
1266 }
1267
1268 static ssize_t show_win_property(struct device *dev,
1269                                  struct device_attribute *attr,
1270                                  char *buf)
1271 {
1272         struct fb_info *fbi = dev_get_drvdata(dev);
1273         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
1274         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
1275         int win_id = 0;
1276
1277         win_id = dev_drv->ops->fb_get_win_id(dev_drv, fbi->fix.id);
1278         return snprintf(buf, PAGE_SIZE,
1279                         "feature: %d, max_input_x: %d, max_input_y: %d\n",
1280                         dev_drv->win[win_id]->property.feature,
1281                         dev_drv->win[win_id]->property.max_input_x,
1282                         dev_drv->win[win_id]->property.max_input_y);
1283 }
1284
1285 static ssize_t set_car_reverse(struct device *dev,
1286                                struct device_attribute *attr,
1287                                const char *buf, size_t count)
1288 {
1289         struct fb_info *fbi = dev_get_drvdata(dev);
1290         struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
1291         struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
1292         u32 status;
1293         int ret;
1294
1295         ret = kstrtou32(buf, 0, &status);
1296         if (ret)
1297                 return ret;
1298         rk_fb_set_car_reverse_status(dev_drv, status);
1299
1300         return count;
1301 }
1302
1303 static struct device_attribute rkfb_attrs[] = {
1304         __ATTR(phys_addr, S_IRUGO, show_phys, NULL),
1305         __ATTR(virt_addr, S_IRUGO, show_virt, NULL),
1306         __ATTR(disp_info, S_IRUGO, show_disp_info, NULL),
1307         __ATTR(dump_buf, S_IRUGO | S_IWUSR, show_dump_buffer, set_dump_buffer),
1308         __ATTR(dsp_buf, S_IRUGO | S_IWUSR, show_dsp_buffer, set_dsp_buffer),
1309         __ATTR(screen_info, S_IRUGO | S_IWUSR,
1310                show_screen_info, set_screen_info),
1311         __ATTR(dual_mode, S_IRUGO, show_dual_mode, NULL),
1312         __ATTR(enable, S_IRUGO | S_IWUSR, show_fb_state, set_fb_state),
1313         __ATTR(overlay, S_IRUGO | S_IWUSR, show_overlay, set_overlay),
1314         __ATTR(fps, S_IRUGO | S_IWUSR, show_fps, set_fps),
1315         __ATTR(map, S_IRUGO | S_IWUSR, show_fb_win_map, set_fb_win_map),
1316         __ATTR(dsp_lut, S_IRUGO | S_IWUSR, show_dsp_lut, set_dsp_lut),
1317         __ATTR(cabc_lut, S_IRUGO | S_IWUSR, show_cabc_lut, set_cabc_lut),
1318         __ATTR(hwc_lut, S_IRUGO | S_IWUSR, show_hwc_lut, set_hwc_lut),
1319         __ATTR(cabc, S_IRUGO | S_IWUSR, show_dsp_cabc, set_dsp_cabc),
1320         __ATTR(bcsh, S_IRUGO | S_IWUSR, show_dsp_bcsh, set_dsp_bcsh),
1321         __ATTR(scale, S_IRUGO | S_IWUSR, show_scale, set_scale),
1322         __ATTR(lcdcid, S_IRUGO, show_lcdc_id, NULL),
1323         __ATTR(win_property, S_IRUGO, show_win_property, NULL),
1324         __ATTR(car_reverse, S_IWUSR, NULL, set_car_reverse),
1325         __ATTR(dsp_mode, S_IRUGO, show_dsp_mode, NULL),
1326         __ATTR(hot_plug_state, S_IRUGO, show_hot_plug_state, NULL),
1327 };
1328
1329 int rkfb_create_sysfs(struct fb_info *fbi)
1330 {
1331         int r, t;
1332
1333         for (t = 0; t < ARRAY_SIZE(rkfb_attrs); t++) {
1334                 r = device_create_file(fbi->dev, &rkfb_attrs[t]);
1335                 if (r) {
1336                         dev_err(fbi->dev, "failed to create sysfs " "file\n");
1337                         return r;
1338                 }
1339         }
1340
1341         return 0;
1342 }
1343
1344 void rkfb_remove_sysfs(struct rk_fb *rk_fb)
1345 {
1346         int i, t;
1347
1348         for (i = 0; i < rk_fb->num_fb; i++) {
1349                 for (t = 0; t < ARRAY_SIZE(rkfb_attrs); t++)
1350                         device_remove_file(rk_fb->fb[i]->dev, &rkfb_attrs[t]);
1351         }
1352 }