2 * linux/drivers/video/rockchip/rkfb-sysfs.c
4 * Copyright (C) 2012 Rockchip Corporation
5 * Author: yxj<yxj@rock-chips.com>
7 * Some code and ideas taken from
8 *drivers/video/omap2/omapfb/omapfb-sys.c
9 *driver by Tomi Valkeinen.
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.
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
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/>.
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>
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>
40 #include "bmp_helper.h"
41 #include <linux/delay.h>
42 struct rkfb_sys_trace {
50 #define DUMP_BUF_PATH "/data/dmp_buf"
52 static char *get_format_str(enum data_format format)
81 return "FBDC_RGB_565";
83 return "FBDC_ARGB_888";
85 return "FBDC_RGBX_888";
91 static ssize_t show_screen_info(struct device *dev,
92 struct device_attribute *attr, char *buf)
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;
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);
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);
113 static ssize_t show_disp_info(struct device *dev,
114 struct device_attribute *attr, char *buf)
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);
121 if (dev_drv->ops->get_disp_info)
122 return dev_drv->ops->get_disp_info(dev_drv, buf, win_id);
127 static void fill_buffer(void *handle, void *vaddr, int size)
129 struct file *filp = handle;
132 vfs_write(filp, vaddr, size, &filp->f_pos);
135 static void read_buffer(void *handle, void *vaddr, int size, loff_t pos)
137 struct file *filp = handle;
140 vfs_read(filp, vaddr, size, &pos);
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)
148 void __iomem *vaddr = NULL;
155 switch (data_format) {
185 vaddr = ion_map_kernel(ion_client, ion_handle);
186 } else if (phys_addr) {
188 unsigned int nr_pages;
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);
201 vaddr = vmap(pages, nr_pages, VM_MAP,
202 pgprot_writecombine(PAGE_KERNEL));
204 pr_err("failed to vmap phy addr %lx\n",
212 flags = O_RDWR | O_CREAT | O_NONBLOCK;
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");
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");
224 pr_info("dump win == > %s\n", name);
225 filp = filp_open(name, flags, 0x600);
227 printk("fail to create %s\n", name);
233 bmpencoder(vaddr, width, height,
234 data_format, filp, fill_buffer);
236 fill_buffer(filp, vaddr, width * height * bits >> 3);
241 ion_unmap_kernel(ion_client, ion_handle);
245 filp_close(filp, NULL);
250 static ssize_t show_dump_buffer(struct device *dev,
251 struct device_attribute *attr, char *buf)
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"
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"
277 void trace_buffer_dump(struct device *dev, struct rk_lcdc_driver *dev_drv)
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;
288 if (trace->num_frames <= trace->count_frame)
291 if (!dev_drv->front_regs)
293 front_regs = dev_drv->front_regs;
295 for (i = 0; i < front_regs->win_num; i++) {
296 if (trace->mask_win && !(trace->mask_win & (1 << i)))
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)))
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);
311 trace->count_frame++;
314 static ssize_t set_dump_buffer(struct device *dev,
315 struct device_attribute *attr,
316 const char *buf, size_t count)
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;
333 bool is_append = true;
337 if (!rk_fb->ion_client)
340 if (!dev_drv->trace_buf) {
341 dev_drv->trace_buf = devm_kmalloc(dev_drv->dev,
342 sizeof(struct rkfb_sys_trace),
344 if (!dev_drv->trace_buf)
347 trace = dev_drv->trace_buf;
351 trace->num_frames = 0;
353 while ((p = strsep((char **)&buf, ":")) != NULL) {
356 if (!strncmp(p, "trace=", 6)) {
357 if (kstrtoint(p + 6, 0, &num_frames))
358 dev_err(dev, "can't found trace frames\n");
361 if (!strncmp(p, "win=", 4)) {
364 if (kstrtoint(p + 4, 0, &win))
365 dev_err(dev, "can't found trace frames\n");
367 mask_win |= 1 << win;
369 mask_win |= 1 << (win / 10);
370 mask_area |= 1 << (win % 10);
375 if (!strncmp(p, "bmp", 3)) {
380 if (!strncmp(p, "bin", 3)) {
384 if (!strncmp(p, "multi", 5)) {
390 dev_err(dev, "unknown option %s\n", p);
393 dentry = kern_path_create(AT_FDCWD, DUMP_BUF_PATH, &path,
395 if (!IS_ERR(dentry)) {
396 err = vfs_mkdir(path.dentry->d_inode, dentry, 700);
398 dev_err(dev, "can't create %s err%d\n",
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",
404 return PTR_ERR(dentry);
408 mutex_lock(&dev_drv->front_lock);
410 if (!dev_drv->front_regs) {
415 mutex_unlock(&dev_drv->front_lock);
417 if (dev_drv->ops->get_dspbuf_info)
418 dev_drv->ops->get_dspbuf_info(dev_drv, &xact,
419 &yact, &data_format, &dsp_addr);
421 dump_win(NULL, NULL, dsp_addr, xact, yact, data_format,
422 0, 0, 0, is_bmp, false);
425 front_regs = kmalloc(sizeof(*front_regs), GFP_KERNEL);
428 memcpy(front_regs, dev_drv->front_regs, sizeof(*front_regs));
430 for (i = 0; i < front_regs->win_num; i++) {
431 if (mask_win && !(mask_win & (1 << i)))
433 for (j = 0; j < RK_WIN_MAX_AREA; j++) {
434 if (mask_area && !(mask_area & (1 << j)))
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);
443 for (i = 0; i < front_regs->win_num; i++) {
444 if (mask_win && !(mask_win & (1 << i)))
446 for (j = 0; j < RK_WIN_MAX_AREA; j++) {
447 if (mask_area && !(mask_area & (1 << j)))
450 win_data = &front_regs->reg_win_data[i];
451 area_data = &win_data->reg_area_data[j];
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);
465 mutex_unlock(&dev_drv->front_lock);
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;
479 static ssize_t show_dsp_buffer(struct device *dev,
480 struct device_attribute *attr, char *buf)
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"
489 "xsize: picture horizontal size\n"
490 "ysize: picture vertical size\n"
492 " RGBA=1,RGBX=2,RGB=3,YUV420SP=17");
496 extern int __close_fd(struct files_struct *files, unsigned fd);
498 static ssize_t set_dsp_buffer(struct device *dev,
499 struct device_attribute *attr,
500 const char *buf, size_t count)
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);
508 int width, height, frame_num;
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;
518 char *name = "/data/fb0.bin";
519 struct sync_fence *acq_fence;
520 struct files_struct *files = current->files;
522 frame_num = simple_strtoul(start, NULL, 10);
526 } while ((*start != ' ') && space_max);
528 width = simple_strtoul(start, NULL, 10);
532 } while ((*start != ' ') && space_max);
534 height = simple_strtoul(start, NULL, 10);
539 } while ((*start != ' ') && space_max);
541 format = simple_strtoul(start, NULL, 10);
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);
548 pr_err("fail to create %s\n", name);
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);
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));
564 fd = ion_share_dma_buf_fd(rk_fb->ion_client, handle);
566 pr_err("ion_share_dma_buf_fd failed, fd=%d\n", fd);
569 screen_base = ion_map_kernel(rk_fb->ion_client, handle);
570 read_buffer(filp, screen_base, mem_size, 0);
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;
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) {
596 sync_fence_fdget(win_config.rel_fence_fd[j]);
597 sync_fence_put(acq_fence);
601 if (win_config.ret_fence_fd > 0){
603 sync_fence_fdget(win_config.ret_fence_fd);
604 sync_fence_put(acq_fence);
608 ion_unmap_kernel(rk_fb->ion_client, handle);
609 ion_free(rk_fb->ion_client, handle);
610 __close_fd(files, fd);
613 filp_close(filp, NULL);
618 static ssize_t show_phys(struct device *dev,
619 struct device_attribute *attr, char *buf)
621 struct fb_info *fbi = dev_get_drvdata(dev);
623 return snprintf(buf, PAGE_SIZE, "0x%lx-----0x%x\n",
624 fbi->fix.smem_start, fbi->fix.smem_len);
627 static ssize_t show_virt(struct device *dev,
628 struct device_attribute *attr, char *buf)
630 struct fb_info *fbi = dev_get_drvdata(dev);
632 return snprintf(buf, PAGE_SIZE, "0x%p-----0x%x\n",
633 fbi->screen_base, fbi->fix.smem_len);
636 static ssize_t show_fb_state(struct device *dev,
637 struct device_attribute *attr, char *buf)
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;
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);
646 return snprintf(buf, PAGE_SIZE, "%s\n", state ? "enabled" : "disabled");
649 static ssize_t show_dual_mode(struct device *dev,
650 struct device_attribute *attr, char *buf)
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;
656 return snprintf(buf, PAGE_SIZE, "%d\n", mode);
659 static ssize_t set_fb_state(struct device *dev, struct device_attribute *attr,
660 const char *buf, size_t count)
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);
669 ret = kstrtoint(buf, 0, &state);
672 dev_drv->ops->open(dev_drv, win_id, 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);
681 static ssize_t show_overlay(struct device *dev,
682 struct device_attribute *attr, char *buf)
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;
689 if (dev_drv->ops->ovl_mgr)
690 ovl = dev_drv->ops->ovl_mgr(dev_drv, 0, 0);
695 return snprintf(buf, PAGE_SIZE, "%s\n",
696 ovl ? "win0 on the top of win1" :
697 "win1 on the top of win0");
700 static ssize_t set_overlay(struct device *dev, struct device_attribute *attr,
701 const char *buf, size_t count)
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;
709 ret = kstrtou32(buf, 0, &ovl);
712 if (dev_drv->ops->ovl_mgr)
713 ret = dev_drv->ops->ovl_mgr(dev_drv, ovl, 1);
720 static ssize_t show_fps(struct device *dev,
721 struct device_attribute *attr, char *buf)
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;
728 if (dev_drv->ops->fps_mgr)
729 fps = dev_drv->ops->fps_mgr(dev_drv, 0, 0);
733 return snprintf(buf, PAGE_SIZE, "fps:%d\n", fps);
736 static ssize_t set_fps(struct device *dev, struct device_attribute *attr,
737 const char *buf, size_t count)
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;
745 ret = kstrtou32(buf, 0, &fps);
749 if (fps == 0 || fps > 60) {
750 dev_info(dev, "unsupport fps value,pelase set 1~60\n");
754 if (dev_drv->ops->fps_mgr)
755 ret = dev_drv->ops->fps_mgr(dev_drv, fps, 1);
762 static ssize_t show_fb_win_map(struct device *dev,
763 struct device_attribute *attr, char *buf)
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;
770 mutex_lock(&dev_drv->fb_win_id_mutex);
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);
780 static ssize_t set_fb_win_map(struct device *dev, struct device_attribute *attr,
781 const char *buf, size_t count)
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;
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");
806 if (dev_drv->ops->fb_win_remap)
807 dev_drv->ops->fb_win_remap(dev_drv, order);
813 static ssize_t show_hwc_lut(struct device *dev,
814 struct device_attribute *attr, char *buf)
819 static ssize_t set_hwc_lut(struct device *dev, struct device_attribute *attr,
820 const char *buf, size_t count)
823 const char *start = buf;
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;
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);
839 } while ((*start != ' ') && space_max);
847 for (i = 0; i < 16; i++) {
848 for (j = 0; j < 16; j++)
849 printk("0x%08x ", hwc_lut[i * 16 + j]);
853 if (dev_drv->ops->set_hwc_lut)
854 dev_drv->ops->set_hwc_lut(dev_drv, hwc_lut, 1);
859 static ssize_t show_cabc_lut(struct device *dev,
860 struct device_attribute *attr, char *buf)
865 static ssize_t set_cabc_lut(struct device *dev, struct device_attribute *attr,
866 const char *buf, size_t count)
869 const char *start = buf;
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;
877 for (i = 0; i < 256; i++) {
879 /*init by default value*/
880 cabc_lut[i] = temp + (temp << 8) + (temp << 16);
882 for (i = 0; i < 256; i++) {
883 space_max = 10; /*max space number 10*/
884 temp = simple_strtoul(start, NULL, 10);
889 } while ((*start != ' ') && space_max);
896 if (dev_drv->ops->set_cabc_lut)
897 dev_drv->ops->set_cabc_lut(dev_drv, cabc_lut);
902 static ssize_t show_dsp_lut(struct device *dev,
903 struct device_attribute *attr, char *buf)
908 static ssize_t set_dsp_lut(struct device *dev, struct device_attribute *attr,
909 const char *buf, size_t count)
912 const char *start = buf;
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;
920 for (i = 0; i < 256; i++) {
922 /*init by default value*/
923 dsp_lut[i] = temp + (temp << 8) + (temp << 16);
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);
933 } while ((*start != ' ') && space_max);
941 for (i = 0; i < 16; i++) {
942 for (j = 0; j < 16; j++)
943 printk("0x%08x ", dsp_lut[i * 16 + j]);
947 if (dev_drv->ops->set_dsp_lut)
948 dev_drv->ops->set_dsp_lut(dev_drv, dsp_lut);
953 static ssize_t show_dsp_cabc(struct device *dev,
954 struct device_attribute *attr, char *buf)
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;
960 return snprintf(buf, PAGE_SIZE, "cabc mode=%d\n",
965 static ssize_t set_dsp_cabc(struct device *dev, struct device_attribute *attr,
966 const char *buf, size_t count)
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;
974 space_max = 10; /*max space number 10*/
975 mode = simple_strtoul(start, NULL, 10);
979 } while ((*start != ' ') && space_max);
981 calc = simple_strtoul(start, NULL, 10);
986 } while ((*start != ' ') && space_max);
988 up = simple_strtoul(start, NULL, 10);
993 } while ((*start != ' ') && space_max);
995 down = simple_strtoul(start, NULL, 10);
1000 } while ((*start != ' ') && space_max);
1002 global = simple_strtoul(start, NULL, 10);
1004 if (dev_drv->ops->set_dsp_cabc)
1005 ret = dev_drv->ops->set_dsp_cabc(dev_drv, mode, calc, up, down, global);
1012 static ssize_t show_dsp_bcsh(struct device *dev,
1013 struct device_attribute *attr, char *buf)
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;
1020 if (dev_drv->ops->get_dsp_bcsh_bcs) {
1021 brightness = dev_drv->ops->get_dsp_bcsh_bcs(dev_drv,
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);
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);
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);
1036 static ssize_t set_dsp_bcsh(struct device *dev, struct device_attribute *attr,
1037 const char *buf, size_t count)
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;
1044 if (!strncmp(buf, "open", 4)) {
1045 if (dev_drv->ops->open_bcsh)
1046 ret = dev_drv->ops->open_bcsh(dev_drv, 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);
1054 } else if (!strncmp(buf, "brightness", 10)) {
1055 sscanf(buf, "brightness %d", &brightness);
1056 if (unlikely(brightness > 255)) {
1058 "brightness should be [0:255],now=%d\n\n",
1062 if (dev_drv->ops->set_dsp_bcsh_bcs)
1063 ret = dev_drv->ops->set_dsp_bcsh_bcs(dev_drv,
1068 } else if (!strncmp(buf, "contrast", 8)) {
1069 sscanf(buf, "contrast %d", &contrast);
1070 if (unlikely(contrast > 510)) {
1072 "contrast should be [0:510],now=%d\n",
1076 if (dev_drv->ops->set_dsp_bcsh_bcs)
1077 ret = dev_drv->ops->set_dsp_bcsh_bcs(dev_drv,
1082 } else if (!strncmp(buf, "sat_con", 7)) {
1083 sscanf(buf, "sat_con %d", &sat_con);
1084 if (unlikely(sat_con > 1015)) {
1086 "sat_con should be [0:1015],now=%d\n",
1090 if (dev_drv->ops->set_dsp_bcsh_bcs)
1091 ret = dev_drv->ops->set_dsp_bcsh_bcs(dev_drv,
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",
1102 if (dev_drv->ops->set_dsp_bcsh_hue)
1103 ret = dev_drv->ops->set_dsp_bcsh_hue(dev_drv,
1109 dev_info(dev, "format error\n");
1118 static ssize_t show_scale(struct device *dev,
1119 struct device_attribute *attr, char *buf)
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;
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);
1133 static ssize_t set_scale(struct device *dev, struct device_attribute *attr,
1134 const char *buf, size_t count)
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;
1141 if (!strncmp(buf, "overscan", 8)) {
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;
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;
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;
1190 if (dev_drv->ops->set_overscan)
1191 dev_drv->ops->set_overscan(dev_drv, &dev_drv->overscan);
1196 static ssize_t show_lcdc_id(struct device *dev,
1197 struct device_attribute *attr,
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;
1204 return snprintf(buf, PAGE_SIZE, "%d\n", dev_drv->id);
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),
1228 int rkfb_create_sysfs(struct fb_info *fbi)
1232 for (t = 0; t < ARRAY_SIZE(rkfb_attrs); t++) {
1233 r = device_create_file(fbi->dev, &rkfb_attrs[t]);
1235 dev_err(fbi->dev, "failed to create sysfs " "file\n");
1243 void rkfb_remove_sysfs(struct rk_fb *rk_fb)
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]);