#include <linux/rockchip_ion.h>
#endif
#include "bmp_helper.h"
-
+#include <linux/delay.h>
struct rkfb_sys_trace {
int num_frames;
int count_frame;
if (ft > 0)
fps = div64_u64(1000000000000llu, ft);
- return snprintf(buf, PAGE_SIZE, "xres:%d\nyres:%d\nfps:%d\n",
- screen->mode.xres, screen->mode.yres, fps);
+ return snprintf(buf, PAGE_SIZE,
+ "xres:%d\nyres:%d\nfps:%d\ntype:%d\ninterlace:%d\n",
+ screen->mode.xres, screen->mode.yres,
+ fps, screen->type, screen->mode.vmode);
+}
+
+static ssize_t set_screen_info(struct device *dev,
+ struct device_attribute *attr,
+ const char *buf, size_t count)
+{
+ struct fb_info *fbi = dev_get_drvdata(dev);
+ struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
+ struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
+ int xmirror = 0, ymirror = 0, ret = 0, rotate = 0;
+
+ ret = kstrtoint(buf, 0, &rotate);
+ if (ret)
+ return ret;
+ xmirror = !!(rotate & X_MIRROR);
+ ymirror = !!(rotate & Y_MIRROR);
+ dev_drv->cur_screen->x_mirror = xmirror;
+ dev_drv->cur_screen->y_mirror = ymirror;
+ dev_drv->rotate_mode = rotate;
+ mutex_lock(&dev_drv->output_lock);
+ mutex_lock(&dev_drv->win_config);
+ if (dev_drv->ops->extern_func)
+ dev_drv->ops->extern_func(dev_drv, SET_DSP_MIRROR);
+ mutex_unlock(&dev_drv->win_config);
+ mutex_unlock(&dev_drv->output_lock);
+
+ return count;
}
static ssize_t show_disp_info(struct device *dev,
vfs_write(filp, vaddr, size, &filp->f_pos);
}
+static void read_buffer(void *handle, void *vaddr, int size, loff_t pos)
+{
+ struct file *filp = handle;
+
+ if (filp)
+ vfs_read(filp, vaddr, size, &pos);
+}
+
static int dump_win(struct ion_client *ion_client,
struct ion_handle *ion_handle, phys_addr_t phys_addr,
int width, int height, u8 data_format, uint32_t frameid,
start = phys_addr;
nr_pages = roundup(width * height * (bits >> 3), PAGE_SIZE);
nr_pages /= PAGE_SIZE;
- pages = kzalloc(sizeof(struct page) * nr_pages,GFP_KERNEL);
+ pages = kzalloc(sizeof(struct page) * nr_pages, GFP_KERNEL);
+ if (!pages)
+ return -ENOMEM;
while (i < nr_pages) {
pages[i] = phys_to_page(start);
start += PAGE_SIZE;
pr_info("dump win == > %s\n", name);
filp = filp_open(name, flags, 0x600);
if (!filp)
- printk("fail to create %s\n", name);
+ pr_err("fail to create %s\n", name);
old_fs = get_fs();
set_fs(KERNEL_DS);
}
static ssize_t show_dump_buffer(struct device *dev,
- struct device_attribute *attr, char *buf)
+ struct device_attribute *attr, char *buf)
{
ssize_t size;
size = snprintf(buf, PAGE_SIZE,
"bmp -- dump buffer to bmp image\n"
+ " can't support dump to single file\n"
"bin -- dump buffer to bin image\n"
- "multi -- each dump will create new file\n"
+ "multi -- each dump will create new file\n"
+ " only works on trace context\n"
"win=num -- mask win to dump, default mask all\n"
" win=1, will dump win1 buffer\n"
" win=23, will dump win2 area3 buffer\n"
struct rk_fb_reg_win_data *win_data;
struct rk_fb_reg_area_data *area_data;
struct rkfb_sys_trace *trace = dev_drv->trace_buf;
- int i,j;
+ int i, j;
if (!trace)
return;
if (kstrtoint(p + 4, 0, &win))
dev_err(dev, "can't found trace frames\n");
- if (win < 10)
+ if (win < 10) {
mask_win |= 1 << win;
- else {
+ } else {
mask_win |= 1 << (win / 10);
mask_area |= 1 << (win % 10);
}
continue;
}
if (!strncmp(p, "multi", 5)) {
- is_append = true;
- is_bmp = false;
+ is_append = false;
continue;
}
return PTR_ERR(dentry);
}
+ mutex_lock(&dev_drv->front_lock);
if (!num_frames) {
- mutex_lock(&dev_drv->front_lock);
-
if (!dev_drv->front_regs) {
u16 xact, yact;
int data_format;
u32 dsp_addr;
-
- mutex_unlock(&dev_drv->front_lock);
+ int ymirror;
if (dev_drv->ops->get_dspbuf_info)
dev_drv->ops->get_dspbuf_info(dev_drv, &xact,
- &yact, &data_format, &dsp_addr);
+ &yact, &data_format, &dsp_addr,
+ &ymirror);
dump_win(NULL, NULL, dsp_addr, xact, yact, data_format,
0, 0, 0, is_bmp, false);
goto out;
}
front_regs = kmalloc(sizeof(*front_regs), GFP_KERNEL);
- if (!front_regs)
+ if (!front_regs) {
+ mutex_unlock(&dev_drv->front_lock);
return -ENOMEM;
+ }
memcpy(front_regs, dev_drv->front_regs, sizeof(*front_regs));
for (i = 0; i < front_regs->win_num; i++) {
win_data = &front_regs->reg_win_data[i];
area_data = &win_data->reg_area_data[j];
- dump_win(rk_fb->ion_client, area_data->ion_handle,
+ dump_win(rk_fb->ion_client,
+ area_data->ion_handle,
area_data->smem_start,
area_data->xvir, area_data->yvir,
- area_data->data_format, trace->count_frame,
- i, j, trace->is_bmp, trace->is_append);
+ area_data->data_format,
+ 0, i, j, is_bmp, false);
if (area_data->ion_handle)
ion_handle_put(area_data->ion_handle);
}
}
kfree(front_regs);
-
- mutex_unlock(&dev_drv->front_lock);
} else {
trace->num_frames = num_frames;
trace->count_frame = 0;
trace->mask_area = mask_area;
}
out:
+ mutex_unlock(&dev_drv->front_lock);
+ return count;
+}
+
+static ssize_t show_dsp_buffer(struct device *dev,
+ struct device_attribute *attr, char *buf)
+{
+ ssize_t size;
+
+ size = snprintf(buf, PAGE_SIZE,
+ "you can display a picture store in "
+ "/data/fb0.bin use the following cmd:\n"
+ "echo n xsize ysize format > dsp_buf\n"
+ "n: picture number"
+ "xsize: picture horizontal size\n"
+ "ysize: picture vertical size\n"
+ "format:\n"
+ " RGBA=1,RGBX=2,RGB=3,YUV420SP=17");
+
+ return size;
+}
+extern int __close_fd(struct files_struct *files, unsigned fd);
+
+static ssize_t set_dsp_buffer(struct device *dev,
+ struct device_attribute *attr,
+ const char *buf, size_t count)
+{
+ struct fb_info *fbi = dev_get_drvdata(dev);
+ struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
+ struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
+ struct rk_fb *rk_fb = dev_get_drvdata(fbi->device);
+ struct file *filp;
+ mm_segment_t old_fs;
+ int width, height, frame_num;
+ int i, j, flags, fd;
+ const char *start = buf;
+ struct ion_handle *handle = NULL;
+ char __iomem *screen_base;
+ struct rk_fb_win_cfg_data *win_config = NULL;
+ struct rk_screen *screen = dev_drv->cur_screen;
+ int space_max = 10;
+ int format;
+ size_t mem_size = 0;
+ char *name = "/data/fb0.bin";
+ struct sync_fence *acq_fence;
+ struct files_struct *files = current->files;
+
+ frame_num = simple_strtoul(start, NULL, 10);
+ do {
+ start++;
+ space_max--;
+ } while ((*start != ' ') && space_max);
+ start++;
+ width = simple_strtoul(start, NULL, 10);
+ do {
+ start++;
+ space_max--;
+ } while ((*start != ' ') && space_max);
+ start++;
+ height = simple_strtoul(start, NULL, 10);
+
+ do {
+ start++;
+ space_max--;
+ } while ((*start != ' ') && space_max);
+ start++;
+ format = simple_strtoul(start, NULL, 10);
+ pr_info("frame_num=%d,w=%d,h=%d,file=%s,format=%d\n",
+ frame_num, width, height, name, format);
+ flags = O_RDWR | O_CREAT | O_NONBLOCK;
+ filp = filp_open(name, flags, 0x600);
+ if (!filp)
+ pr_err("fail to create %s\n", name);
+
+ old_fs = get_fs();
+ set_fs(KERNEL_DS);
+
+ mem_size = width * height * 4 * frame_num;
+ if (dev_drv->iommu_enabled)
+ handle = ion_alloc(rk_fb->ion_client, mem_size, 0,
+ ION_HEAP_SYSTEM_MASK, 0);
+ else
+ handle = ion_alloc(rk_fb->ion_client, mem_size, 0,
+ ION_HEAP_TYPE_DMA_MASK, 0);
+ if (IS_ERR(handle)) {
+ pr_err("failed to ion_alloc:%ld\n", PTR_ERR(handle));
+ return -ENOMEM;
+ }
+ fd = ion_share_dma_buf_fd(rk_fb->ion_client, handle);
+ if (fd < 0) {
+ pr_err("ion_share_dma_buf_fd failed, fd=%d\n", fd);
+ return fd;
+ }
+ screen_base = ion_map_kernel(rk_fb->ion_client, handle);
+ read_buffer(filp, screen_base, mem_size, 0);
+ win_config =
+ kzalloc(sizeof(*win_config), GFP_KERNEL);
+ if (!win_config)
+ return -ENOMEM;
+
+ memset(win_config, 0, sizeof(struct rk_fb_win_cfg_data));
+ win_config->wait_fs = 0;
+ win_config->win_par[0].win_id = 0;
+ win_config->win_par[0].z_order = 0;
+ win_config->win_par[0].area_par[0].data_format = format;
+ win_config->win_par[0].area_par[0].ion_fd = fd;
+ win_config->win_par[0].area_par[0].x_offset = 0;
+ win_config->win_par[0].area_par[0].y_offset = 0;
+ win_config->win_par[0].area_par[0].xpos = 0;
+ win_config->win_par[0].area_par[0].ypos = 0;
+ win_config->win_par[0].area_par[0].xsize = screen->mode.xres;
+ win_config->win_par[0].area_par[0].ysize = screen->mode.yres;
+ win_config->win_par[0].area_par[0].xact = width;
+ win_config->win_par[0].area_par[0].yact = height;
+ win_config->win_par[0].area_par[0].xvir = width;
+ win_config->win_par[0].area_par[0].yvir = height;
+
+ for (i = 0; i < frame_num; i++) {
+ win_config->win_par[0].area_par[0].y_offset = height * i;
+ fbi->fbops->fb_ioctl(fbi, RK_FBIOSET_CONFIG_DONE,
+ (unsigned long)(win_config));
+ for (j = 0; j < RK_MAX_BUF_NUM; j++) {
+ if (win_config->rel_fence_fd[j] > 0) {
+ acq_fence =
+ sync_fence_fdget(win_config->rel_fence_fd[j]);
+ sync_fence_put(acq_fence);
+ }
+ }
+
+ if (win_config->ret_fence_fd > 0) {
+ acq_fence =
+ sync_fence_fdget(win_config->ret_fence_fd);
+ sync_fence_put(acq_fence);
+ }
+ }
+
+ ion_unmap_kernel(rk_fb->ion_client, handle);
+ ion_free(rk_fb->ion_client, handle);
+ __close_fd(files, fd);
+
+ set_fs(old_fs);
+ filp_close(filp, NULL);
+ kfree(win_config);
return count;
}
struct fb_info *fbi = dev_get_drvdata(dev);
struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
- int ovl;
+ int ovl = 0;
if (dev_drv->ops->ovl_mgr)
ovl = dev_drv->ops->ovl_mgr(dev_drv, 0, 0);
struct fb_info *fbi = dev_get_drvdata(dev);
struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
- int fps;
+ int fps = 0;
if (dev_drv->ops->fps_mgr)
fps = dev_drv->ops->fps_mgr(dev_drv, 0, 0);
struct fb_info *fbi = dev_get_drvdata(dev);
struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
- u32 fps;
+ struct rk_screen *screen = dev_drv->cur_screen;
+ u32 fps, origin_fps;
int ret;
ret = kstrtou32(buf, 0, &fps);
if (ret)
return ret;
- if (fps == 0 || fps > 60) {
- dev_info(dev, "unsupport fps value,pelase set 1~60\n");
- return count;
- }
+ origin_fps = rk_fb_calc_fps(screen, dev_drv->pixclock);
+
+ /*
+ * use too low or too high fps would make screen abnormal,
+ * and maybe can't recovery, so limit the fps.
+ */
+ if (fps <= 40 || fps > origin_fps)
+ fps = origin_fps;
if (dev_drv->ops->fps_mgr)
ret = dev_drv->ops->fps_mgr(dev_drv, fps, 1);
static ssize_t set_hwc_lut(struct device *dev, struct device_attribute *attr,
const char *buf, size_t count)
{
- int hwc_lut[256];
+ int *hwc_lut = NULL;
const char *start = buf;
int i = 256, temp;
int space_max;
struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
+ hwc_lut = kzalloc(256 * 4, GFP_KERNEL);
+ if (!hwc_lut)
+ return -ENOMEM;
/*printk("count:%d\n>>%s\n\n",count,start);*/
for (i = 0; i < 256; i++) {
space_max = 15; /*max space number 15*/
else
start++;
}
-#if 0
- for (i = 0; i < 16; i++) {
- for (j = 0; j < 16; j++)
- printk("0x%08x ", hwc_lut[i * 16 + j]);
- printk("\n");
- }
-#endif
if (dev_drv->ops->set_hwc_lut)
dev_drv->ops->set_hwc_lut(dev_drv, hwc_lut, 1);
+ kfree(hwc_lut);
return count;
}
static ssize_t set_cabc_lut(struct device *dev, struct device_attribute *attr,
const char *buf, size_t count)
{
- int cabc_lut[256];
+ int *cabc_lut = NULL;
const char *start = buf;
int i = 256, temp;
int space_max = 10;
struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
+ cabc_lut = kzalloc(256 * 4, GFP_KERNEL);
+ if (!cabc_lut)
+ return -ENOMEM;
for (i = 0; i < 256; i++) {
temp = i;
/*init by default value*/
if (dev_drv->ops->set_cabc_lut)
dev_drv->ops->set_cabc_lut(dev_drv, cabc_lut);
+ kfree(cabc_lut);
return count;
}
static ssize_t set_dsp_lut(struct device *dev, struct device_attribute *attr,
const char *buf, size_t count)
{
- int dsp_lut[256];
+ int *dsp_lut = NULL;
const char *start = buf;
int i = 256, temp;
int space_max = 10;
struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
+ dsp_lut = kzalloc(256 * 4, GFP_KERNEL);
+ if (!dsp_lut)
+ return -ENOMEM;
for (i = 0; i < 256; i++) {
temp = i;
/*init by default value*/
else
start++;
}
-#if 0
- for (i = 0; i < 16; i++) {
- for (j = 0; j < 16; j++)
- printk("0x%08x ", dsp_lut[i * 16 + j]);
- printk("\n");
- }
-#endif
if (dev_drv->ops->set_dsp_lut)
dev_drv->ops->set_dsp_lut(dev_drv, dsp_lut);
+ kfree(dsp_lut);
return count;
}
struct fb_info *fbi = dev_get_drvdata(dev);
struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
- int space_max, ret, mode = 0, calc = 0,up = 0, down = 0, global = 0;
+ int space_max, ret = 0;
+ int mode = 0, calc = 0, up = 0, down = 0, global = 0;
const char *start = buf;
space_max = 10; /*max space number 10*/
start++;
global = simple_strtoul(start, NULL, 10);
- if (dev_drv->ops->set_dsp_cabc)
- ret = dev_drv->ops->set_dsp_cabc(dev_drv, mode, calc, up, down, global);
+ if (dev_drv->ops->set_dsp_cabc)
+ ret = dev_drv->ops->set_dsp_cabc(dev_drv, mode,
+ calc, up, down, global);
if (ret < 0)
return ret;
struct fb_info *fbi = dev_get_drvdata(dev);
struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
- int brightness, contrast, sat_con, sin_hue, cos_hue;
+ int brightness = 0, contrast = 0, sat_con = 0, sin_hue = 0, cos_hue = 0;
if (dev_drv->ops->get_dsp_bcsh_bcs) {
brightness = dev_drv->ops->get_dsp_bcsh_bcs(dev_drv,
return count;
}
+static ssize_t show_lcdc_id(struct device *dev,
+ struct device_attribute *attr,
+ char *buf)
+{
+ struct fb_info *fbi = dev_get_drvdata(dev);
+ struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
+ struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
+
+ return snprintf(buf, PAGE_SIZE, "%d\n", dev_drv->id);
+}
+
+static ssize_t show_dsp_mode(struct device *dev,
+ struct device_attribute *attr,
+ char *buf)
+{
+ struct fb_info *fbi = dev_get_drvdata(dev);
+ struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
+ struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
+
+ return snprintf(buf, PAGE_SIZE, "%d\n", dev_drv->dsp_mode);
+}
+
+static ssize_t show_hot_plug_state(struct device *dev,
+ struct device_attribute *attr,
+ char *buf)
+{
+ struct fb_info *fbi = dev_get_drvdata(dev);
+ struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
+ struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
+
+ return snprintf(buf, PAGE_SIZE, "%d\n", dev_drv->hot_plug_state);
+}
+
+static ssize_t show_win_property(struct device *dev,
+ struct device_attribute *attr,
+ char *buf)
+{
+ struct fb_info *fbi = dev_get_drvdata(dev);
+ struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
+ struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
+ int win_id = 0;
+
+ win_id = dev_drv->ops->fb_get_win_id(dev_drv, fbi->fix.id);
+ return snprintf(buf, PAGE_SIZE,
+ "feature: %d, max_input_x: %d, max_input_y: %d\n",
+ dev_drv->win[win_id]->property.feature,
+ dev_drv->win[win_id]->property.max_input_x,
+ dev_drv->win[win_id]->property.max_input_y);
+}
+
+static ssize_t set_car_reverse(struct device *dev,
+ struct device_attribute *attr,
+ const char *buf, size_t count)
+{
+ struct fb_info *fbi = dev_get_drvdata(dev);
+ struct rk_fb_par *fb_par = (struct rk_fb_par *)fbi->par;
+ struct rk_lcdc_driver *dev_drv = fb_par->lcdc_drv;
+ u32 status;
+ int ret;
+
+ ret = kstrtou32(buf, 0, &status);
+ if (ret)
+ return ret;
+ rk_fb_set_car_reverse_status(dev_drv, status);
+
+ return count;
+}
+
static struct device_attribute rkfb_attrs[] = {
__ATTR(phys_addr, S_IRUGO, show_phys, NULL),
__ATTR(virt_addr, S_IRUGO, show_virt, NULL),
__ATTR(disp_info, S_IRUGO, show_disp_info, NULL),
__ATTR(dump_buf, S_IRUGO | S_IWUSR, show_dump_buffer, set_dump_buffer),
- __ATTR(screen_info, S_IRUGO, show_screen_info, NULL),
+ __ATTR(dsp_buf, S_IRUGO | S_IWUSR, show_dsp_buffer, set_dsp_buffer),
+ __ATTR(screen_info, S_IRUGO | S_IWUSR,
+ show_screen_info, set_screen_info),
__ATTR(dual_mode, S_IRUGO, show_dual_mode, NULL),
__ATTR(enable, S_IRUGO | S_IWUSR, show_fb_state, set_fb_state),
__ATTR(overlay, S_IRUGO | S_IWUSR, show_overlay, set_overlay),
__ATTR(cabc, S_IRUGO | S_IWUSR, show_dsp_cabc, set_dsp_cabc),
__ATTR(bcsh, S_IRUGO | S_IWUSR, show_dsp_bcsh, set_dsp_bcsh),
__ATTR(scale, S_IRUGO | S_IWUSR, show_scale, set_scale),
+ __ATTR(lcdcid, S_IRUGO, show_lcdc_id, NULL),
+ __ATTR(win_property, S_IRUGO, show_win_property, NULL),
+ __ATTR(car_reverse, S_IWUSR, NULL, set_car_reverse),
+ __ATTR(dsp_mode, S_IRUGO, show_dsp_mode, NULL),
+ __ATTR(hot_plug_state, S_IRUGO, show_hot_plug_state, NULL),
};
int rkfb_create_sysfs(struct fb_info *fbi)
projects / firefly-linux-kernel-4.4.55.git / blobdiff