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