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