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 set_screen_info(struct device *dev,
114 struct device_attribute *attr,
115 const char *buf, size_t count)
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;
122 ret = kstrtoint(buf, 0, &rotate);
125 xmirror = !!(rotate & X_MIRROR);
126 ymirror = !!(rotate & Y_MIRROR);
127 dev_drv->cur_screen->x_mirror = xmirror;
128 dev_drv->cur_screen->y_mirror = ymirror;
129 dev_drv->rotate_mode = rotate;
130 mutex_lock(&dev_drv->output_lock);
131 mutex_lock(&dev_drv->win_config);
132 if (dev_drv->ops->extern_func)
133 dev_drv->ops->extern_func(dev_drv, SET_DSP_MIRROR);
134 mutex_unlock(&dev_drv->win_config);
135 mutex_unlock(&dev_drv->output_lock);
140 static ssize_t show_disp_info(struct device *dev,
141 struct device_attribute *attr, char *buf)
143 struct fb_info *fbi = dev_get_drvdata(dev);
144 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
145 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
146 int win_id = dev_drv->ops->fb_get_win_id(dev_drv, fbi->fix.id);
148 if (dev_drv->ops->get_disp_info)
149 return dev_drv->ops->get_disp_info(dev_drv, buf, win_id);
154 static void fill_buffer(void *handle, void *vaddr, int size)
156 struct file *filp = handle;
159 vfs_write(filp, vaddr, size, &filp->f_pos);
162 static void read_buffer(void *handle, void *vaddr, int size, loff_t pos)
164 struct file *filp = handle;
167 vfs_read(filp, vaddr, size, &pos);
170 static int dump_win(struct ion_client *ion_client,
171 struct ion_handle *ion_handle, phys_addr_t phys_addr,
172 int width, int height, u8 data_format, uint32_t frameid,
173 int win_id, int area_id, bool is_bmp, bool is_append)
175 void __iomem *vaddr = NULL;
182 switch (data_format) {
212 vaddr = ion_map_kernel(ion_client, ion_handle);
213 } else if (phys_addr) {
215 unsigned int nr_pages;
220 nr_pages = roundup(width * height * (bits >> 3), PAGE_SIZE);
221 nr_pages /= PAGE_SIZE;
222 pages = kzalloc(sizeof(struct page) * nr_pages, GFP_KERNEL);
225 while (i < nr_pages) {
226 pages[i] = phys_to_page(start);
230 vaddr = vmap(pages, nr_pages, VM_MAP,
231 pgprot_writecombine(PAGE_KERNEL));
233 pr_err("failed to vmap phy addr %lx\n",
241 flags = O_RDWR | O_CREAT | O_NONBLOCK;
243 snprintf(name, 100, "%s/append_win%d_%d_%dx%d_%s.%s",
244 DUMP_BUF_PATH, win_id, area_id, width, height,
245 get_format_str(data_format), is_bmp ? "bmp" : "bin");
248 snprintf(name, 100, "%s/frame%d_win%d_%d_%dx%d_%s.%s",
249 DUMP_BUF_PATH, frameid, win_id, area_id, width, height,
250 get_format_str(data_format), is_bmp ? "bmp" : "bin");
253 pr_info("dump win == > %s\n", name);
254 filp = filp_open(name, flags, 0x600);
256 pr_err("fail to create %s\n", name);
262 bmpencoder(vaddr, width, height,
263 data_format, filp, fill_buffer);
265 fill_buffer(filp, vaddr, width * height * bits >> 3);
270 ion_unmap_kernel(ion_client, ion_handle);
274 filp_close(filp, NULL);
279 static ssize_t show_dump_buffer(struct device *dev,
280 struct device_attribute *attr, char *buf)
284 size = snprintf(buf, PAGE_SIZE,
285 "bmp -- dump buffer to bmp image\n"
286 " can't support dump to single file\n"
287 "bin -- dump buffer to bin image\n"
288 "multi -- each dump will create new file\n"
289 " only works on trace context\n"
290 "win=num -- mask win to dump, default mask all\n"
291 " win=1, will dump win1 buffer\n"
292 " win=23, will dump win2 area3 buffer\n"
293 "trace=num -- trace num frames buffer dump\n"
294 " this option will block buffer switch\n"
295 " so recommend use with bin and win=xx\n"
297 "echo bmp > dump_buf; -- dump current buf to bmp file\n"
298 "echo bin > dump_buf; -- dump current buf to bin file\n"
299 "echo trace=50:win=1:win=23 > dump_buf\n"
300 " -- dump 50 frames, dump win1 and win2 area3\n"
301 " -- dump all buffer to single file\n"
302 "You can found dump files at %s\n"
308 void trace_buffer_dump(struct device *dev, struct rk_lcdc_driver *dev_drv)
310 struct rk_fb *rk_fb = dev_get_drvdata(dev);
311 struct rk_fb_reg_data *front_regs;
312 struct rk_fb_reg_win_data *win_data;
313 struct rk_fb_reg_area_data *area_data;
314 struct rkfb_sys_trace *trace = dev_drv->trace_buf;
319 if (trace->num_frames <= trace->count_frame)
322 if (!dev_drv->front_regs)
324 front_regs = dev_drv->front_regs;
326 for (i = 0; i < front_regs->win_num; i++) {
327 if (trace->mask_win && !(trace->mask_win & (1 << i)))
329 for (j = 0; j < RK_WIN_MAX_AREA; j++) {
330 win_data = &front_regs->reg_win_data[i];
331 area_data = &win_data->reg_area_data[j];
332 if (trace->mask_area && !(trace->mask_area & (1 << j)))
335 dump_win(rk_fb->ion_client, area_data->ion_handle,
336 area_data->smem_start,
337 area_data->xvir, area_data->yvir,
338 area_data->data_format, trace->count_frame,
339 i, j, trace->is_bmp, trace->is_append);
342 trace->count_frame++;
345 static ssize_t set_dump_buffer(struct device *dev,
346 struct device_attribute *attr,
347 const char *buf, size_t count)
349 struct fb_info *fbi = dev_get_drvdata(dev);
350 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
351 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
352 struct rk_fb *rk_fb = dev_get_drvdata(fbi->device);
353 struct rk_fb_reg_data *front_regs;
354 struct rk_fb_reg_win_data *win_data;
355 struct rk_fb_reg_area_data *area_data;
356 struct rkfb_sys_trace *trace;
357 struct dentry *dentry;
364 bool is_append = true;
368 if (!rk_fb->ion_client)
371 if (!dev_drv->trace_buf) {
372 dev_drv->trace_buf = devm_kmalloc(dev_drv->dev,
373 sizeof(struct rkfb_sys_trace),
375 if (!dev_drv->trace_buf)
378 trace = dev_drv->trace_buf;
382 trace->num_frames = 0;
384 while ((p = strsep((char **)&buf, ":")) != NULL) {
387 if (!strncmp(p, "trace=", 6)) {
388 if (kstrtoint(p + 6, 0, &num_frames))
389 dev_err(dev, "can't found trace frames\n");
392 if (!strncmp(p, "win=", 4)) {
395 if (kstrtoint(p + 4, 0, &win))
396 dev_err(dev, "can't found trace frames\n");
398 mask_win |= 1 << win;
400 mask_win |= 1 << (win / 10);
401 mask_area |= 1 << (win % 10);
406 if (!strncmp(p, "bmp", 3)) {
411 if (!strncmp(p, "bin", 3)) {
415 if (!strncmp(p, "multi", 5)) {
420 dev_err(dev, "unknown option %s\n", p);
423 dentry = kern_path_create(AT_FDCWD, DUMP_BUF_PATH, &path,
425 if (!IS_ERR(dentry)) {
426 err = vfs_mkdir(path.dentry->d_inode, dentry, 700);
428 dev_err(dev, "can't create %s err%d\n",
430 done_path_create(&path, dentry);
431 } else if (PTR_ERR(dentry) != -EEXIST) {
432 dev_err(dev, "can't create PATH %s err%d\n",
434 return PTR_ERR(dentry);
437 mutex_lock(&dev_drv->front_lock);
439 if (!dev_drv->front_regs) {
445 if (dev_drv->ops->get_dspbuf_info)
446 dev_drv->ops->get_dspbuf_info(dev_drv, &xact,
447 &yact, &data_format, &dsp_addr,
450 dump_win(NULL, NULL, dsp_addr, xact, yact, data_format,
451 0, 0, 0, is_bmp, false);
454 front_regs = kmalloc(sizeof(*front_regs), GFP_KERNEL);
456 mutex_unlock(&dev_drv->front_lock);
459 memcpy(front_regs, dev_drv->front_regs, sizeof(*front_regs));
461 for (i = 0; i < front_regs->win_num; i++) {
462 if (mask_win && !(mask_win & (1 << i)))
464 for (j = 0; j < RK_WIN_MAX_AREA; j++) {
465 if (mask_area && !(mask_area & (1 << j)))
467 win_data = &front_regs->reg_win_data[i];
468 area_data = &win_data->reg_area_data[j];
469 if (area_data->ion_handle)
470 ion_handle_get(area_data->ion_handle);
474 for (i = 0; i < front_regs->win_num; i++) {
475 if (mask_win && !(mask_win & (1 << i)))
477 for (j = 0; j < RK_WIN_MAX_AREA; j++) {
478 if (mask_area && !(mask_area & (1 << j)))
481 win_data = &front_regs->reg_win_data[i];
482 area_data = &win_data->reg_area_data[j];
484 dump_win(rk_fb->ion_client,
485 area_data->ion_handle,
486 area_data->smem_start,
487 area_data->xvir, area_data->yvir,
488 area_data->data_format,
489 0, i, j, is_bmp, false);
490 if (area_data->ion_handle)
491 ion_handle_put(area_data->ion_handle);
497 trace->num_frames = num_frames;
498 trace->count_frame = 0;
499 trace->is_bmp = is_bmp;
500 trace->is_append = is_append;
501 trace->mask_win = mask_win;
502 trace->mask_area = mask_area;
505 mutex_unlock(&dev_drv->front_lock);
509 static ssize_t show_dsp_buffer(struct device *dev,
510 struct device_attribute *attr, char *buf)
514 size = snprintf(buf, PAGE_SIZE,
515 "you can display a picture store in "
516 "/data/fb0.bin use the following cmd:\n"
517 "echo n xsize ysize format > dsp_buf\n"
519 "xsize: picture horizontal size\n"
520 "ysize: picture vertical size\n"
522 " RGBA=1,RGBX=2,RGB=3,YUV420SP=17");
526 extern int __close_fd(struct files_struct *files, unsigned fd);
528 static ssize_t set_dsp_buffer(struct device *dev,
529 struct device_attribute *attr,
530 const char *buf, size_t count)
532 struct fb_info *fbi = dev_get_drvdata(dev);
533 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
534 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
535 struct rk_fb *rk_fb = dev_get_drvdata(fbi->device);
538 int width, height, frame_num;
540 const char *start = buf;
541 struct ion_handle *handle = NULL;
542 char __iomem *screen_base;
543 struct rk_fb_win_cfg_data *win_config = NULL;
544 struct rk_screen *screen = dev_drv->cur_screen;
548 char *name = "/data/fb0.bin";
549 struct sync_fence *acq_fence;
550 struct files_struct *files = current->files;
552 frame_num = simple_strtoul(start, NULL, 10);
556 } while ((*start != ' ') && space_max);
558 width = simple_strtoul(start, NULL, 10);
562 } while ((*start != ' ') && space_max);
564 height = simple_strtoul(start, NULL, 10);
569 } while ((*start != ' ') && space_max);
571 format = simple_strtoul(start, NULL, 10);
573 pr_info("frame_num=%d,w=%d,h=%d,file=%s,format=%d\n",
574 frame_num, width, height, name, format);
575 flags = O_RDWR | O_CREAT | O_NONBLOCK;
576 filp = filp_open(name, flags, 0x600);
578 pr_err("fail to create %s\n", name);
583 mem_size = width * height * 4 * frame_num;
584 if (dev_drv->iommu_enabled)
585 handle = ion_alloc(rk_fb->ion_client, mem_size, 0,
586 ION_HEAP_SYSTEM_MASK, 0);
588 handle = ion_alloc(rk_fb->ion_client, mem_size, 0,
589 ION_HEAP_TYPE_DMA_MASK, 0);
590 if (IS_ERR(handle)) {
591 pr_err("failed to ion_alloc:%ld\n", PTR_ERR(handle));
594 fd = ion_share_dma_buf_fd(rk_fb->ion_client, handle);
596 pr_err("ion_share_dma_buf_fd failed, fd=%d\n", fd);
599 screen_base = ion_map_kernel(rk_fb->ion_client, handle);
600 read_buffer(filp, screen_base, mem_size, 0);
602 kzalloc(sizeof(*win_config), GFP_KERNEL);
606 memset(win_config, 0, sizeof(struct rk_fb_win_cfg_data));
607 win_config->wait_fs = 0;
608 win_config->win_par[0].win_id = 0;
609 win_config->win_par[0].z_order = 0;
610 win_config->win_par[0].area_par[0].data_format = format;
611 win_config->win_par[0].area_par[0].ion_fd = fd;
612 win_config->win_par[0].area_par[0].x_offset = 0;
613 win_config->win_par[0].area_par[0].y_offset = 0;
614 win_config->win_par[0].area_par[0].xpos = 0;
615 win_config->win_par[0].area_par[0].ypos = 0;
616 win_config->win_par[0].area_par[0].xsize = screen->mode.xres;
617 win_config->win_par[0].area_par[0].ysize = screen->mode.yres;
618 win_config->win_par[0].area_par[0].xact = width;
619 win_config->win_par[0].area_par[0].yact = height;
620 win_config->win_par[0].area_par[0].xvir = width;
621 win_config->win_par[0].area_par[0].yvir = height;
623 for (i = 0; i < frame_num; i++) {
624 win_config->win_par[0].area_par[0].y_offset = height * i;
625 fbi->fbops->fb_ioctl(fbi, RK_FBIOSET_CONFIG_DONE,
626 (unsigned long)(win_config));
627 for (j = 0; j < RK_MAX_BUF_NUM; j++) {
628 if (win_config->rel_fence_fd[j] > 0) {
630 sync_fence_fdget(win_config->rel_fence_fd[j]);
631 sync_fence_put(acq_fence);
635 if (win_config->ret_fence_fd > 0) {
637 sync_fence_fdget(win_config->ret_fence_fd);
638 sync_fence_put(acq_fence);
642 ion_unmap_kernel(rk_fb->ion_client, handle);
643 ion_free(rk_fb->ion_client, handle);
644 __close_fd(files, fd);
647 filp_close(filp, NULL);
652 static ssize_t show_phys(struct device *dev,
653 struct device_attribute *attr, char *buf)
655 struct fb_info *fbi = dev_get_drvdata(dev);
657 return snprintf(buf, PAGE_SIZE, "0x%lx-----0x%x\n",
658 fbi->fix.smem_start, fbi->fix.smem_len);
661 static ssize_t show_virt(struct device *dev,
662 struct device_attribute *attr, char *buf)
664 struct fb_info *fbi = dev_get_drvdata(dev);
666 return snprintf(buf, PAGE_SIZE, "0x%p-----0x%x\n",
667 fbi->screen_base, fbi->fix.smem_len);
670 static ssize_t show_fb_state(struct device *dev,
671 struct device_attribute *attr, char *buf)
673 struct fb_info *fbi = dev_get_drvdata(dev);
674 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
675 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
677 int win_id = dev_drv->ops->fb_get_win_id(dev_drv, fbi->fix.id);
678 int state = dev_drv->ops->get_win_state(dev_drv, win_id, 0);
680 return snprintf(buf, PAGE_SIZE, "%s\n", state ? "enabled" : "disabled");
683 static ssize_t show_dual_mode(struct device *dev,
684 struct device_attribute *attr, char *buf)
686 struct fb_info *fbi = dev_get_drvdata(dev);
687 struct rk_fb *rk_fb = dev_get_drvdata(fbi->device);
688 int mode = rk_fb->disp_mode;
690 return snprintf(buf, PAGE_SIZE, "%d\n", mode);
693 static ssize_t set_fb_state(struct device *dev, struct device_attribute *attr,
694 const char *buf, size_t count)
696 struct fb_info *fbi = dev_get_drvdata(dev);
697 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
698 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
699 int win_id = dev_drv->ops->fb_get_win_id(dev_drv, fbi->fix.id);
703 ret = kstrtoint(buf, 0, &state);
706 dev_drv->ops->open(dev_drv, win_id, state);
708 dev_drv->ops->set_par(dev_drv, win_id);
709 dev_drv->ops->pan_display(dev_drv, win_id);
710 dev_drv->ops->cfg_done(dev_drv);
715 static ssize_t show_overlay(struct device *dev,
716 struct device_attribute *attr, char *buf)
718 struct fb_info *fbi = dev_get_drvdata(dev);
719 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
720 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
723 if (dev_drv->ops->ovl_mgr)
724 ovl = dev_drv->ops->ovl_mgr(dev_drv, 0, 0);
729 return snprintf(buf, PAGE_SIZE, "%s\n",
730 ovl ? "win0 on the top of win1" :
731 "win1 on the top of win0");
734 static ssize_t set_overlay(struct device *dev, struct device_attribute *attr,
735 const char *buf, size_t count)
737 struct fb_info *fbi = dev_get_drvdata(dev);
738 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
739 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
743 ret = kstrtou32(buf, 0, &ovl);
746 if (dev_drv->ops->ovl_mgr)
747 ret = dev_drv->ops->ovl_mgr(dev_drv, ovl, 1);
754 static ssize_t show_fps(struct device *dev,
755 struct device_attribute *attr, char *buf)
757 struct fb_info *fbi = dev_get_drvdata(dev);
758 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
759 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
762 if (dev_drv->ops->fps_mgr)
763 fps = dev_drv->ops->fps_mgr(dev_drv, 0, 0);
767 return snprintf(buf, PAGE_SIZE, "fps:%d\n", fps);
770 static ssize_t set_fps(struct device *dev, struct device_attribute *attr,
771 const char *buf, size_t count)
773 struct fb_info *fbi = dev_get_drvdata(dev);
774 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
775 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
776 struct rk_screen *screen = dev_drv->cur_screen;
780 ret = kstrtou32(buf, 0, &fps);
784 origin_fps = rk_fb_calc_fps(screen, dev_drv->pixclock);
787 * use too low or too high fps would make screen abnormal,
788 * and maybe can't recovery, so limit the fps.
790 if (fps <= 40 || fps > origin_fps)
793 if (dev_drv->ops->fps_mgr)
794 ret = dev_drv->ops->fps_mgr(dev_drv, fps, 1);
801 static ssize_t show_fb_win_map(struct device *dev,
802 struct device_attribute *attr, char *buf)
805 struct fb_info *fbi = dev_get_drvdata(dev);
806 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
807 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
809 mutex_lock(&dev_drv->fb_win_id_mutex);
811 snprintf(buf, PAGE_SIZE, "fb0:win%d\nfb1:win%d\nfb2:win%d\n",
812 dev_drv->fb0_win_id, dev_drv->fb1_win_id,
813 dev_drv->fb2_win_id);
814 mutex_unlock(&dev_drv->fb_win_id_mutex);
819 static ssize_t set_fb_win_map(struct device *dev, struct device_attribute *attr,
820 const char *buf, size_t count)
822 struct fb_info *fbi = dev_get_drvdata(dev);
823 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
824 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
828 ret = kstrtou32(buf, 0, &order);
829 if ((order != FB0_WIN2_FB1_WIN1_FB2_WIN0) &&
830 (order != FB0_WIN1_FB1_WIN2_FB2_WIN0) &&
831 (order != FB0_WIN2_FB1_WIN0_FB2_WIN1) &&
832 (order != FB0_WIN0_FB1_WIN2_FB2_WIN1) &&
833 (order != FB0_WIN0_FB1_WIN1_FB2_WIN2) &&
834 (order != FB0_WIN1_FB1_WIN0_FB2_WIN2)) {
835 dev_info(dev, "un supported map\n"
836 "you can use the following order:\n" "201:\n"
837 "fb0-win1\n" "fb1-win0\n" "fb2-win2\n" "210:\n"
838 "fb0-win0\n" "fb1-win1\n" "fb2-win2\n" "120:\n"
839 "fb0-win0\n" "fb1-win2\n" "fb2-win1\n" "102:\n"
840 "fb0-win2\n" "fb1-win0\n" "fb2-win1\n" "021:\n"
841 "fb0-win1\n" "fb1-win2\n" "fb2-win0\n" "012:\n"
842 "fb0-win2\n" "fb1-win1\n" "fb2-win0\n");
845 if (dev_drv->ops->fb_win_remap)
846 dev_drv->ops->fb_win_remap(dev_drv, order);
852 static ssize_t show_hwc_lut(struct device *dev,
853 struct device_attribute *attr, char *buf)
858 static ssize_t set_hwc_lut(struct device *dev, struct device_attribute *attr,
859 const char *buf, size_t count)
862 const char *start = buf;
866 struct fb_info *fbi = dev_get_drvdata(dev);
867 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
868 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
870 hwc_lut = kzalloc(256 * 4, GFP_KERNEL);
873 /*printk("count:%d\n>>%s\n\n",count,start);*/
874 for (i = 0; i < 256; i++) {
875 space_max = 15; /*max space number 15*/
876 temp = simple_strtoul(start, NULL, 16);
881 } while ((*start != ' ') && space_max);
888 if (dev_drv->ops->set_hwc_lut)
889 dev_drv->ops->set_hwc_lut(dev_drv, hwc_lut, 1);
895 static ssize_t show_cabc_lut(struct device *dev,
896 struct device_attribute *attr, char *buf)
901 static ssize_t set_cabc_lut(struct device *dev, struct device_attribute *attr,
902 const char *buf, size_t count)
904 int *cabc_lut = NULL;
905 const char *start = buf;
909 struct fb_info *fbi = dev_get_drvdata(dev);
910 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
911 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
913 cabc_lut = kzalloc(256 * 4, GFP_KERNEL);
916 for (i = 0; i < 256; i++) {
918 /*init by default value*/
919 cabc_lut[i] = temp + (temp << 8) + (temp << 16);
921 for (i = 0; i < 256; i++) {
922 space_max = 10; /*max space number 10*/
923 temp = simple_strtoul(start, NULL, 10);
928 } while ((*start != ' ') && space_max);
935 if (dev_drv->ops->set_cabc_lut)
936 dev_drv->ops->set_cabc_lut(dev_drv, cabc_lut);
942 static ssize_t show_dsp_lut(struct device *dev,
943 struct device_attribute *attr, char *buf)
948 static ssize_t set_dsp_lut(struct device *dev, struct device_attribute *attr,
949 const char *buf, size_t count)
952 const char *start = 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 dsp_lut = kzalloc(256 * 4, GFP_KERNEL);
963 for (i = 0; i < 256; i++) {
965 /*init by default value*/
966 dsp_lut[i] = temp + (temp << 8) + (temp << 16);
968 /*printk("count:%d\n>>%s\n\n",count,start);*/
969 for (i = 0; i < 256; i++) {
970 space_max = 10; /*max space number 10*/
971 temp = simple_strtoul(start, NULL, 10);
976 } while ((*start != ' ') && space_max);
983 if (dev_drv->ops->set_dsp_lut)
984 dev_drv->ops->set_dsp_lut(dev_drv, dsp_lut);
990 static ssize_t show_dsp_cabc(struct device *dev,
991 struct device_attribute *attr, char *buf)
993 struct fb_info *fbi = dev_get_drvdata(dev);
994 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
995 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
997 return snprintf(buf, PAGE_SIZE, "cabc mode=%d\n",
1002 static ssize_t set_dsp_cabc(struct device *dev, struct device_attribute *attr,
1003 const char *buf, size_t count)
1005 struct fb_info *fbi = dev_get_drvdata(dev);
1006 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
1007 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
1008 int space_max, ret = 0;
1009 int mode = 0, calc = 0, up = 0, down = 0, global = 0;
1010 const char *start = buf;
1012 space_max = 10; /*max space number 10*/
1013 mode = simple_strtoul(start, NULL, 10);
1017 } while ((*start != ' ') && space_max);
1019 calc = simple_strtoul(start, NULL, 10);
1024 } while ((*start != ' ') && space_max);
1026 up = simple_strtoul(start, NULL, 10);
1031 } while ((*start != ' ') && space_max);
1033 down = simple_strtoul(start, NULL, 10);
1038 } while ((*start != ' ') && space_max);
1040 global = simple_strtoul(start, NULL, 10);
1042 if (dev_drv->ops->set_dsp_cabc)
1043 ret = dev_drv->ops->set_dsp_cabc(dev_drv, mode,
1044 calc, up, down, global);
1051 static ssize_t show_dsp_bcsh(struct device *dev,
1052 struct device_attribute *attr, char *buf)
1054 struct fb_info *fbi = dev_get_drvdata(dev);
1055 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
1056 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
1057 int brightness = 0, contrast = 0, sat_con = 0, sin_hue = 0, cos_hue = 0;
1059 if (dev_drv->ops->get_dsp_bcsh_bcs) {
1060 brightness = dev_drv->ops->get_dsp_bcsh_bcs(dev_drv,
1062 contrast = dev_drv->ops->get_dsp_bcsh_bcs(dev_drv, CONTRAST);
1063 sat_con = dev_drv->ops->get_dsp_bcsh_bcs(dev_drv, SAT_CON);
1065 if (dev_drv->ops->get_dsp_bcsh_hue) {
1066 sin_hue = dev_drv->ops->get_dsp_bcsh_hue(dev_drv, H_SIN);
1067 cos_hue = dev_drv->ops->get_dsp_bcsh_hue(dev_drv, H_COS);
1069 return snprintf(buf, PAGE_SIZE,
1070 "brightness:%4d,contrast:%4d,sat_con:%4d,"
1071 "sin_hue:%4d,cos_hue:%4d\n",
1072 brightness, contrast, sat_con, sin_hue, cos_hue);
1075 static ssize_t set_dsp_bcsh(struct device *dev, struct device_attribute *attr,
1076 const char *buf, size_t count)
1078 struct fb_info *fbi = dev_get_drvdata(dev);
1079 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
1080 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
1081 int brightness, contrast, sat_con, ret = 0, sin_hue, cos_hue;
1083 if (!strncmp(buf, "open", 4)) {
1084 if (dev_drv->ops->open_bcsh)
1085 ret = dev_drv->ops->open_bcsh(dev_drv, 1);
1088 } else if (!strncmp(buf, "close", 5)) {
1089 if (dev_drv->ops->open_bcsh)
1090 ret = dev_drv->ops->open_bcsh(dev_drv, 0);
1093 } else if (!strncmp(buf, "brightness", 10)) {
1094 sscanf(buf, "brightness %d", &brightness);
1095 if (unlikely(brightness > 255)) {
1097 "brightness should be [0:255],now=%d\n\n",
1101 if (dev_drv->ops->set_dsp_bcsh_bcs)
1102 ret = dev_drv->ops->set_dsp_bcsh_bcs(dev_drv,
1107 } else if (!strncmp(buf, "contrast", 8)) {
1108 sscanf(buf, "contrast %d", &contrast);
1109 if (unlikely(contrast > 510)) {
1111 "contrast should be [0:510],now=%d\n",
1115 if (dev_drv->ops->set_dsp_bcsh_bcs)
1116 ret = dev_drv->ops->set_dsp_bcsh_bcs(dev_drv,
1121 } else if (!strncmp(buf, "sat_con", 7)) {
1122 sscanf(buf, "sat_con %d", &sat_con);
1123 if (unlikely(sat_con > 1015)) {
1125 "sat_con should be [0:1015],now=%d\n",
1129 if (dev_drv->ops->set_dsp_bcsh_bcs)
1130 ret = dev_drv->ops->set_dsp_bcsh_bcs(dev_drv,
1135 } else if (!strncmp(buf, "hue", 3)) {
1136 sscanf(buf, "hue %d %d", &sin_hue, &cos_hue);
1137 if (unlikely(sin_hue > 511 || cos_hue > 511)) {
1138 dev_err(fbi->dev, "sin_hue=%d,cos_hue=%d\n",
1141 if (dev_drv->ops->set_dsp_bcsh_hue)
1142 ret = dev_drv->ops->set_dsp_bcsh_hue(dev_drv,
1148 dev_info(dev, "format error\n");
1157 static ssize_t show_scale(struct device *dev,
1158 struct device_attribute *attr, char *buf)
1160 struct fb_info *fbi = dev_get_drvdata(dev);
1161 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
1162 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
1164 return snprintf(buf, PAGE_SIZE,
1165 "xscale=%d yscale=%d\nleft=%d top=%d right=%d bottom=%d\n",
1166 (dev_drv->overscan.left + dev_drv->overscan.right) / 2,
1167 (dev_drv->overscan.top + dev_drv->overscan.bottom) / 2,
1168 dev_drv->overscan.left, dev_drv->overscan.top,
1169 dev_drv->overscan.right, dev_drv->overscan.bottom);
1172 static ssize_t set_scale(struct device *dev, struct device_attribute *attr,
1173 const char *buf, size_t count)
1175 struct fb_info *fbi = dev_get_drvdata(dev);
1176 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
1177 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
1178 u32 left, top, right, bottom;
1180 if (!strncmp(buf, "overscan", 8)) {
1182 "overscan %d,%d,%d,%d", &left, &top, &right, &bottom);
1183 if (left > 0 && left <= 100)
1184 dev_drv->overscan.left = left;
1185 if (top > 0 && top <= 100)
1186 dev_drv->overscan.top = top;
1187 if (right > 0 && right <= 100)
1188 dev_drv->overscan.right = right;
1189 if (bottom > 0 && bottom <= 100)
1190 dev_drv->overscan.bottom = bottom;
1191 } else if (!strncmp(buf, "left", 4)) {
1192 sscanf(buf, "left=%d", &left);
1193 if (left > 0 && left <= 100)
1194 dev_drv->overscan.left = left;
1195 } else if (!strncmp(buf, "top", 3)) {
1196 sscanf(buf, "top=%d", &top);
1197 if (top > 0 && top <= 100)
1198 dev_drv->overscan.top = top;
1199 } else if (!strncmp(buf, "right", 5)) {
1200 sscanf(buf, "right=%d", &right);
1201 if (right > 0 && right <= 100)
1202 dev_drv->overscan.right = right;
1203 } else if (!strncmp(buf, "bottom", 6)) {
1204 sscanf(buf, "bottom=%d", &bottom);
1205 if (bottom > 0 && bottom <= 100)
1206 dev_drv->overscan.bottom = bottom;
1207 } else if (!strncmp(buf, "xscale", 6)) {
1208 sscanf(buf, "xscale=%d", &left);
1209 if (left > 0 && left <= 100) {
1210 dev_drv->overscan.left = left;
1211 dev_drv->overscan.right = left;
1213 } else if (!strncmp(buf, "yscale", 6)) {
1214 sscanf(buf, "yscale=%d", &left);
1215 if (left > 0 && left <= 100) {
1216 dev_drv->overscan.top = left;
1217 dev_drv->overscan.bottom = left;
1220 sscanf(buf, "%d", &left);
1221 if (left > 0 && left <= 100) {
1222 dev_drv->overscan.left = left;
1223 dev_drv->overscan.right = left;
1224 dev_drv->overscan.top = left;
1225 dev_drv->overscan.bottom = left;
1229 if (dev_drv->ops->set_overscan)
1230 dev_drv->ops->set_overscan(dev_drv, &dev_drv->overscan);
1235 static ssize_t show_lcdc_id(struct device *dev,
1236 struct device_attribute *attr,
1239 struct fb_info *fbi = dev_get_drvdata(dev);
1240 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
1241 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
1243 return snprintf(buf, PAGE_SIZE, "%d\n", dev_drv->id);
1246 static ssize_t show_dsp_mode(struct device *dev,
1247 struct device_attribute *attr,
1250 struct fb_info *fbi = dev_get_drvdata(dev);
1251 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
1252 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
1254 return snprintf(buf, PAGE_SIZE, "%d\n", dev_drv->dsp_mode);
1257 static ssize_t show_hot_plug_state(struct device *dev,
1258 struct device_attribute *attr,
1261 struct fb_info *fbi = dev_get_drvdata(dev);
1262 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
1263 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
1265 return snprintf(buf, PAGE_SIZE, "%d\n", dev_drv->hot_plug_state);
1268 static ssize_t show_win_property(struct device *dev,
1269 struct device_attribute *attr,
1272 struct fb_info *fbi = dev_get_drvdata(dev);
1273 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
1274 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
1277 win_id = dev_drv->ops->fb_get_win_id(dev_drv, fbi->fix.id);
1278 return snprintf(buf, PAGE_SIZE,
1279 "feature: %d, max_input_x: %d, max_input_y: %d\n",
1280 dev_drv->win[win_id]->property.feature,
1281 dev_drv->win[win_id]->property.max_input_x,
1282 dev_drv->win[win_id]->property.max_input_y);
1285 static ssize_t set_car_reverse(struct device *dev,
1286 struct device_attribute *attr,
1287 const char *buf, size_t count)
1289 struct fb_info *fbi = dev_get_drvdata(dev);
1290 struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
1291 struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
1295 ret = kstrtou32(buf, 0, &status);
1298 rk_fb_set_car_reverse_status(dev_drv, status);
1303 static struct device_attribute rkfb_attrs[] = {
1304 __ATTR(phys_addr, S_IRUGO, show_phys, NULL),
1305 __ATTR(virt_addr, S_IRUGO, show_virt, NULL),
1306 __ATTR(disp_info, S_IRUGO, show_disp_info, NULL),
1307 __ATTR(dump_buf, S_IRUGO | S_IWUSR, show_dump_buffer, set_dump_buffer),
1308 __ATTR(dsp_buf, S_IRUGO | S_IWUSR, show_dsp_buffer, set_dsp_buffer),
1309 __ATTR(screen_info, S_IRUGO | S_IWUSR,
1310 show_screen_info, set_screen_info),
1311 __ATTR(dual_mode, S_IRUGO, show_dual_mode, NULL),
1312 __ATTR(enable, S_IRUGO | S_IWUSR, show_fb_state, set_fb_state),
1313 __ATTR(overlay, S_IRUGO | S_IWUSR, show_overlay, set_overlay),
1314 __ATTR(fps, S_IRUGO | S_IWUSR, show_fps, set_fps),
1315 __ATTR(map, S_IRUGO | S_IWUSR, show_fb_win_map, set_fb_win_map),
1316 __ATTR(dsp_lut, S_IRUGO | S_IWUSR, show_dsp_lut, set_dsp_lut),
1317 __ATTR(cabc_lut, S_IRUGO | S_IWUSR, show_cabc_lut, set_cabc_lut),
1318 __ATTR(hwc_lut, S_IRUGO | S_IWUSR, show_hwc_lut, set_hwc_lut),
1319 __ATTR(cabc, S_IRUGO | S_IWUSR, show_dsp_cabc, set_dsp_cabc),
1320 __ATTR(bcsh, S_IRUGO | S_IWUSR, show_dsp_bcsh, set_dsp_bcsh),
1321 __ATTR(scale, S_IRUGO | S_IWUSR, show_scale, set_scale),
1322 __ATTR(lcdcid, S_IRUGO, show_lcdc_id, NULL),
1323 __ATTR(win_property, S_IRUGO, show_win_property, NULL),
1324 __ATTR(car_reverse, S_IWUSR, NULL, set_car_reverse),
1325 __ATTR(dsp_mode, S_IRUGO, show_dsp_mode, NULL),
1326 __ATTR(hot_plug_state, S_IRUGO, show_hot_plug_state, NULL),
1329 int rkfb_create_sysfs(struct fb_info *fbi)
1333 for (t = 0; t < ARRAY_SIZE(rkfb_attrs); t++) {
1334 r = device_create_file(fbi->dev, &rkfb_attrs[t]);
1336 dev_err(fbi->dev, "failed to create sysfs " "file\n");
1344 void rkfb_remove_sysfs(struct rk_fb *rk_fb)
1348 for (i = 0; i < rk_fb->num_fb; i++) {
1349 for (t = 0; t < ARRAY_SIZE(rkfb_attrs); t++)
1350 device_remove_file(rk_fb->fb[i]->dev, &rkfb_attrs[t]);