2 * linux/drivers/video/omap2/omapfb-ioctl.c
4 * Copyright (C) 2008 Nokia Corporation
5 * Author: Tomi Valkeinen <tomi.valkeinen@nokia.com>
7 * Some code and ideas taken from drivers/video/omap/ driver
10 * This program is free software; you can redistribute it and/or modify it
11 * under the terms of the GNU General Public License version 2 as published by
12 * the Free Software Foundation.
14 * This program is distributed in the hope that it will be useful, but WITHOUT
15 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
16 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
19 * You should have received a copy of the GNU General Public License along with
20 * this program. If not, see <http://www.gnu.org/licenses/>.
24 #include <linux/device.h>
25 #include <linux/uaccess.h>
26 #include <linux/platform_device.h>
28 #include <linux/omapfb.h>
29 #include <linux/vmalloc.h>
31 #include <plat/display.h>
32 #include <plat/vrfb.h>
33 #include <plat/vram.h>
37 static int omapfb_setup_plane(struct fb_info *fbi, struct omapfb_plane_info *pi)
39 struct omapfb_info *ofbi = FB2OFB(fbi);
40 struct omapfb2_device *fbdev = ofbi->fbdev;
41 struct omap_overlay *ovl;
42 struct omap_overlay_info info;
45 DBG("omapfb_setup_plane\n");
47 if (ofbi->num_overlays != 1) {
52 /* XXX uses only the first overlay */
53 ovl = ofbi->overlays[0];
55 if (pi->enabled && !ofbi->region.size) {
57 * This plane's memory was freed, can't enable it
58 * until it's reallocated.
64 ovl->get_overlay_info(ovl, &info);
66 info.pos_x = pi->pos_x;
67 info.pos_y = pi->pos_y;
68 info.out_width = pi->out_width;
69 info.out_height = pi->out_height;
70 info.enabled = pi->enabled;
72 r = ovl->set_overlay_info(ovl, &info);
77 r = ovl->manager->apply(ovl->manager);
84 dev_err(fbdev->dev, "setup_plane failed\n");
88 static int omapfb_query_plane(struct fb_info *fbi, struct omapfb_plane_info *pi)
90 struct omapfb_info *ofbi = FB2OFB(fbi);
92 if (ofbi->num_overlays != 1) {
93 memset(pi, 0, sizeof(*pi));
95 struct omap_overlay_info *ovli;
96 struct omap_overlay *ovl;
98 ovl = ofbi->overlays[0];
101 pi->pos_x = ovli->pos_x;
102 pi->pos_y = ovli->pos_y;
103 pi->enabled = ovli->enabled;
104 pi->channel_out = 0; /* xxx */
106 pi->out_width = ovli->out_width;
107 pi->out_height = ovli->out_height;
113 static int omapfb_setup_mem(struct fb_info *fbi, struct omapfb_mem_info *mi)
115 struct omapfb_info *ofbi = FB2OFB(fbi);
116 struct omapfb2_device *fbdev = ofbi->fbdev;
117 struct omapfb2_mem_region *rg;
121 if (mi->type > OMAPFB_MEMTYPE_MAX)
124 size = PAGE_ALIGN(mi->size);
128 for (i = 0; i < ofbi->num_overlays; i++) {
129 if (ofbi->overlays[i]->info.enabled)
133 if (rg->size != size || rg->type != mi->type) {
134 r = omapfb_realloc_fbmem(fbi, size, mi->type);
136 dev_err(fbdev->dev, "realloc fbmem failed\n");
144 static int omapfb_query_mem(struct fb_info *fbi, struct omapfb_mem_info *mi)
146 struct omapfb_info *ofbi = FB2OFB(fbi);
147 struct omapfb2_mem_region *rg;
150 memset(mi, 0, sizeof(*mi));
158 static int omapfb_update_window_nolock(struct fb_info *fbi,
159 u32 x, u32 y, u32 w, u32 h)
161 struct omap_dss_device *display = fb2display(fbi);
167 if (w == 0 || h == 0)
170 display->driver->get_resolution(display, &dw, &dh);
172 if (x + w > dw || y + h > dh)
175 return display->driver->update(display, x, y, w, h);
178 /* This function is exported for SGX driver use */
179 int omapfb_update_window(struct fb_info *fbi,
180 u32 x, u32 y, u32 w, u32 h)
182 struct omapfb_info *ofbi = FB2OFB(fbi);
183 struct omapfb2_device *fbdev = ofbi->fbdev;
186 if (!lock_fb_info(fbi))
190 r = omapfb_update_window_nolock(fbi, x, y, w, h);
192 omapfb_unlock(fbdev);
197 EXPORT_SYMBOL(omapfb_update_window);
199 static int omapfb_set_update_mode(struct fb_info *fbi,
200 enum omapfb_update_mode mode)
202 struct omap_dss_device *display = fb2display(fbi);
203 enum omap_dss_update_mode um;
206 if (!display || !display->driver->set_update_mode)
210 case OMAPFB_UPDATE_DISABLED:
211 um = OMAP_DSS_UPDATE_DISABLED;
214 case OMAPFB_AUTO_UPDATE:
215 um = OMAP_DSS_UPDATE_AUTO;
218 case OMAPFB_MANUAL_UPDATE:
219 um = OMAP_DSS_UPDATE_MANUAL;
226 r = display->driver->set_update_mode(display, um);
231 static int omapfb_get_update_mode(struct fb_info *fbi,
232 enum omapfb_update_mode *mode)
234 struct omap_dss_device *display = fb2display(fbi);
235 enum omap_dss_update_mode m;
240 if (!display->driver->get_update_mode) {
241 *mode = OMAPFB_AUTO_UPDATE;
245 m = display->driver->get_update_mode(display);
248 case OMAP_DSS_UPDATE_DISABLED:
249 *mode = OMAPFB_UPDATE_DISABLED;
251 case OMAP_DSS_UPDATE_AUTO:
252 *mode = OMAPFB_AUTO_UPDATE;
254 case OMAP_DSS_UPDATE_MANUAL:
255 *mode = OMAPFB_MANUAL_UPDATE;
264 /* XXX this color key handling is a hack... */
265 static struct omapfb_color_key omapfb_color_keys[2];
267 static int _omapfb_set_color_key(struct omap_overlay_manager *mgr,
268 struct omapfb_color_key *ck)
270 struct omap_overlay_manager_info info;
271 enum omap_dss_trans_key_type kt;
274 mgr->get_manager_info(mgr, &info);
276 if (ck->key_type == OMAPFB_COLOR_KEY_DISABLED) {
277 info.trans_enabled = false;
278 omapfb_color_keys[mgr->id] = *ck;
280 r = mgr->set_manager_info(mgr, &info);
289 switch (ck->key_type) {
290 case OMAPFB_COLOR_KEY_GFX_DST:
291 kt = OMAP_DSS_COLOR_KEY_GFX_DST;
293 case OMAPFB_COLOR_KEY_VID_SRC:
294 kt = OMAP_DSS_COLOR_KEY_VID_SRC;
300 info.default_color = ck->background;
301 info.trans_key = ck->trans_key;
302 info.trans_key_type = kt;
303 info.trans_enabled = true;
305 omapfb_color_keys[mgr->id] = *ck;
307 r = mgr->set_manager_info(mgr, &info);
316 static int omapfb_set_color_key(struct fb_info *fbi,
317 struct omapfb_color_key *ck)
319 struct omapfb_info *ofbi = FB2OFB(fbi);
320 struct omapfb2_device *fbdev = ofbi->fbdev;
323 struct omap_overlay_manager *mgr = NULL;
327 for (i = 0; i < ofbi->num_overlays; i++) {
328 if (ofbi->overlays[i]->manager) {
329 mgr = ofbi->overlays[i]->manager;
339 r = _omapfb_set_color_key(mgr, ck);
341 omapfb_unlock(fbdev);
346 static int omapfb_get_color_key(struct fb_info *fbi,
347 struct omapfb_color_key *ck)
349 struct omapfb_info *ofbi = FB2OFB(fbi);
350 struct omapfb2_device *fbdev = ofbi->fbdev;
351 struct omap_overlay_manager *mgr = NULL;
357 for (i = 0; i < ofbi->num_overlays; i++) {
358 if (ofbi->overlays[i]->manager) {
359 mgr = ofbi->overlays[i]->manager;
369 *ck = omapfb_color_keys[mgr->id];
371 omapfb_unlock(fbdev);
376 static int omapfb_memory_read(struct fb_info *fbi,
377 struct omapfb_memory_read *mr)
379 struct omap_dss_device *display = fb2display(fbi);
383 if (!display || !display->driver->memory_read)
386 if (!access_ok(VERIFY_WRITE, mr->buffer, mr->buffer_size))
389 if (mr->w * mr->h * 3 > mr->buffer_size)
392 buf = vmalloc(mr->buffer_size);
394 DBG("vmalloc failed\n");
398 r = display->driver->memory_read(display, buf, mr->buffer_size,
399 mr->x, mr->y, mr->w, mr->h);
402 if (copy_to_user(mr->buffer, buf, mr->buffer_size))
411 static int omapfb_get_ovl_colormode(struct omapfb2_device *fbdev,
412 struct omapfb_ovl_colormode *mode)
414 int ovl_idx = mode->overlay_idx;
415 int mode_idx = mode->mode_idx;
416 struct omap_overlay *ovl;
417 enum omap_color_mode supported_modes;
418 struct fb_var_screeninfo var;
421 if (ovl_idx >= fbdev->num_overlays)
423 ovl = fbdev->overlays[ovl_idx];
424 supported_modes = ovl->supported_modes;
426 mode_idx = mode->mode_idx;
428 for (i = 0; i < sizeof(supported_modes) * 8; i++) {
429 if (!(supported_modes & (1 << i)))
432 * It's possible that the FB doesn't support a mode
433 * that is supported by the overlay, so call the
436 if (dss_mode_to_fb_mode(1 << i, &var) < 0)
444 if (i == sizeof(supported_modes) * 8)
447 mode->bits_per_pixel = var.bits_per_pixel;
448 mode->nonstd = var.nonstd;
450 mode->green = var.green;
451 mode->blue = var.blue;
452 mode->transp = var.transp;
457 static int omapfb_wait_for_go(struct fb_info *fbi)
459 struct omapfb_info *ofbi = FB2OFB(fbi);
463 for (i = 0; i < ofbi->num_overlays; ++i) {
464 struct omap_overlay *ovl = ofbi->overlays[i];
465 r = ovl->wait_for_go(ovl);
473 int omapfb_ioctl(struct fb_info *fbi, unsigned int cmd, unsigned long arg)
475 struct omapfb_info *ofbi = FB2OFB(fbi);
476 struct omapfb2_device *fbdev = ofbi->fbdev;
477 struct omap_dss_device *display = fb2display(fbi);
480 struct omapfb_update_window_old uwnd_o;
481 struct omapfb_update_window uwnd;
482 struct omapfb_plane_info plane_info;
483 struct omapfb_caps caps;
484 struct omapfb_mem_info mem_info;
485 struct omapfb_color_key color_key;
486 struct omapfb_ovl_colormode ovl_colormode;
487 enum omapfb_update_mode update_mode;
489 struct omapfb_memory_read memory_read;
490 struct omapfb_vram_info vram_info;
491 struct omapfb_tearsync_info tearsync_info;
492 struct omapfb_display_info display_info;
498 case OMAPFB_SYNC_GFX:
499 DBG("ioctl SYNC_GFX\n");
500 if (!display || !display->driver->sync) {
501 /* DSS1 never returns an error here, so we neither */
506 r = display->driver->sync(display);
509 case OMAPFB_UPDATE_WINDOW_OLD:
510 DBG("ioctl UPDATE_WINDOW_OLD\n");
511 if (!display || !display->driver->update) {
516 if (copy_from_user(&p.uwnd_o,
523 r = omapfb_update_window_nolock(fbi, p.uwnd_o.x, p.uwnd_o.y,
524 p.uwnd_o.width, p.uwnd_o.height);
527 case OMAPFB_UPDATE_WINDOW:
528 DBG("ioctl UPDATE_WINDOW\n");
529 if (!display || !display->driver->update) {
534 if (copy_from_user(&p.uwnd, (void __user *)arg,
540 r = omapfb_update_window_nolock(fbi, p.uwnd.x, p.uwnd.y,
541 p.uwnd.width, p.uwnd.height);
544 case OMAPFB_SETUP_PLANE:
545 DBG("ioctl SETUP_PLANE\n");
546 if (copy_from_user(&p.plane_info, (void __user *)arg,
547 sizeof(p.plane_info)))
550 r = omapfb_setup_plane(fbi, &p.plane_info);
553 case OMAPFB_QUERY_PLANE:
554 DBG("ioctl QUERY_PLANE\n");
555 r = omapfb_query_plane(fbi, &p.plane_info);
558 if (copy_to_user((void __user *)arg, &p.plane_info,
559 sizeof(p.plane_info)))
563 case OMAPFB_SETUP_MEM:
564 DBG("ioctl SETUP_MEM\n");
565 if (copy_from_user(&p.mem_info, (void __user *)arg,
569 r = omapfb_setup_mem(fbi, &p.mem_info);
572 case OMAPFB_QUERY_MEM:
573 DBG("ioctl QUERY_MEM\n");
574 r = omapfb_query_mem(fbi, &p.mem_info);
577 if (copy_to_user((void __user *)arg, &p.mem_info,
582 case OMAPFB_GET_CAPS:
583 DBG("ioctl GET_CAPS\n");
589 memset(&p.caps, 0, sizeof(p.caps));
590 if (display->caps & OMAP_DSS_DISPLAY_CAP_MANUAL_UPDATE)
591 p.caps.ctrl |= OMAPFB_CAPS_MANUAL_UPDATE;
592 if (display->caps & OMAP_DSS_DISPLAY_CAP_TEAR_ELIM)
593 p.caps.ctrl |= OMAPFB_CAPS_TEARSYNC;
595 if (copy_to_user((void __user *)arg, &p.caps, sizeof(p.caps)))
599 case OMAPFB_GET_OVERLAY_COLORMODE:
600 DBG("ioctl GET_OVERLAY_COLORMODE\n");
601 if (copy_from_user(&p.ovl_colormode, (void __user *)arg,
602 sizeof(p.ovl_colormode))) {
606 r = omapfb_get_ovl_colormode(fbdev, &p.ovl_colormode);
609 if (copy_to_user((void __user *)arg, &p.ovl_colormode,
610 sizeof(p.ovl_colormode)))
614 case OMAPFB_SET_UPDATE_MODE:
615 DBG("ioctl SET_UPDATE_MODE\n");
616 if (get_user(p.update_mode, (int __user *)arg))
619 r = omapfb_set_update_mode(fbi, p.update_mode);
622 case OMAPFB_GET_UPDATE_MODE:
623 DBG("ioctl GET_UPDATE_MODE\n");
624 r = omapfb_get_update_mode(fbi, &p.update_mode);
627 if (put_user(p.update_mode,
628 (enum omapfb_update_mode __user *)arg))
632 case OMAPFB_SET_COLOR_KEY:
633 DBG("ioctl SET_COLOR_KEY\n");
634 if (copy_from_user(&p.color_key, (void __user *)arg,
635 sizeof(p.color_key)))
638 r = omapfb_set_color_key(fbi, &p.color_key);
641 case OMAPFB_GET_COLOR_KEY:
642 DBG("ioctl GET_COLOR_KEY\n");
643 r = omapfb_get_color_key(fbi, &p.color_key);
646 if (copy_to_user((void __user *)arg, &p.color_key,
647 sizeof(p.color_key)))
651 case OMAPFB_WAITFORVSYNC:
652 DBG("ioctl WAITFORVSYNC\n");
658 r = display->manager->wait_for_vsync(display->manager);
661 case OMAPFB_WAITFORGO:
662 DBG("ioctl WAITFORGO\n");
668 r = omapfb_wait_for_go(fbi);
671 /* LCD and CTRL tests do the same thing for backward
673 case OMAPFB_LCD_TEST:
674 DBG("ioctl LCD_TEST\n");
675 if (get_user(p.test_num, (int __user *)arg)) {
679 if (!display || !display->driver->run_test) {
684 r = display->driver->run_test(display, p.test_num);
688 case OMAPFB_CTRL_TEST:
689 DBG("ioctl CTRL_TEST\n");
690 if (get_user(p.test_num, (int __user *)arg)) {
694 if (!display || !display->driver->run_test) {
699 r = display->driver->run_test(display, p.test_num);
703 case OMAPFB_MEMORY_READ:
704 DBG("ioctl MEMORY_READ\n");
706 if (copy_from_user(&p.memory_read, (void __user *)arg,
707 sizeof(p.memory_read))) {
712 r = omapfb_memory_read(fbi, &p.memory_read);
716 case OMAPFB_GET_VRAM_INFO: {
717 unsigned long vram, free, largest;
719 DBG("ioctl GET_VRAM_INFO\n");
721 omap_vram_get_info(&vram, &free, &largest);
722 p.vram_info.total = vram;
723 p.vram_info.free = free;
724 p.vram_info.largest_free_block = largest;
726 if (copy_to_user((void __user *)arg, &p.vram_info,
727 sizeof(p.vram_info)))
732 case OMAPFB_SET_TEARSYNC: {
733 DBG("ioctl SET_TEARSYNC\n");
735 if (copy_from_user(&p.tearsync_info, (void __user *)arg,
736 sizeof(p.tearsync_info))) {
741 if (!display->driver->enable_te) {
746 r = display->driver->enable_te(display,
747 !!p.tearsync_info.enabled);
752 case OMAPFB_GET_DISPLAY_INFO: {
755 DBG("ioctl GET_DISPLAY_INFO\n");
757 if (display == NULL) {
762 display->driver->get_resolution(display, &xres, &yres);
764 p.display_info.xres = xres;
765 p.display_info.yres = yres;
766 p.display_info.width = 0;
767 p.display_info.height = 0;
769 if (copy_to_user((void __user *)arg, &p.display_info,
770 sizeof(p.display_info)))
776 dev_err(fbdev->dev, "Unknown ioctl 0x%x\n", cmd);
781 DBG("ioctl failed: %d\n", r);