11a59d1b8SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later 2f7018c21STomi Valkeinen /* 3f7018c21STomi Valkeinen * Framebuffer driver for TI OMAP boards 4f7018c21STomi Valkeinen * 5f7018c21STomi Valkeinen * Copyright (C) 2004 Nokia Corporation 6f7018c21STomi Valkeinen * Author: Imre Deak <imre.deak@nokia.com> 7f7018c21STomi Valkeinen * 8f7018c21STomi Valkeinen * Acknowledgements: 9f7018c21STomi Valkeinen * Alex McMains <aam@ridgerun.com> - Original driver 10f7018c21STomi Valkeinen * Juha Yrjola <juha.yrjola@nokia.com> - Original driver and improvements 11f7018c21STomi Valkeinen * Dirk Behme <dirk.behme@de.bosch.com> - changes for 2.6 kernel API 12f7018c21STomi Valkeinen * Texas Instruments - H3 support 13f7018c21STomi Valkeinen */ 14f7018c21STomi Valkeinen #include <linux/platform_device.h> 15f7018c21STomi Valkeinen #include <linux/mm.h> 16f7018c21STomi Valkeinen #include <linux/slab.h> 17f7018c21STomi Valkeinen #include <linux/uaccess.h> 18f7018c21STomi Valkeinen #include <linux/module.h> 19f7018c21STomi Valkeinen 20f7018c21STomi Valkeinen #include <linux/omap-dma.h> 21f7018c21STomi Valkeinen 22f7018c21STomi Valkeinen #include <mach/hardware.h> 23f7018c21STomi Valkeinen 24f7018c21STomi Valkeinen #include "omapfb.h" 25f7018c21STomi Valkeinen #include "lcdc.h" 26f7018c21STomi Valkeinen 27f7018c21STomi Valkeinen #define MODULE_NAME "omapfb" 28f7018c21STomi Valkeinen 29f7018c21STomi Valkeinen static unsigned int def_accel; 30f7018c21STomi Valkeinen static unsigned long def_vram[OMAPFB_PLANE_NUM]; 31f7018c21STomi Valkeinen static unsigned int def_vram_cnt; 32f7018c21STomi Valkeinen static unsigned long def_vxres; 33f7018c21STomi Valkeinen static unsigned long def_vyres; 34f7018c21STomi Valkeinen static unsigned int def_rotate; 35f7018c21STomi Valkeinen static unsigned int def_mirror; 36f7018c21STomi Valkeinen 3772081524SJoe Perches static bool manual_update = IS_BUILTIN(CONFIG_FB_OMAP_MANUAL_UPDATE); 38f7018c21STomi Valkeinen 39f7018c21STomi Valkeinen static struct platform_device *fbdev_pdev; 40f7018c21STomi Valkeinen static struct lcd_panel *fbdev_panel; 41f7018c21STomi Valkeinen static struct omapfb_device *omapfb_dev; 42f7018c21STomi Valkeinen 43f7018c21STomi Valkeinen struct caps_table_struct { 44f7018c21STomi Valkeinen unsigned long flag; 45f7018c21STomi Valkeinen const char *name; 46f7018c21STomi Valkeinen }; 47f7018c21STomi Valkeinen 4862bffe32SArvind Yadav static const struct caps_table_struct ctrl_caps[] = { 49f7018c21STomi Valkeinen { OMAPFB_CAPS_MANUAL_UPDATE, "manual update" }, 50f7018c21STomi Valkeinen { OMAPFB_CAPS_TEARSYNC, "tearing synchronization" }, 51f7018c21STomi Valkeinen { OMAPFB_CAPS_PLANE_RELOCATE_MEM, "relocate plane memory" }, 52f7018c21STomi Valkeinen { OMAPFB_CAPS_PLANE_SCALE, "scale plane" }, 53f7018c21STomi Valkeinen { OMAPFB_CAPS_WINDOW_PIXEL_DOUBLE, "pixel double window" }, 54f7018c21STomi Valkeinen { OMAPFB_CAPS_WINDOW_SCALE, "scale window" }, 55f7018c21STomi Valkeinen { OMAPFB_CAPS_WINDOW_OVERLAY, "overlay window" }, 56f7018c21STomi Valkeinen { OMAPFB_CAPS_WINDOW_ROTATE, "rotate window" }, 57f7018c21STomi Valkeinen { OMAPFB_CAPS_SET_BACKLIGHT, "backlight setting" }, 58f7018c21STomi Valkeinen }; 59f7018c21STomi Valkeinen 6062bffe32SArvind Yadav static const struct caps_table_struct color_caps[] = { 61f7018c21STomi Valkeinen { 1 << OMAPFB_COLOR_RGB565, "RGB565", }, 62f7018c21STomi Valkeinen { 1 << OMAPFB_COLOR_YUV422, "YUV422", }, 63f7018c21STomi Valkeinen { 1 << OMAPFB_COLOR_YUV420, "YUV420", }, 64f7018c21STomi Valkeinen { 1 << OMAPFB_COLOR_CLUT_8BPP, "CLUT8", }, 65f7018c21STomi Valkeinen { 1 << OMAPFB_COLOR_CLUT_4BPP, "CLUT4", }, 66f7018c21STomi Valkeinen { 1 << OMAPFB_COLOR_CLUT_2BPP, "CLUT2", }, 67f7018c21STomi Valkeinen { 1 << OMAPFB_COLOR_CLUT_1BPP, "CLUT1", }, 68f7018c21STomi Valkeinen { 1 << OMAPFB_COLOR_RGB444, "RGB444", }, 69f7018c21STomi Valkeinen { 1 << OMAPFB_COLOR_YUY422, "YUY422", }, 70f7018c21STomi Valkeinen }; 71f7018c21STomi Valkeinen 72f7018c21STomi Valkeinen static void omapdss_release(struct device *dev) 73f7018c21STomi Valkeinen { 74f7018c21STomi Valkeinen } 75f7018c21STomi Valkeinen 76f7018c21STomi Valkeinen /* dummy device for clocks */ 77f7018c21STomi Valkeinen static struct platform_device omapdss_device = { 78f7018c21STomi Valkeinen .name = "omapdss_dss", 79f7018c21STomi Valkeinen .id = -1, 80f7018c21STomi Valkeinen .dev = { 81f7018c21STomi Valkeinen .release = omapdss_release, 82f7018c21STomi Valkeinen }, 83f7018c21STomi Valkeinen }; 84f7018c21STomi Valkeinen 85f7018c21STomi Valkeinen /* 86f7018c21STomi Valkeinen * --------------------------------------------------------------------------- 87f7018c21STomi Valkeinen * LCD panel 88f7018c21STomi Valkeinen * --------------------------------------------------------------------------- 89f7018c21STomi Valkeinen */ 90f7018c21STomi Valkeinen extern struct lcd_ctrl hwa742_ctrl; 91f7018c21STomi Valkeinen 92f7018c21STomi Valkeinen static const struct lcd_ctrl *ctrls[] = { 93f7018c21STomi Valkeinen &omap1_int_ctrl, 94f7018c21STomi Valkeinen 95f7018c21STomi Valkeinen #ifdef CONFIG_FB_OMAP_LCDC_HWA742 96f7018c21STomi Valkeinen &hwa742_ctrl, 97f7018c21STomi Valkeinen #endif 98f7018c21STomi Valkeinen }; 99f7018c21STomi Valkeinen 100f7018c21STomi Valkeinen #ifdef CONFIG_FB_OMAP_LCDC_EXTERNAL 101f7018c21STomi Valkeinen extern struct lcd_ctrl_extif omap1_ext_if; 102f7018c21STomi Valkeinen #endif 103f7018c21STomi Valkeinen 104f7018c21STomi Valkeinen static void omapfb_rqueue_lock(struct omapfb_device *fbdev) 105f7018c21STomi Valkeinen { 106f7018c21STomi Valkeinen mutex_lock(&fbdev->rqueue_mutex); 107f7018c21STomi Valkeinen } 108f7018c21STomi Valkeinen 109f7018c21STomi Valkeinen static void omapfb_rqueue_unlock(struct omapfb_device *fbdev) 110f7018c21STomi Valkeinen { 111f7018c21STomi Valkeinen mutex_unlock(&fbdev->rqueue_mutex); 112f7018c21STomi Valkeinen } 113f7018c21STomi Valkeinen 114f7018c21STomi Valkeinen /* 115f7018c21STomi Valkeinen * --------------------------------------------------------------------------- 116f7018c21STomi Valkeinen * LCD controller and LCD DMA 117f7018c21STomi Valkeinen * --------------------------------------------------------------------------- 118f7018c21STomi Valkeinen */ 119f7018c21STomi Valkeinen /* 120f7018c21STomi Valkeinen * Allocate resources needed for LCD controller and LCD DMA operations. Video 121f7018c21STomi Valkeinen * memory is allocated from system memory according to the virtual display 122f7018c21STomi Valkeinen * size, except if a bigger memory size is specified explicitly as a kernel 123f7018c21STomi Valkeinen * parameter. 124f7018c21STomi Valkeinen */ 125f7018c21STomi Valkeinen static int ctrl_init(struct omapfb_device *fbdev) 126f7018c21STomi Valkeinen { 127f7018c21STomi Valkeinen int r; 128f7018c21STomi Valkeinen int i; 129f7018c21STomi Valkeinen 130f7018c21STomi Valkeinen /* kernel/module vram parameters override boot tags/board config */ 131f7018c21STomi Valkeinen if (def_vram_cnt) { 132f7018c21STomi Valkeinen for (i = 0; i < def_vram_cnt; i++) 133f7018c21STomi Valkeinen fbdev->mem_desc.region[i].size = 134f7018c21STomi Valkeinen PAGE_ALIGN(def_vram[i]); 135f7018c21STomi Valkeinen fbdev->mem_desc.region_cnt = i; 136f7018c21STomi Valkeinen } 137f7018c21STomi Valkeinen 138f7018c21STomi Valkeinen if (!fbdev->mem_desc.region_cnt) { 139f7018c21STomi Valkeinen struct lcd_panel *panel = fbdev->panel; 140f7018c21STomi Valkeinen int def_size; 141f7018c21STomi Valkeinen int bpp = panel->bpp; 142f7018c21STomi Valkeinen 143f7018c21STomi Valkeinen /* 12 bpp is packed in 16 bits */ 144f7018c21STomi Valkeinen if (bpp == 12) 145f7018c21STomi Valkeinen bpp = 16; 146f7018c21STomi Valkeinen def_size = def_vxres * def_vyres * bpp / 8; 147f7018c21STomi Valkeinen fbdev->mem_desc.region_cnt = 1; 148f7018c21STomi Valkeinen fbdev->mem_desc.region[0].size = PAGE_ALIGN(def_size); 149f7018c21STomi Valkeinen } 150f7018c21STomi Valkeinen r = fbdev->ctrl->init(fbdev, 0, &fbdev->mem_desc); 151f7018c21STomi Valkeinen if (r < 0) { 152f7018c21STomi Valkeinen dev_err(fbdev->dev, "controller initialization failed (%d)\n", 153f7018c21STomi Valkeinen r); 154f7018c21STomi Valkeinen return r; 155f7018c21STomi Valkeinen } 156f7018c21STomi Valkeinen 157f7018c21STomi Valkeinen #ifdef DEBUG 158f7018c21STomi Valkeinen for (i = 0; i < fbdev->mem_desc.region_cnt; i++) { 159f7018c21STomi Valkeinen dev_dbg(fbdev->dev, "region%d phys %08x virt %p size=%lu\n", 160f7018c21STomi Valkeinen i, 161f7018c21STomi Valkeinen fbdev->mem_desc.region[i].paddr, 162f7018c21STomi Valkeinen fbdev->mem_desc.region[i].vaddr, 163f7018c21STomi Valkeinen fbdev->mem_desc.region[i].size); 164f7018c21STomi Valkeinen } 165f7018c21STomi Valkeinen #endif 166f7018c21STomi Valkeinen return 0; 167f7018c21STomi Valkeinen } 168f7018c21STomi Valkeinen 169f7018c21STomi Valkeinen static void ctrl_cleanup(struct omapfb_device *fbdev) 170f7018c21STomi Valkeinen { 171f7018c21STomi Valkeinen fbdev->ctrl->cleanup(); 172f7018c21STomi Valkeinen } 173f7018c21STomi Valkeinen 174f7018c21STomi Valkeinen /* Must be called with fbdev->rqueue_mutex held. */ 175f7018c21STomi Valkeinen static int ctrl_change_mode(struct fb_info *fbi) 176f7018c21STomi Valkeinen { 177f7018c21STomi Valkeinen int r; 178f7018c21STomi Valkeinen unsigned long offset; 179f7018c21STomi Valkeinen struct omapfb_plane_struct *plane = fbi->par; 180f7018c21STomi Valkeinen struct omapfb_device *fbdev = plane->fbdev; 181f7018c21STomi Valkeinen struct fb_var_screeninfo *var = &fbi->var; 182f7018c21STomi Valkeinen 183f7018c21STomi Valkeinen offset = var->yoffset * fbi->fix.line_length + 184f7018c21STomi Valkeinen var->xoffset * var->bits_per_pixel / 8; 185f7018c21STomi Valkeinen 186f7018c21STomi Valkeinen if (fbdev->ctrl->sync) 187f7018c21STomi Valkeinen fbdev->ctrl->sync(); 188f7018c21STomi Valkeinen r = fbdev->ctrl->setup_plane(plane->idx, plane->info.channel_out, 189f7018c21STomi Valkeinen offset, var->xres_virtual, 190f7018c21STomi Valkeinen plane->info.pos_x, plane->info.pos_y, 191f7018c21STomi Valkeinen var->xres, var->yres, plane->color_mode); 192f7018c21STomi Valkeinen if (r < 0) 193f7018c21STomi Valkeinen return r; 194f7018c21STomi Valkeinen 195f7018c21STomi Valkeinen if (fbdev->ctrl->set_rotate != NULL) { 196f7018c21STomi Valkeinen r = fbdev->ctrl->set_rotate(var->rotate); 197f7018c21STomi Valkeinen if (r < 0) 198f7018c21STomi Valkeinen return r; 199f7018c21STomi Valkeinen } 200f7018c21STomi Valkeinen 201f7018c21STomi Valkeinen if (fbdev->ctrl->set_scale != NULL) 202f7018c21STomi Valkeinen r = fbdev->ctrl->set_scale(plane->idx, 203f7018c21STomi Valkeinen var->xres, var->yres, 204f7018c21STomi Valkeinen plane->info.out_width, 205f7018c21STomi Valkeinen plane->info.out_height); 206f7018c21STomi Valkeinen 207f7018c21STomi Valkeinen return r; 208f7018c21STomi Valkeinen } 209f7018c21STomi Valkeinen 210f7018c21STomi Valkeinen /* 211f7018c21STomi Valkeinen * --------------------------------------------------------------------------- 212f7018c21STomi Valkeinen * fbdev framework callbacks and the ioctl interface 213f7018c21STomi Valkeinen * --------------------------------------------------------------------------- 214f7018c21STomi Valkeinen */ 215f7018c21STomi Valkeinen /* Called each time the omapfb device is opened */ 216f7018c21STomi Valkeinen static int omapfb_open(struct fb_info *info, int user) 217f7018c21STomi Valkeinen { 218f7018c21STomi Valkeinen return 0; 219f7018c21STomi Valkeinen } 220f7018c21STomi Valkeinen 221f7018c21STomi Valkeinen static void omapfb_sync(struct fb_info *info); 222f7018c21STomi Valkeinen 223f7018c21STomi Valkeinen /* Called when the omapfb device is closed. We make sure that any pending 224f7018c21STomi Valkeinen * gfx DMA operations are ended, before we return. */ 225f7018c21STomi Valkeinen static int omapfb_release(struct fb_info *info, int user) 226f7018c21STomi Valkeinen { 227f7018c21STomi Valkeinen omapfb_sync(info); 228f7018c21STomi Valkeinen return 0; 229f7018c21STomi Valkeinen } 230f7018c21STomi Valkeinen 231f7018c21STomi Valkeinen /* Store a single color palette entry into a pseudo palette or the hardware 232f7018c21STomi Valkeinen * palette if one is available. For now we support only 16bpp and thus store 233f7018c21STomi Valkeinen * the entry only to the pseudo palette. 234f7018c21STomi Valkeinen */ 235f7018c21STomi Valkeinen static int _setcolreg(struct fb_info *info, u_int regno, u_int red, u_int green, 236f7018c21STomi Valkeinen u_int blue, u_int transp, int update_hw_pal) 237f7018c21STomi Valkeinen { 238f7018c21STomi Valkeinen struct omapfb_plane_struct *plane = info->par; 239f7018c21STomi Valkeinen struct omapfb_device *fbdev = plane->fbdev; 240f7018c21STomi Valkeinen struct fb_var_screeninfo *var = &info->var; 241f7018c21STomi Valkeinen int r = 0; 242f7018c21STomi Valkeinen 243f7018c21STomi Valkeinen switch (plane->color_mode) { 244f7018c21STomi Valkeinen case OMAPFB_COLOR_YUV422: 245f7018c21STomi Valkeinen case OMAPFB_COLOR_YUV420: 246f7018c21STomi Valkeinen case OMAPFB_COLOR_YUY422: 247f7018c21STomi Valkeinen r = -EINVAL; 248f7018c21STomi Valkeinen break; 249f7018c21STomi Valkeinen case OMAPFB_COLOR_CLUT_8BPP: 250f7018c21STomi Valkeinen case OMAPFB_COLOR_CLUT_4BPP: 251f7018c21STomi Valkeinen case OMAPFB_COLOR_CLUT_2BPP: 252f7018c21STomi Valkeinen case OMAPFB_COLOR_CLUT_1BPP: 253f7018c21STomi Valkeinen if (fbdev->ctrl->setcolreg) 254f7018c21STomi Valkeinen r = fbdev->ctrl->setcolreg(regno, red, green, blue, 255f7018c21STomi Valkeinen transp, update_hw_pal); 256f7018c21STomi Valkeinen /* Fallthrough */ 257f7018c21STomi Valkeinen case OMAPFB_COLOR_RGB565: 258f7018c21STomi Valkeinen case OMAPFB_COLOR_RGB444: 259f7018c21STomi Valkeinen if (r != 0) 260f7018c21STomi Valkeinen break; 261f7018c21STomi Valkeinen 262f7018c21STomi Valkeinen if (regno < 16) { 263f7018c21STomi Valkeinen u16 pal; 264f7018c21STomi Valkeinen pal = ((red >> (16 - var->red.length)) << 265f7018c21STomi Valkeinen var->red.offset) | 266f7018c21STomi Valkeinen ((green >> (16 - var->green.length)) << 267f7018c21STomi Valkeinen var->green.offset) | 268f7018c21STomi Valkeinen (blue >> (16 - var->blue.length)); 269f7018c21STomi Valkeinen ((u32 *)(info->pseudo_palette))[regno] = pal; 270f7018c21STomi Valkeinen } 271f7018c21STomi Valkeinen break; 272f7018c21STomi Valkeinen default: 273f7018c21STomi Valkeinen BUG(); 274f7018c21STomi Valkeinen } 275f7018c21STomi Valkeinen return r; 276f7018c21STomi Valkeinen } 277f7018c21STomi Valkeinen 278f7018c21STomi Valkeinen static int omapfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue, 279f7018c21STomi Valkeinen u_int transp, struct fb_info *info) 280f7018c21STomi Valkeinen { 281f7018c21STomi Valkeinen return _setcolreg(info, regno, red, green, blue, transp, 1); 282f7018c21STomi Valkeinen } 283f7018c21STomi Valkeinen 284f7018c21STomi Valkeinen static int omapfb_setcmap(struct fb_cmap *cmap, struct fb_info *info) 285f7018c21STomi Valkeinen { 286f7018c21STomi Valkeinen int count, index, r; 287f7018c21STomi Valkeinen u16 *red, *green, *blue, *transp; 288f7018c21STomi Valkeinen u16 trans = 0xffff; 289f7018c21STomi Valkeinen 290f7018c21STomi Valkeinen red = cmap->red; 291f7018c21STomi Valkeinen green = cmap->green; 292f7018c21STomi Valkeinen blue = cmap->blue; 293f7018c21STomi Valkeinen transp = cmap->transp; 294f7018c21STomi Valkeinen index = cmap->start; 295f7018c21STomi Valkeinen 296f7018c21STomi Valkeinen for (count = 0; count < cmap->len; count++) { 297f7018c21STomi Valkeinen if (transp) 298f7018c21STomi Valkeinen trans = *transp++; 299f7018c21STomi Valkeinen r = _setcolreg(info, index++, *red++, *green++, *blue++, trans, 300f7018c21STomi Valkeinen count == cmap->len - 1); 301f7018c21STomi Valkeinen if (r != 0) 302f7018c21STomi Valkeinen return r; 303f7018c21STomi Valkeinen } 304f7018c21STomi Valkeinen 305f7018c21STomi Valkeinen return 0; 306f7018c21STomi Valkeinen } 307f7018c21STomi Valkeinen 308f7018c21STomi Valkeinen static int omapfb_update_full_screen(struct fb_info *fbi); 309f7018c21STomi Valkeinen 310f7018c21STomi Valkeinen static int omapfb_blank(int blank, struct fb_info *fbi) 311f7018c21STomi Valkeinen { 312f7018c21STomi Valkeinen struct omapfb_plane_struct *plane = fbi->par; 313f7018c21STomi Valkeinen struct omapfb_device *fbdev = plane->fbdev; 314f7018c21STomi Valkeinen int do_update = 0; 315f7018c21STomi Valkeinen int r = 0; 316f7018c21STomi Valkeinen 317f7018c21STomi Valkeinen omapfb_rqueue_lock(fbdev); 318f7018c21STomi Valkeinen switch (blank) { 319f7018c21STomi Valkeinen case FB_BLANK_UNBLANK: 320f7018c21STomi Valkeinen if (fbdev->state == OMAPFB_SUSPENDED) { 321f7018c21STomi Valkeinen if (fbdev->ctrl->resume) 322f7018c21STomi Valkeinen fbdev->ctrl->resume(); 323561eb9d0SLars-Peter Clausen if (fbdev->panel->enable) 324f7018c21STomi Valkeinen fbdev->panel->enable(fbdev->panel); 325f7018c21STomi Valkeinen fbdev->state = OMAPFB_ACTIVE; 326f7018c21STomi Valkeinen if (fbdev->ctrl->get_update_mode() == 327f7018c21STomi Valkeinen OMAPFB_MANUAL_UPDATE) 328f7018c21STomi Valkeinen do_update = 1; 329f7018c21STomi Valkeinen } 330f7018c21STomi Valkeinen break; 331f7018c21STomi Valkeinen case FB_BLANK_POWERDOWN: 332f7018c21STomi Valkeinen if (fbdev->state == OMAPFB_ACTIVE) { 333561eb9d0SLars-Peter Clausen if (fbdev->panel->disable) 334f7018c21STomi Valkeinen fbdev->panel->disable(fbdev->panel); 335f7018c21STomi Valkeinen if (fbdev->ctrl->suspend) 336f7018c21STomi Valkeinen fbdev->ctrl->suspend(); 337f7018c21STomi Valkeinen fbdev->state = OMAPFB_SUSPENDED; 338f7018c21STomi Valkeinen } 339f7018c21STomi Valkeinen break; 340f7018c21STomi Valkeinen default: 341f7018c21STomi Valkeinen r = -EINVAL; 342f7018c21STomi Valkeinen } 343f7018c21STomi Valkeinen omapfb_rqueue_unlock(fbdev); 344f7018c21STomi Valkeinen 345f7018c21STomi Valkeinen if (r == 0 && do_update) 346f7018c21STomi Valkeinen r = omapfb_update_full_screen(fbi); 347f7018c21STomi Valkeinen 348f7018c21STomi Valkeinen return r; 349f7018c21STomi Valkeinen } 350f7018c21STomi Valkeinen 351f7018c21STomi Valkeinen static void omapfb_sync(struct fb_info *fbi) 352f7018c21STomi Valkeinen { 353f7018c21STomi Valkeinen struct omapfb_plane_struct *plane = fbi->par; 354f7018c21STomi Valkeinen struct omapfb_device *fbdev = plane->fbdev; 355f7018c21STomi Valkeinen 356f7018c21STomi Valkeinen omapfb_rqueue_lock(fbdev); 357f7018c21STomi Valkeinen if (fbdev->ctrl->sync) 358f7018c21STomi Valkeinen fbdev->ctrl->sync(); 359f7018c21STomi Valkeinen omapfb_rqueue_unlock(fbdev); 360f7018c21STomi Valkeinen } 361f7018c21STomi Valkeinen 362f7018c21STomi Valkeinen /* 363f7018c21STomi Valkeinen * Set fb_info.fix fields and also updates fbdev. 364f7018c21STomi Valkeinen * When calling this fb_info.var must be set up already. 365f7018c21STomi Valkeinen */ 366f7018c21STomi Valkeinen static void set_fb_fix(struct fb_info *fbi, int from_init) 367f7018c21STomi Valkeinen { 368f7018c21STomi Valkeinen struct fb_fix_screeninfo *fix = &fbi->fix; 369f7018c21STomi Valkeinen struct fb_var_screeninfo *var = &fbi->var; 370f7018c21STomi Valkeinen struct omapfb_plane_struct *plane = fbi->par; 371f7018c21STomi Valkeinen struct omapfb_mem_region *rg; 372f7018c21STomi Valkeinen int bpp; 373f7018c21STomi Valkeinen 374f7018c21STomi Valkeinen rg = &plane->fbdev->mem_desc.region[plane->idx]; 375f7018c21STomi Valkeinen fbi->screen_base = rg->vaddr; 376f7018c21STomi Valkeinen 377f7018c21STomi Valkeinen if (!from_init) { 378f7018c21STomi Valkeinen mutex_lock(&fbi->mm_lock); 379f7018c21STomi Valkeinen fix->smem_start = rg->paddr; 380f7018c21STomi Valkeinen fix->smem_len = rg->size; 381f7018c21STomi Valkeinen mutex_unlock(&fbi->mm_lock); 382f7018c21STomi Valkeinen } else { 383f7018c21STomi Valkeinen fix->smem_start = rg->paddr; 384f7018c21STomi Valkeinen fix->smem_len = rg->size; 385f7018c21STomi Valkeinen } 386f7018c21STomi Valkeinen 387f7018c21STomi Valkeinen fix->type = FB_TYPE_PACKED_PIXELS; 388f7018c21STomi Valkeinen bpp = var->bits_per_pixel; 389f7018c21STomi Valkeinen if (var->nonstd) 390f7018c21STomi Valkeinen fix->visual = FB_VISUAL_PSEUDOCOLOR; 391f7018c21STomi Valkeinen else switch (var->bits_per_pixel) { 392f7018c21STomi Valkeinen case 16: 393f7018c21STomi Valkeinen case 12: 394f7018c21STomi Valkeinen fix->visual = FB_VISUAL_TRUECOLOR; 395f7018c21STomi Valkeinen /* 12bpp is stored in 16 bits */ 396f7018c21STomi Valkeinen bpp = 16; 397f7018c21STomi Valkeinen break; 398f7018c21STomi Valkeinen case 1: 399f7018c21STomi Valkeinen case 2: 400f7018c21STomi Valkeinen case 4: 401f7018c21STomi Valkeinen case 8: 402f7018c21STomi Valkeinen fix->visual = FB_VISUAL_PSEUDOCOLOR; 403f7018c21STomi Valkeinen break; 404f7018c21STomi Valkeinen } 405f7018c21STomi Valkeinen fix->accel = FB_ACCEL_OMAP1610; 406f7018c21STomi Valkeinen fix->line_length = var->xres_virtual * bpp / 8; 407f7018c21STomi Valkeinen } 408f7018c21STomi Valkeinen 409f7018c21STomi Valkeinen static int set_color_mode(struct omapfb_plane_struct *plane, 410f7018c21STomi Valkeinen struct fb_var_screeninfo *var) 411f7018c21STomi Valkeinen { 412f7018c21STomi Valkeinen switch (var->nonstd) { 413f7018c21STomi Valkeinen case 0: 414f7018c21STomi Valkeinen break; 415f7018c21STomi Valkeinen case OMAPFB_COLOR_YUV422: 416f7018c21STomi Valkeinen var->bits_per_pixel = 16; 417f7018c21STomi Valkeinen plane->color_mode = var->nonstd; 418f7018c21STomi Valkeinen return 0; 419f7018c21STomi Valkeinen case OMAPFB_COLOR_YUV420: 420f7018c21STomi Valkeinen var->bits_per_pixel = 12; 421f7018c21STomi Valkeinen plane->color_mode = var->nonstd; 422f7018c21STomi Valkeinen return 0; 423f7018c21STomi Valkeinen case OMAPFB_COLOR_YUY422: 424f7018c21STomi Valkeinen var->bits_per_pixel = 16; 425f7018c21STomi Valkeinen plane->color_mode = var->nonstd; 426f7018c21STomi Valkeinen return 0; 427f7018c21STomi Valkeinen default: 428f7018c21STomi Valkeinen return -EINVAL; 429f7018c21STomi Valkeinen } 430f7018c21STomi Valkeinen 431f7018c21STomi Valkeinen switch (var->bits_per_pixel) { 432f7018c21STomi Valkeinen case 1: 433f7018c21STomi Valkeinen plane->color_mode = OMAPFB_COLOR_CLUT_1BPP; 434f7018c21STomi Valkeinen return 0; 435f7018c21STomi Valkeinen case 2: 436f7018c21STomi Valkeinen plane->color_mode = OMAPFB_COLOR_CLUT_2BPP; 437f7018c21STomi Valkeinen return 0; 438f7018c21STomi Valkeinen case 4: 439f7018c21STomi Valkeinen plane->color_mode = OMAPFB_COLOR_CLUT_4BPP; 440f7018c21STomi Valkeinen return 0; 441f7018c21STomi Valkeinen case 8: 442f7018c21STomi Valkeinen plane->color_mode = OMAPFB_COLOR_CLUT_8BPP; 443f7018c21STomi Valkeinen return 0; 444f7018c21STomi Valkeinen case 12: 445f7018c21STomi Valkeinen var->bits_per_pixel = 16; 44670a2783cSGustavo A. R. Silva /* fall through */ 447f7018c21STomi Valkeinen case 16: 448f7018c21STomi Valkeinen if (plane->fbdev->panel->bpp == 12) 449f7018c21STomi Valkeinen plane->color_mode = OMAPFB_COLOR_RGB444; 450f7018c21STomi Valkeinen else 451f7018c21STomi Valkeinen plane->color_mode = OMAPFB_COLOR_RGB565; 452f7018c21STomi Valkeinen return 0; 453f7018c21STomi Valkeinen default: 454f7018c21STomi Valkeinen return -EINVAL; 455f7018c21STomi Valkeinen } 456f7018c21STomi Valkeinen } 457f7018c21STomi Valkeinen 458f7018c21STomi Valkeinen /* 459f7018c21STomi Valkeinen * Check the values in var against our capabilities and in case of out of 460f7018c21STomi Valkeinen * bound values try to adjust them. 461f7018c21STomi Valkeinen */ 462f7018c21STomi Valkeinen static int set_fb_var(struct fb_info *fbi, 463f7018c21STomi Valkeinen struct fb_var_screeninfo *var) 464f7018c21STomi Valkeinen { 465f7018c21STomi Valkeinen int bpp; 466f7018c21STomi Valkeinen unsigned long max_frame_size; 467f7018c21STomi Valkeinen unsigned long line_size; 468f7018c21STomi Valkeinen int xres_min, xres_max; 469f7018c21STomi Valkeinen int yres_min, yres_max; 470f7018c21STomi Valkeinen struct omapfb_plane_struct *plane = fbi->par; 471f7018c21STomi Valkeinen struct omapfb_device *fbdev = plane->fbdev; 472f7018c21STomi Valkeinen struct lcd_panel *panel = fbdev->panel; 473f7018c21STomi Valkeinen 474f7018c21STomi Valkeinen if (set_color_mode(plane, var) < 0) 475f7018c21STomi Valkeinen return -EINVAL; 476f7018c21STomi Valkeinen 477f7018c21STomi Valkeinen bpp = var->bits_per_pixel; 478f7018c21STomi Valkeinen if (plane->color_mode == OMAPFB_COLOR_RGB444) 479f7018c21STomi Valkeinen bpp = 16; 480f7018c21STomi Valkeinen 481f7018c21STomi Valkeinen switch (var->rotate) { 482f7018c21STomi Valkeinen case 0: 483f7018c21STomi Valkeinen case 180: 484f7018c21STomi Valkeinen xres_min = OMAPFB_PLANE_XRES_MIN; 485f7018c21STomi Valkeinen xres_max = panel->x_res; 486f7018c21STomi Valkeinen yres_min = OMAPFB_PLANE_YRES_MIN; 487f7018c21STomi Valkeinen yres_max = panel->y_res; 488f7018c21STomi Valkeinen if (cpu_is_omap15xx()) { 489f7018c21STomi Valkeinen var->xres = panel->x_res; 490f7018c21STomi Valkeinen var->yres = panel->y_res; 491f7018c21STomi Valkeinen } 492f7018c21STomi Valkeinen break; 493f7018c21STomi Valkeinen case 90: 494f7018c21STomi Valkeinen case 270: 495f7018c21STomi Valkeinen xres_min = OMAPFB_PLANE_YRES_MIN; 496f7018c21STomi Valkeinen xres_max = panel->y_res; 497f7018c21STomi Valkeinen yres_min = OMAPFB_PLANE_XRES_MIN; 498f7018c21STomi Valkeinen yres_max = panel->x_res; 499f7018c21STomi Valkeinen if (cpu_is_omap15xx()) { 500f7018c21STomi Valkeinen var->xres = panel->y_res; 501f7018c21STomi Valkeinen var->yres = panel->x_res; 502f7018c21STomi Valkeinen } 503f7018c21STomi Valkeinen break; 504f7018c21STomi Valkeinen default: 505f7018c21STomi Valkeinen return -EINVAL; 506f7018c21STomi Valkeinen } 507f7018c21STomi Valkeinen 508f7018c21STomi Valkeinen if (var->xres < xres_min) 509f7018c21STomi Valkeinen var->xres = xres_min; 510f7018c21STomi Valkeinen if (var->yres < yres_min) 511f7018c21STomi Valkeinen var->yres = yres_min; 512f7018c21STomi Valkeinen if (var->xres > xres_max) 513f7018c21STomi Valkeinen var->xres = xres_max; 514f7018c21STomi Valkeinen if (var->yres > yres_max) 515f7018c21STomi Valkeinen var->yres = yres_max; 516f7018c21STomi Valkeinen 517f7018c21STomi Valkeinen if (var->xres_virtual < var->xres) 518f7018c21STomi Valkeinen var->xres_virtual = var->xres; 519f7018c21STomi Valkeinen if (var->yres_virtual < var->yres) 520f7018c21STomi Valkeinen var->yres_virtual = var->yres; 521f7018c21STomi Valkeinen max_frame_size = fbdev->mem_desc.region[plane->idx].size; 522f7018c21STomi Valkeinen line_size = var->xres_virtual * bpp / 8; 523f7018c21STomi Valkeinen if (line_size * var->yres_virtual > max_frame_size) { 524f7018c21STomi Valkeinen /* Try to keep yres_virtual first */ 525f7018c21STomi Valkeinen line_size = max_frame_size / var->yres_virtual; 526f7018c21STomi Valkeinen var->xres_virtual = line_size * 8 / bpp; 527f7018c21STomi Valkeinen if (var->xres_virtual < var->xres) { 528f7018c21STomi Valkeinen /* Still doesn't fit. Shrink yres_virtual too */ 529f7018c21STomi Valkeinen var->xres_virtual = var->xres; 530f7018c21STomi Valkeinen line_size = var->xres * bpp / 8; 531f7018c21STomi Valkeinen var->yres_virtual = max_frame_size / line_size; 532f7018c21STomi Valkeinen } 533f7018c21STomi Valkeinen /* Recheck this, as the virtual size changed. */ 534f7018c21STomi Valkeinen if (var->xres_virtual < var->xres) 535f7018c21STomi Valkeinen var->xres = var->xres_virtual; 536f7018c21STomi Valkeinen if (var->yres_virtual < var->yres) 537f7018c21STomi Valkeinen var->yres = var->yres_virtual; 538f7018c21STomi Valkeinen if (var->xres < xres_min || var->yres < yres_min) 539f7018c21STomi Valkeinen return -EINVAL; 540f7018c21STomi Valkeinen } 541f7018c21STomi Valkeinen if (var->xres + var->xoffset > var->xres_virtual) 542f7018c21STomi Valkeinen var->xoffset = var->xres_virtual - var->xres; 543f7018c21STomi Valkeinen if (var->yres + var->yoffset > var->yres_virtual) 544f7018c21STomi Valkeinen var->yoffset = var->yres_virtual - var->yres; 545f7018c21STomi Valkeinen 546f7018c21STomi Valkeinen if (plane->color_mode == OMAPFB_COLOR_RGB444) { 547f7018c21STomi Valkeinen var->red.offset = 8; var->red.length = 4; 548f7018c21STomi Valkeinen var->red.msb_right = 0; 549f7018c21STomi Valkeinen var->green.offset = 4; var->green.length = 4; 550f7018c21STomi Valkeinen var->green.msb_right = 0; 551f7018c21STomi Valkeinen var->blue.offset = 0; var->blue.length = 4; 552f7018c21STomi Valkeinen var->blue.msb_right = 0; 553f7018c21STomi Valkeinen } else { 554f7018c21STomi Valkeinen var->red.offset = 11; var->red.length = 5; 555f7018c21STomi Valkeinen var->red.msb_right = 0; 556f7018c21STomi Valkeinen var->green.offset = 5; var->green.length = 6; 557f7018c21STomi Valkeinen var->green.msb_right = 0; 558f7018c21STomi Valkeinen var->blue.offset = 0; var->blue.length = 5; 559f7018c21STomi Valkeinen var->blue.msb_right = 0; 560f7018c21STomi Valkeinen } 561f7018c21STomi Valkeinen 562f7018c21STomi Valkeinen var->height = -1; 563f7018c21STomi Valkeinen var->width = -1; 564f7018c21STomi Valkeinen var->grayscale = 0; 565f7018c21STomi Valkeinen 566f7018c21STomi Valkeinen /* pixclock in ps, the rest in pixclock */ 567f7018c21STomi Valkeinen var->pixclock = 10000000 / (panel->pixel_clock / 100); 568f7018c21STomi Valkeinen var->left_margin = panel->hfp; 569f7018c21STomi Valkeinen var->right_margin = panel->hbp; 570f7018c21STomi Valkeinen var->upper_margin = panel->vfp; 571f7018c21STomi Valkeinen var->lower_margin = panel->vbp; 572f7018c21STomi Valkeinen var->hsync_len = panel->hsw; 573f7018c21STomi Valkeinen var->vsync_len = panel->vsw; 574f7018c21STomi Valkeinen 575f7018c21STomi Valkeinen /* TODO: get these from panel->config */ 576f7018c21STomi Valkeinen var->vmode = FB_VMODE_NONINTERLACED; 577f7018c21STomi Valkeinen var->sync = 0; 578f7018c21STomi Valkeinen 579f7018c21STomi Valkeinen return 0; 580f7018c21STomi Valkeinen } 581f7018c21STomi Valkeinen 582f7018c21STomi Valkeinen 583f7018c21STomi Valkeinen /* 584f7018c21STomi Valkeinen * Set new x,y offsets in the virtual display for the visible area and switch 585f7018c21STomi Valkeinen * to the new mode. 586f7018c21STomi Valkeinen */ 587f7018c21STomi Valkeinen static int omapfb_pan_display(struct fb_var_screeninfo *var, 588f7018c21STomi Valkeinen struct fb_info *fbi) 589f7018c21STomi Valkeinen { 590f7018c21STomi Valkeinen struct omapfb_plane_struct *plane = fbi->par; 591f7018c21STomi Valkeinen struct omapfb_device *fbdev = plane->fbdev; 592f7018c21STomi Valkeinen int r = 0; 593f7018c21STomi Valkeinen 594f7018c21STomi Valkeinen omapfb_rqueue_lock(fbdev); 595f7018c21STomi Valkeinen if (var->xoffset != fbi->var.xoffset || 596f7018c21STomi Valkeinen var->yoffset != fbi->var.yoffset) { 597f7018c21STomi Valkeinen struct fb_var_screeninfo *new_var = &fbdev->new_var; 598f7018c21STomi Valkeinen 599f7018c21STomi Valkeinen memcpy(new_var, &fbi->var, sizeof(*new_var)); 600f7018c21STomi Valkeinen new_var->xoffset = var->xoffset; 601f7018c21STomi Valkeinen new_var->yoffset = var->yoffset; 602f7018c21STomi Valkeinen if (set_fb_var(fbi, new_var)) 603f7018c21STomi Valkeinen r = -EINVAL; 604f7018c21STomi Valkeinen else { 605f7018c21STomi Valkeinen memcpy(&fbi->var, new_var, sizeof(*new_var)); 606f7018c21STomi Valkeinen ctrl_change_mode(fbi); 607f7018c21STomi Valkeinen } 608f7018c21STomi Valkeinen } 609f7018c21STomi Valkeinen omapfb_rqueue_unlock(fbdev); 610f7018c21STomi Valkeinen 611f7018c21STomi Valkeinen return r; 612f7018c21STomi Valkeinen } 613f7018c21STomi Valkeinen 614f7018c21STomi Valkeinen /* Set mirror to vertical axis and switch to the new mode. */ 615f7018c21STomi Valkeinen static int omapfb_mirror(struct fb_info *fbi, int mirror) 616f7018c21STomi Valkeinen { 617f7018c21STomi Valkeinen struct omapfb_plane_struct *plane = fbi->par; 618f7018c21STomi Valkeinen struct omapfb_device *fbdev = plane->fbdev; 619f7018c21STomi Valkeinen int r = 0; 620f7018c21STomi Valkeinen 621f7018c21STomi Valkeinen omapfb_rqueue_lock(fbdev); 622f7018c21STomi Valkeinen mirror = mirror ? 1 : 0; 623f7018c21STomi Valkeinen if (cpu_is_omap15xx()) 624f7018c21STomi Valkeinen r = -EINVAL; 625f7018c21STomi Valkeinen else if (mirror != plane->info.mirror) { 626f7018c21STomi Valkeinen plane->info.mirror = mirror; 627f7018c21STomi Valkeinen r = ctrl_change_mode(fbi); 628f7018c21STomi Valkeinen } 629f7018c21STomi Valkeinen omapfb_rqueue_unlock(fbdev); 630f7018c21STomi Valkeinen 631f7018c21STomi Valkeinen return r; 632f7018c21STomi Valkeinen } 633f7018c21STomi Valkeinen 634f7018c21STomi Valkeinen /* 635f7018c21STomi Valkeinen * Check values in var, try to adjust them in case of out of bound values if 636f7018c21STomi Valkeinen * possible, or return error. 637f7018c21STomi Valkeinen */ 638f7018c21STomi Valkeinen static int omapfb_check_var(struct fb_var_screeninfo *var, struct fb_info *fbi) 639f7018c21STomi Valkeinen { 640f7018c21STomi Valkeinen struct omapfb_plane_struct *plane = fbi->par; 641f7018c21STomi Valkeinen struct omapfb_device *fbdev = plane->fbdev; 642f7018c21STomi Valkeinen int r; 643f7018c21STomi Valkeinen 644f7018c21STomi Valkeinen omapfb_rqueue_lock(fbdev); 645f7018c21STomi Valkeinen if (fbdev->ctrl->sync != NULL) 646f7018c21STomi Valkeinen fbdev->ctrl->sync(); 647f7018c21STomi Valkeinen r = set_fb_var(fbi, var); 648f7018c21STomi Valkeinen omapfb_rqueue_unlock(fbdev); 649f7018c21STomi Valkeinen 650f7018c21STomi Valkeinen return r; 651f7018c21STomi Valkeinen } 652f7018c21STomi Valkeinen 653f7018c21STomi Valkeinen /* 654f7018c21STomi Valkeinen * Switch to a new mode. The parameters for it has been check already by 655f7018c21STomi Valkeinen * omapfb_check_var. 656f7018c21STomi Valkeinen */ 657f7018c21STomi Valkeinen static int omapfb_set_par(struct fb_info *fbi) 658f7018c21STomi Valkeinen { 659f7018c21STomi Valkeinen struct omapfb_plane_struct *plane = fbi->par; 660f7018c21STomi Valkeinen struct omapfb_device *fbdev = plane->fbdev; 661f7018c21STomi Valkeinen int r = 0; 662f7018c21STomi Valkeinen 663f7018c21STomi Valkeinen omapfb_rqueue_lock(fbdev); 664f7018c21STomi Valkeinen set_fb_fix(fbi, 0); 665f7018c21STomi Valkeinen r = ctrl_change_mode(fbi); 666f7018c21STomi Valkeinen omapfb_rqueue_unlock(fbdev); 667f7018c21STomi Valkeinen 668f7018c21STomi Valkeinen return r; 669f7018c21STomi Valkeinen } 670f7018c21STomi Valkeinen 671f7018c21STomi Valkeinen int omapfb_update_window_async(struct fb_info *fbi, 672f7018c21STomi Valkeinen struct omapfb_update_window *win, 673f7018c21STomi Valkeinen void (*callback)(void *), 674f7018c21STomi Valkeinen void *callback_data) 675f7018c21STomi Valkeinen { 676f7018c21STomi Valkeinen int xres, yres; 677f7018c21STomi Valkeinen struct omapfb_plane_struct *plane = fbi->par; 678f7018c21STomi Valkeinen struct omapfb_device *fbdev = plane->fbdev; 679f7018c21STomi Valkeinen struct fb_var_screeninfo *var = &fbi->var; 680f7018c21STomi Valkeinen 681f7018c21STomi Valkeinen switch (var->rotate) { 682f7018c21STomi Valkeinen case 0: 683f7018c21STomi Valkeinen case 180: 684f7018c21STomi Valkeinen xres = fbdev->panel->x_res; 685f7018c21STomi Valkeinen yres = fbdev->panel->y_res; 686f7018c21STomi Valkeinen break; 687f7018c21STomi Valkeinen case 90: 688f7018c21STomi Valkeinen case 270: 689f7018c21STomi Valkeinen xres = fbdev->panel->y_res; 690f7018c21STomi Valkeinen yres = fbdev->panel->x_res; 691f7018c21STomi Valkeinen break; 692f7018c21STomi Valkeinen default: 693f7018c21STomi Valkeinen return -EINVAL; 694f7018c21STomi Valkeinen } 695f7018c21STomi Valkeinen 696f7018c21STomi Valkeinen if (win->x >= xres || win->y >= yres || 697f7018c21STomi Valkeinen win->out_x > xres || win->out_y > yres) 698f7018c21STomi Valkeinen return -EINVAL; 699f7018c21STomi Valkeinen 700f7018c21STomi Valkeinen if (!fbdev->ctrl->update_window || 701f7018c21STomi Valkeinen fbdev->ctrl->get_update_mode() != OMAPFB_MANUAL_UPDATE) 702f7018c21STomi Valkeinen return -ENODEV; 703f7018c21STomi Valkeinen 704f7018c21STomi Valkeinen if (win->x + win->width > xres) 705f7018c21STomi Valkeinen win->width = xres - win->x; 706f7018c21STomi Valkeinen if (win->y + win->height > yres) 707f7018c21STomi Valkeinen win->height = yres - win->y; 708f7018c21STomi Valkeinen if (win->out_x + win->out_width > xres) 709f7018c21STomi Valkeinen win->out_width = xres - win->out_x; 710f7018c21STomi Valkeinen if (win->out_y + win->out_height > yres) 711f7018c21STomi Valkeinen win->out_height = yres - win->out_y; 712f7018c21STomi Valkeinen if (!win->width || !win->height || !win->out_width || !win->out_height) 713f7018c21STomi Valkeinen return 0; 714f7018c21STomi Valkeinen 715f7018c21STomi Valkeinen return fbdev->ctrl->update_window(fbi, win, callback, callback_data); 716f7018c21STomi Valkeinen } 717f7018c21STomi Valkeinen EXPORT_SYMBOL(omapfb_update_window_async); 718f7018c21STomi Valkeinen 719f7018c21STomi Valkeinen static int omapfb_update_win(struct fb_info *fbi, 720f7018c21STomi Valkeinen struct omapfb_update_window *win) 721f7018c21STomi Valkeinen { 722f7018c21STomi Valkeinen struct omapfb_plane_struct *plane = fbi->par; 723f7018c21STomi Valkeinen int ret; 724f7018c21STomi Valkeinen 725f7018c21STomi Valkeinen omapfb_rqueue_lock(plane->fbdev); 726f7018c21STomi Valkeinen ret = omapfb_update_window_async(fbi, win, NULL, NULL); 727f7018c21STomi Valkeinen omapfb_rqueue_unlock(plane->fbdev); 728f7018c21STomi Valkeinen 729f7018c21STomi Valkeinen return ret; 730f7018c21STomi Valkeinen } 731f7018c21STomi Valkeinen 732f7018c21STomi Valkeinen static int omapfb_update_full_screen(struct fb_info *fbi) 733f7018c21STomi Valkeinen { 734f7018c21STomi Valkeinen struct omapfb_plane_struct *plane = fbi->par; 735f7018c21STomi Valkeinen struct omapfb_device *fbdev = plane->fbdev; 736f7018c21STomi Valkeinen struct omapfb_update_window win; 737f7018c21STomi Valkeinen int r; 738f7018c21STomi Valkeinen 739f7018c21STomi Valkeinen if (!fbdev->ctrl->update_window || 740f7018c21STomi Valkeinen fbdev->ctrl->get_update_mode() != OMAPFB_MANUAL_UPDATE) 741f7018c21STomi Valkeinen return -ENODEV; 742f7018c21STomi Valkeinen 743f7018c21STomi Valkeinen win.x = 0; 744f7018c21STomi Valkeinen win.y = 0; 745f7018c21STomi Valkeinen win.width = fbi->var.xres; 746f7018c21STomi Valkeinen win.height = fbi->var.yres; 747f7018c21STomi Valkeinen win.out_x = 0; 748f7018c21STomi Valkeinen win.out_y = 0; 749f7018c21STomi Valkeinen win.out_width = fbi->var.xres; 750f7018c21STomi Valkeinen win.out_height = fbi->var.yres; 751f7018c21STomi Valkeinen win.format = 0; 752f7018c21STomi Valkeinen 753f7018c21STomi Valkeinen omapfb_rqueue_lock(fbdev); 754f7018c21STomi Valkeinen r = fbdev->ctrl->update_window(fbi, &win, NULL, NULL); 755f7018c21STomi Valkeinen omapfb_rqueue_unlock(fbdev); 756f7018c21STomi Valkeinen 757f7018c21STomi Valkeinen return r; 758f7018c21STomi Valkeinen } 759f7018c21STomi Valkeinen 760f7018c21STomi Valkeinen static int omapfb_setup_plane(struct fb_info *fbi, struct omapfb_plane_info *pi) 761f7018c21STomi Valkeinen { 762f7018c21STomi Valkeinen struct omapfb_plane_struct *plane = fbi->par; 763f7018c21STomi Valkeinen struct omapfb_device *fbdev = plane->fbdev; 764f7018c21STomi Valkeinen struct lcd_panel *panel = fbdev->panel; 765f7018c21STomi Valkeinen struct omapfb_plane_info old_info; 766f7018c21STomi Valkeinen int r = 0; 767f7018c21STomi Valkeinen 768f7018c21STomi Valkeinen if (pi->pos_x + pi->out_width > panel->x_res || 769f7018c21STomi Valkeinen pi->pos_y + pi->out_height > panel->y_res) 770f7018c21STomi Valkeinen return -EINVAL; 771f7018c21STomi Valkeinen 772f7018c21STomi Valkeinen omapfb_rqueue_lock(fbdev); 773f7018c21STomi Valkeinen if (pi->enabled && !fbdev->mem_desc.region[plane->idx].size) { 774f7018c21STomi Valkeinen /* 775f7018c21STomi Valkeinen * This plane's memory was freed, can't enable it 776f7018c21STomi Valkeinen * until it's reallocated. 777f7018c21STomi Valkeinen */ 778f7018c21STomi Valkeinen r = -EINVAL; 779f7018c21STomi Valkeinen goto out; 780f7018c21STomi Valkeinen } 781f7018c21STomi Valkeinen old_info = plane->info; 782f7018c21STomi Valkeinen plane->info = *pi; 783f7018c21STomi Valkeinen if (pi->enabled) { 784f7018c21STomi Valkeinen r = ctrl_change_mode(fbi); 785f7018c21STomi Valkeinen if (r < 0) { 786f7018c21STomi Valkeinen plane->info = old_info; 787f7018c21STomi Valkeinen goto out; 788f7018c21STomi Valkeinen } 789f7018c21STomi Valkeinen } 790f7018c21STomi Valkeinen r = fbdev->ctrl->enable_plane(plane->idx, pi->enabled); 791f7018c21STomi Valkeinen if (r < 0) { 792f7018c21STomi Valkeinen plane->info = old_info; 793f7018c21STomi Valkeinen goto out; 794f7018c21STomi Valkeinen } 795f7018c21STomi Valkeinen out: 796f7018c21STomi Valkeinen omapfb_rqueue_unlock(fbdev); 797f7018c21STomi Valkeinen return r; 798f7018c21STomi Valkeinen } 799f7018c21STomi Valkeinen 800f7018c21STomi Valkeinen static int omapfb_query_plane(struct fb_info *fbi, struct omapfb_plane_info *pi) 801f7018c21STomi Valkeinen { 802f7018c21STomi Valkeinen struct omapfb_plane_struct *plane = fbi->par; 803f7018c21STomi Valkeinen 804f7018c21STomi Valkeinen *pi = plane->info; 805f7018c21STomi Valkeinen return 0; 806f7018c21STomi Valkeinen } 807f7018c21STomi Valkeinen 808f7018c21STomi Valkeinen static int omapfb_setup_mem(struct fb_info *fbi, struct omapfb_mem_info *mi) 809f7018c21STomi Valkeinen { 810f7018c21STomi Valkeinen struct omapfb_plane_struct *plane = fbi->par; 811f7018c21STomi Valkeinen struct omapfb_device *fbdev = plane->fbdev; 812f7018c21STomi Valkeinen struct omapfb_mem_region *rg = &fbdev->mem_desc.region[plane->idx]; 813f7018c21STomi Valkeinen size_t size; 814f7018c21STomi Valkeinen int r = 0; 815f7018c21STomi Valkeinen 816f7018c21STomi Valkeinen if (fbdev->ctrl->setup_mem == NULL) 817f7018c21STomi Valkeinen return -ENODEV; 818f7018c21STomi Valkeinen if (mi->type != OMAPFB_MEMTYPE_SDRAM) 819f7018c21STomi Valkeinen return -EINVAL; 820f7018c21STomi Valkeinen 821f7018c21STomi Valkeinen size = PAGE_ALIGN(mi->size); 822f7018c21STomi Valkeinen omapfb_rqueue_lock(fbdev); 823f7018c21STomi Valkeinen if (plane->info.enabled) { 824f7018c21STomi Valkeinen r = -EBUSY; 825f7018c21STomi Valkeinen goto out; 826f7018c21STomi Valkeinen } 827f7018c21STomi Valkeinen if (rg->size != size || rg->type != mi->type) { 828f7018c21STomi Valkeinen struct fb_var_screeninfo *new_var = &fbdev->new_var; 829f7018c21STomi Valkeinen unsigned long old_size = rg->size; 830f7018c21STomi Valkeinen u8 old_type = rg->type; 831f7018c21STomi Valkeinen unsigned long paddr; 832f7018c21STomi Valkeinen 833f7018c21STomi Valkeinen rg->size = size; 834f7018c21STomi Valkeinen rg->type = mi->type; 835f7018c21STomi Valkeinen /* 836f7018c21STomi Valkeinen * size == 0 is a special case, for which we 837f7018c21STomi Valkeinen * don't check / adjust the screen parameters. 838f7018c21STomi Valkeinen * This isn't a problem since the plane can't 839f7018c21STomi Valkeinen * be reenabled unless its size is > 0. 840f7018c21STomi Valkeinen */ 841f7018c21STomi Valkeinen if (old_size != size && size) { 842f7018c21STomi Valkeinen if (size) { 843f7018c21STomi Valkeinen memcpy(new_var, &fbi->var, sizeof(*new_var)); 844f7018c21STomi Valkeinen r = set_fb_var(fbi, new_var); 845f7018c21STomi Valkeinen if (r < 0) 846f7018c21STomi Valkeinen goto out; 847f7018c21STomi Valkeinen } 848f7018c21STomi Valkeinen } 849f7018c21STomi Valkeinen 850f7018c21STomi Valkeinen if (fbdev->ctrl->sync) 851f7018c21STomi Valkeinen fbdev->ctrl->sync(); 852f7018c21STomi Valkeinen r = fbdev->ctrl->setup_mem(plane->idx, size, mi->type, &paddr); 853f7018c21STomi Valkeinen if (r < 0) { 854f7018c21STomi Valkeinen /* Revert changes. */ 855f7018c21STomi Valkeinen rg->size = old_size; 856f7018c21STomi Valkeinen rg->type = old_type; 857f7018c21STomi Valkeinen goto out; 858f7018c21STomi Valkeinen } 859f7018c21STomi Valkeinen rg->paddr = paddr; 860f7018c21STomi Valkeinen 861f7018c21STomi Valkeinen if (old_size != size) { 862f7018c21STomi Valkeinen if (size) { 863f7018c21STomi Valkeinen memcpy(&fbi->var, new_var, sizeof(fbi->var)); 864f7018c21STomi Valkeinen set_fb_fix(fbi, 0); 865f7018c21STomi Valkeinen } else { 866f7018c21STomi Valkeinen /* 867f7018c21STomi Valkeinen * Set these explicitly to indicate that the 868f7018c21STomi Valkeinen * plane memory is dealloce'd, the other 869f7018c21STomi Valkeinen * screen parameters in var / fix are invalid. 870f7018c21STomi Valkeinen */ 871f7018c21STomi Valkeinen mutex_lock(&fbi->mm_lock); 872f7018c21STomi Valkeinen fbi->fix.smem_start = 0; 873f7018c21STomi Valkeinen fbi->fix.smem_len = 0; 874f7018c21STomi Valkeinen mutex_unlock(&fbi->mm_lock); 875f7018c21STomi Valkeinen } 876f7018c21STomi Valkeinen } 877f7018c21STomi Valkeinen } 878f7018c21STomi Valkeinen out: 879f7018c21STomi Valkeinen omapfb_rqueue_unlock(fbdev); 880f7018c21STomi Valkeinen 881f7018c21STomi Valkeinen return r; 882f7018c21STomi Valkeinen } 883f7018c21STomi Valkeinen 884f7018c21STomi Valkeinen static int omapfb_query_mem(struct fb_info *fbi, struct omapfb_mem_info *mi) 885f7018c21STomi Valkeinen { 886f7018c21STomi Valkeinen struct omapfb_plane_struct *plane = fbi->par; 887f7018c21STomi Valkeinen struct omapfb_device *fbdev = plane->fbdev; 888f7018c21STomi Valkeinen struct omapfb_mem_region *rg; 889f7018c21STomi Valkeinen 890f7018c21STomi Valkeinen rg = &fbdev->mem_desc.region[plane->idx]; 891f7018c21STomi Valkeinen memset(mi, 0, sizeof(*mi)); 892f7018c21STomi Valkeinen mi->size = rg->size; 893f7018c21STomi Valkeinen mi->type = rg->type; 894f7018c21STomi Valkeinen 895f7018c21STomi Valkeinen return 0; 896f7018c21STomi Valkeinen } 897f7018c21STomi Valkeinen 898f7018c21STomi Valkeinen static int omapfb_set_color_key(struct omapfb_device *fbdev, 899f7018c21STomi Valkeinen struct omapfb_color_key *ck) 900f7018c21STomi Valkeinen { 901f7018c21STomi Valkeinen int r; 902f7018c21STomi Valkeinen 903f7018c21STomi Valkeinen if (!fbdev->ctrl->set_color_key) 904f7018c21STomi Valkeinen return -ENODEV; 905f7018c21STomi Valkeinen 906f7018c21STomi Valkeinen omapfb_rqueue_lock(fbdev); 907f7018c21STomi Valkeinen r = fbdev->ctrl->set_color_key(ck); 908f7018c21STomi Valkeinen omapfb_rqueue_unlock(fbdev); 909f7018c21STomi Valkeinen 910f7018c21STomi Valkeinen return r; 911f7018c21STomi Valkeinen } 912f7018c21STomi Valkeinen 913f7018c21STomi Valkeinen static int omapfb_get_color_key(struct omapfb_device *fbdev, 914f7018c21STomi Valkeinen struct omapfb_color_key *ck) 915f7018c21STomi Valkeinen { 916f7018c21STomi Valkeinen int r; 917f7018c21STomi Valkeinen 918f7018c21STomi Valkeinen if (!fbdev->ctrl->get_color_key) 919f7018c21STomi Valkeinen return -ENODEV; 920f7018c21STomi Valkeinen 921f7018c21STomi Valkeinen omapfb_rqueue_lock(fbdev); 922f7018c21STomi Valkeinen r = fbdev->ctrl->get_color_key(ck); 923f7018c21STomi Valkeinen omapfb_rqueue_unlock(fbdev); 924f7018c21STomi Valkeinen 925f7018c21STomi Valkeinen return r; 926f7018c21STomi Valkeinen } 927f7018c21STomi Valkeinen 928f7018c21STomi Valkeinen static struct blocking_notifier_head omapfb_client_list[OMAPFB_PLANE_NUM]; 929f7018c21STomi Valkeinen static int notifier_inited; 930f7018c21STomi Valkeinen 931f7018c21STomi Valkeinen static void omapfb_init_notifier(void) 932f7018c21STomi Valkeinen { 933f7018c21STomi Valkeinen int i; 934f7018c21STomi Valkeinen 935f7018c21STomi Valkeinen for (i = 0; i < OMAPFB_PLANE_NUM; i++) 936f7018c21STomi Valkeinen BLOCKING_INIT_NOTIFIER_HEAD(&omapfb_client_list[i]); 937f7018c21STomi Valkeinen } 938f7018c21STomi Valkeinen 939f7018c21STomi Valkeinen int omapfb_register_client(struct omapfb_notifier_block *omapfb_nb, 940f7018c21STomi Valkeinen omapfb_notifier_callback_t callback, 941f7018c21STomi Valkeinen void *callback_data) 942f7018c21STomi Valkeinen { 943f7018c21STomi Valkeinen int r; 944f7018c21STomi Valkeinen 9455ec1ec35SDan Carpenter if ((unsigned)omapfb_nb->plane_idx >= OMAPFB_PLANE_NUM) 946f7018c21STomi Valkeinen return -EINVAL; 947f7018c21STomi Valkeinen 948f7018c21STomi Valkeinen if (!notifier_inited) { 949f7018c21STomi Valkeinen omapfb_init_notifier(); 950f7018c21STomi Valkeinen notifier_inited = 1; 951f7018c21STomi Valkeinen } 952f7018c21STomi Valkeinen 953f7018c21STomi Valkeinen omapfb_nb->nb.notifier_call = (int (*)(struct notifier_block *, 954f7018c21STomi Valkeinen unsigned long, void *))callback; 955f7018c21STomi Valkeinen omapfb_nb->data = callback_data; 956f7018c21STomi Valkeinen r = blocking_notifier_chain_register( 957f7018c21STomi Valkeinen &omapfb_client_list[omapfb_nb->plane_idx], 958f7018c21STomi Valkeinen &omapfb_nb->nb); 959f7018c21STomi Valkeinen if (r) 960f7018c21STomi Valkeinen return r; 961f7018c21STomi Valkeinen if (omapfb_dev != NULL && 962f7018c21STomi Valkeinen omapfb_dev->ctrl && omapfb_dev->ctrl->bind_client) { 963f7018c21STomi Valkeinen omapfb_dev->ctrl->bind_client(omapfb_nb); 964f7018c21STomi Valkeinen } 965f7018c21STomi Valkeinen 966f7018c21STomi Valkeinen return 0; 967f7018c21STomi Valkeinen } 968f7018c21STomi Valkeinen EXPORT_SYMBOL(omapfb_register_client); 969f7018c21STomi Valkeinen 970f7018c21STomi Valkeinen int omapfb_unregister_client(struct omapfb_notifier_block *omapfb_nb) 971f7018c21STomi Valkeinen { 972f7018c21STomi Valkeinen return blocking_notifier_chain_unregister( 973f7018c21STomi Valkeinen &omapfb_client_list[omapfb_nb->plane_idx], &omapfb_nb->nb); 974f7018c21STomi Valkeinen } 975f7018c21STomi Valkeinen EXPORT_SYMBOL(omapfb_unregister_client); 976f7018c21STomi Valkeinen 977f7018c21STomi Valkeinen void omapfb_notify_clients(struct omapfb_device *fbdev, unsigned long event) 978f7018c21STomi Valkeinen { 979f7018c21STomi Valkeinen int i; 980f7018c21STomi Valkeinen 981f7018c21STomi Valkeinen if (!notifier_inited) 982f7018c21STomi Valkeinen /* no client registered yet */ 983f7018c21STomi Valkeinen return; 984f7018c21STomi Valkeinen 985f7018c21STomi Valkeinen for (i = 0; i < OMAPFB_PLANE_NUM; i++) 986f7018c21STomi Valkeinen blocking_notifier_call_chain(&omapfb_client_list[i], event, 987f7018c21STomi Valkeinen fbdev->fb_info[i]); 988f7018c21STomi Valkeinen } 989f7018c21STomi Valkeinen EXPORT_SYMBOL(omapfb_notify_clients); 990f7018c21STomi Valkeinen 991f7018c21STomi Valkeinen static int omapfb_set_update_mode(struct omapfb_device *fbdev, 992f7018c21STomi Valkeinen enum omapfb_update_mode mode) 993f7018c21STomi Valkeinen { 994f7018c21STomi Valkeinen int r; 995f7018c21STomi Valkeinen 996f7018c21STomi Valkeinen omapfb_rqueue_lock(fbdev); 997f7018c21STomi Valkeinen r = fbdev->ctrl->set_update_mode(mode); 998f7018c21STomi Valkeinen omapfb_rqueue_unlock(fbdev); 999f7018c21STomi Valkeinen 1000f7018c21STomi Valkeinen return r; 1001f7018c21STomi Valkeinen } 1002f7018c21STomi Valkeinen 1003f7018c21STomi Valkeinen static enum omapfb_update_mode omapfb_get_update_mode(struct omapfb_device *fbdev) 1004f7018c21STomi Valkeinen { 1005f7018c21STomi Valkeinen int r; 1006f7018c21STomi Valkeinen 1007f7018c21STomi Valkeinen omapfb_rqueue_lock(fbdev); 1008f7018c21STomi Valkeinen r = fbdev->ctrl->get_update_mode(); 1009f7018c21STomi Valkeinen omapfb_rqueue_unlock(fbdev); 1010f7018c21STomi Valkeinen 1011f7018c21STomi Valkeinen return r; 1012f7018c21STomi Valkeinen } 1013f7018c21STomi Valkeinen 1014f7018c21STomi Valkeinen static void omapfb_get_caps(struct omapfb_device *fbdev, int plane, 1015f7018c21STomi Valkeinen struct omapfb_caps *caps) 1016f7018c21STomi Valkeinen { 1017f7018c21STomi Valkeinen memset(caps, 0, sizeof(*caps)); 1018f7018c21STomi Valkeinen fbdev->ctrl->get_caps(plane, caps); 1019561eb9d0SLars-Peter Clausen if (fbdev->panel->get_caps) 1020f7018c21STomi Valkeinen caps->ctrl |= fbdev->panel->get_caps(fbdev->panel); 1021f7018c21STomi Valkeinen } 1022f7018c21STomi Valkeinen 1023f7018c21STomi Valkeinen /* For lcd testing */ 1024f7018c21STomi Valkeinen void omapfb_write_first_pixel(struct omapfb_device *fbdev, u16 pixval) 1025f7018c21STomi Valkeinen { 1026f7018c21STomi Valkeinen omapfb_rqueue_lock(fbdev); 1027f7018c21STomi Valkeinen *(u16 *)fbdev->mem_desc.region[0].vaddr = pixval; 1028f7018c21STomi Valkeinen if (fbdev->ctrl->get_update_mode() == OMAPFB_MANUAL_UPDATE) { 1029f7018c21STomi Valkeinen struct omapfb_update_window win; 1030f7018c21STomi Valkeinen 1031f7018c21STomi Valkeinen memset(&win, 0, sizeof(win)); 1032f7018c21STomi Valkeinen win.width = 2; 1033f7018c21STomi Valkeinen win.height = 2; 1034f7018c21STomi Valkeinen win.out_width = 2; 1035f7018c21STomi Valkeinen win.out_height = 2; 1036f7018c21STomi Valkeinen fbdev->ctrl->update_window(fbdev->fb_info[0], &win, NULL, NULL); 1037f7018c21STomi Valkeinen } 1038f7018c21STomi Valkeinen omapfb_rqueue_unlock(fbdev); 1039f7018c21STomi Valkeinen } 1040f7018c21STomi Valkeinen EXPORT_SYMBOL(omapfb_write_first_pixel); 1041f7018c21STomi Valkeinen 1042f7018c21STomi Valkeinen /* 1043f7018c21STomi Valkeinen * Ioctl interface. Part of the kernel mode frame buffer API is duplicated 1044f7018c21STomi Valkeinen * here to be accessible by user mode code. 1045f7018c21STomi Valkeinen */ 1046f7018c21STomi Valkeinen static int omapfb_ioctl(struct fb_info *fbi, unsigned int cmd, 1047f7018c21STomi Valkeinen unsigned long arg) 1048f7018c21STomi Valkeinen { 1049f7018c21STomi Valkeinen struct omapfb_plane_struct *plane = fbi->par; 1050f7018c21STomi Valkeinen struct omapfb_device *fbdev = plane->fbdev; 1051e67efd45SJani Nikula const struct fb_ops *ops = fbi->fbops; 1052f7018c21STomi Valkeinen union { 1053f7018c21STomi Valkeinen struct omapfb_update_window update_window; 1054f7018c21STomi Valkeinen struct omapfb_plane_info plane_info; 1055f7018c21STomi Valkeinen struct omapfb_mem_info mem_info; 1056f7018c21STomi Valkeinen struct omapfb_color_key color_key; 1057f7018c21STomi Valkeinen enum omapfb_update_mode update_mode; 1058f7018c21STomi Valkeinen struct omapfb_caps caps; 1059f7018c21STomi Valkeinen unsigned int mirror; 1060f7018c21STomi Valkeinen int plane_out; 1061f7018c21STomi Valkeinen int enable_plane; 1062f7018c21STomi Valkeinen } p; 1063f7018c21STomi Valkeinen int r = 0; 1064f7018c21STomi Valkeinen 1065f7018c21STomi Valkeinen BUG_ON(!ops); 1066f7018c21STomi Valkeinen switch (cmd) { 1067f7018c21STomi Valkeinen case OMAPFB_MIRROR: 1068f7018c21STomi Valkeinen if (get_user(p.mirror, (int __user *)arg)) 1069f7018c21STomi Valkeinen r = -EFAULT; 1070f7018c21STomi Valkeinen else 1071f7018c21STomi Valkeinen omapfb_mirror(fbi, p.mirror); 1072f7018c21STomi Valkeinen break; 1073f7018c21STomi Valkeinen case OMAPFB_SYNC_GFX: 1074f7018c21STomi Valkeinen omapfb_sync(fbi); 1075f7018c21STomi Valkeinen break; 1076f7018c21STomi Valkeinen case OMAPFB_VSYNC: 1077f7018c21STomi Valkeinen break; 1078f7018c21STomi Valkeinen case OMAPFB_SET_UPDATE_MODE: 1079f7018c21STomi Valkeinen if (get_user(p.update_mode, (int __user *)arg)) 1080f7018c21STomi Valkeinen r = -EFAULT; 1081f7018c21STomi Valkeinen else 1082f7018c21STomi Valkeinen r = omapfb_set_update_mode(fbdev, p.update_mode); 1083f7018c21STomi Valkeinen break; 1084f7018c21STomi Valkeinen case OMAPFB_GET_UPDATE_MODE: 1085f7018c21STomi Valkeinen p.update_mode = omapfb_get_update_mode(fbdev); 1086f7018c21STomi Valkeinen if (put_user(p.update_mode, 1087f7018c21STomi Valkeinen (enum omapfb_update_mode __user *)arg)) 1088f7018c21STomi Valkeinen r = -EFAULT; 1089f7018c21STomi Valkeinen break; 1090f7018c21STomi Valkeinen case OMAPFB_UPDATE_WINDOW_OLD: 1091f7018c21STomi Valkeinen if (copy_from_user(&p.update_window, (void __user *)arg, 1092f7018c21STomi Valkeinen sizeof(struct omapfb_update_window_old))) 1093f7018c21STomi Valkeinen r = -EFAULT; 1094f7018c21STomi Valkeinen else { 1095f7018c21STomi Valkeinen struct omapfb_update_window *u = &p.update_window; 1096f7018c21STomi Valkeinen u->out_x = u->x; 1097f7018c21STomi Valkeinen u->out_y = u->y; 1098f7018c21STomi Valkeinen u->out_width = u->width; 1099f7018c21STomi Valkeinen u->out_height = u->height; 1100f7018c21STomi Valkeinen memset(u->reserved, 0, sizeof(u->reserved)); 1101f7018c21STomi Valkeinen r = omapfb_update_win(fbi, u); 1102f7018c21STomi Valkeinen } 1103f7018c21STomi Valkeinen break; 1104f7018c21STomi Valkeinen case OMAPFB_UPDATE_WINDOW: 1105f7018c21STomi Valkeinen if (copy_from_user(&p.update_window, (void __user *)arg, 1106f7018c21STomi Valkeinen sizeof(p.update_window))) 1107f7018c21STomi Valkeinen r = -EFAULT; 1108f7018c21STomi Valkeinen else 1109f7018c21STomi Valkeinen r = omapfb_update_win(fbi, &p.update_window); 1110f7018c21STomi Valkeinen break; 1111f7018c21STomi Valkeinen case OMAPFB_SETUP_PLANE: 1112f7018c21STomi Valkeinen if (copy_from_user(&p.plane_info, (void __user *)arg, 1113f7018c21STomi Valkeinen sizeof(p.plane_info))) 1114f7018c21STomi Valkeinen r = -EFAULT; 1115f7018c21STomi Valkeinen else 1116f7018c21STomi Valkeinen r = omapfb_setup_plane(fbi, &p.plane_info); 1117f7018c21STomi Valkeinen break; 1118f7018c21STomi Valkeinen case OMAPFB_QUERY_PLANE: 1119f7018c21STomi Valkeinen if ((r = omapfb_query_plane(fbi, &p.plane_info)) < 0) 1120f7018c21STomi Valkeinen break; 1121f7018c21STomi Valkeinen if (copy_to_user((void __user *)arg, &p.plane_info, 1122f7018c21STomi Valkeinen sizeof(p.plane_info))) 1123f7018c21STomi Valkeinen r = -EFAULT; 1124f7018c21STomi Valkeinen break; 1125f7018c21STomi Valkeinen case OMAPFB_SETUP_MEM: 1126f7018c21STomi Valkeinen if (copy_from_user(&p.mem_info, (void __user *)arg, 1127f7018c21STomi Valkeinen sizeof(p.mem_info))) 1128f7018c21STomi Valkeinen r = -EFAULT; 1129f7018c21STomi Valkeinen else 1130f7018c21STomi Valkeinen r = omapfb_setup_mem(fbi, &p.mem_info); 1131f7018c21STomi Valkeinen break; 1132f7018c21STomi Valkeinen case OMAPFB_QUERY_MEM: 1133f7018c21STomi Valkeinen if ((r = omapfb_query_mem(fbi, &p.mem_info)) < 0) 1134f7018c21STomi Valkeinen break; 1135f7018c21STomi Valkeinen if (copy_to_user((void __user *)arg, &p.mem_info, 1136f7018c21STomi Valkeinen sizeof(p.mem_info))) 1137f7018c21STomi Valkeinen r = -EFAULT; 1138f7018c21STomi Valkeinen break; 1139f7018c21STomi Valkeinen case OMAPFB_SET_COLOR_KEY: 1140f7018c21STomi Valkeinen if (copy_from_user(&p.color_key, (void __user *)arg, 1141f7018c21STomi Valkeinen sizeof(p.color_key))) 1142f7018c21STomi Valkeinen r = -EFAULT; 1143f7018c21STomi Valkeinen else 1144f7018c21STomi Valkeinen r = omapfb_set_color_key(fbdev, &p.color_key); 1145f7018c21STomi Valkeinen break; 1146f7018c21STomi Valkeinen case OMAPFB_GET_COLOR_KEY: 1147f7018c21STomi Valkeinen if ((r = omapfb_get_color_key(fbdev, &p.color_key)) < 0) 1148f7018c21STomi Valkeinen break; 1149f7018c21STomi Valkeinen if (copy_to_user((void __user *)arg, &p.color_key, 1150f7018c21STomi Valkeinen sizeof(p.color_key))) 1151f7018c21STomi Valkeinen r = -EFAULT; 1152f7018c21STomi Valkeinen break; 1153f7018c21STomi Valkeinen case OMAPFB_GET_CAPS: 1154f7018c21STomi Valkeinen omapfb_get_caps(fbdev, plane->idx, &p.caps); 1155f7018c21STomi Valkeinen if (copy_to_user((void __user *)arg, &p.caps, sizeof(p.caps))) 1156f7018c21STomi Valkeinen r = -EFAULT; 1157f7018c21STomi Valkeinen break; 1158f7018c21STomi Valkeinen case OMAPFB_LCD_TEST: 1159f7018c21STomi Valkeinen { 1160f7018c21STomi Valkeinen int test_num; 1161f7018c21STomi Valkeinen 1162f7018c21STomi Valkeinen if (get_user(test_num, (int __user *)arg)) { 1163f7018c21STomi Valkeinen r = -EFAULT; 1164f7018c21STomi Valkeinen break; 1165f7018c21STomi Valkeinen } 1166f7018c21STomi Valkeinen if (!fbdev->panel->run_test) { 1167f7018c21STomi Valkeinen r = -EINVAL; 1168f7018c21STomi Valkeinen break; 1169f7018c21STomi Valkeinen } 1170f7018c21STomi Valkeinen r = fbdev->panel->run_test(fbdev->panel, test_num); 1171f7018c21STomi Valkeinen break; 1172f7018c21STomi Valkeinen } 1173f7018c21STomi Valkeinen case OMAPFB_CTRL_TEST: 1174f7018c21STomi Valkeinen { 1175f7018c21STomi Valkeinen int test_num; 1176f7018c21STomi Valkeinen 1177f7018c21STomi Valkeinen if (get_user(test_num, (int __user *)arg)) { 1178f7018c21STomi Valkeinen r = -EFAULT; 1179f7018c21STomi Valkeinen break; 1180f7018c21STomi Valkeinen } 1181f7018c21STomi Valkeinen if (!fbdev->ctrl->run_test) { 1182f7018c21STomi Valkeinen r = -EINVAL; 1183f7018c21STomi Valkeinen break; 1184f7018c21STomi Valkeinen } 1185f7018c21STomi Valkeinen r = fbdev->ctrl->run_test(test_num); 1186f7018c21STomi Valkeinen break; 1187f7018c21STomi Valkeinen } 1188f7018c21STomi Valkeinen default: 1189f7018c21STomi Valkeinen r = -EINVAL; 1190f7018c21STomi Valkeinen } 1191f7018c21STomi Valkeinen 1192f7018c21STomi Valkeinen return r; 1193f7018c21STomi Valkeinen } 1194f7018c21STomi Valkeinen 1195f7018c21STomi Valkeinen static int omapfb_mmap(struct fb_info *info, struct vm_area_struct *vma) 1196f7018c21STomi Valkeinen { 1197f7018c21STomi Valkeinen struct omapfb_plane_struct *plane = info->par; 1198f7018c21STomi Valkeinen struct omapfb_device *fbdev = plane->fbdev; 1199f7018c21STomi Valkeinen int r; 1200f7018c21STomi Valkeinen 1201f7018c21STomi Valkeinen omapfb_rqueue_lock(fbdev); 1202f7018c21STomi Valkeinen r = fbdev->ctrl->mmap(info, vma); 1203f7018c21STomi Valkeinen omapfb_rqueue_unlock(fbdev); 1204f7018c21STomi Valkeinen 1205f7018c21STomi Valkeinen return r; 1206f7018c21STomi Valkeinen } 1207f7018c21STomi Valkeinen 1208f7018c21STomi Valkeinen /* 1209f7018c21STomi Valkeinen * Callback table for the frame buffer framework. Some of these pointers 1210f7018c21STomi Valkeinen * will be changed according to the current setting of fb_info->accel_flags. 1211f7018c21STomi Valkeinen */ 1212f7018c21STomi Valkeinen static struct fb_ops omapfb_ops = { 1213f7018c21STomi Valkeinen .owner = THIS_MODULE, 1214f7018c21STomi Valkeinen .fb_open = omapfb_open, 1215f7018c21STomi Valkeinen .fb_release = omapfb_release, 1216f7018c21STomi Valkeinen .fb_setcolreg = omapfb_setcolreg, 1217f7018c21STomi Valkeinen .fb_setcmap = omapfb_setcmap, 1218f7018c21STomi Valkeinen .fb_fillrect = cfb_fillrect, 1219f7018c21STomi Valkeinen .fb_copyarea = cfb_copyarea, 1220f7018c21STomi Valkeinen .fb_imageblit = cfb_imageblit, 1221f7018c21STomi Valkeinen .fb_blank = omapfb_blank, 1222f7018c21STomi Valkeinen .fb_ioctl = omapfb_ioctl, 1223f7018c21STomi Valkeinen .fb_check_var = omapfb_check_var, 1224f7018c21STomi Valkeinen .fb_set_par = omapfb_set_par, 1225f7018c21STomi Valkeinen .fb_pan_display = omapfb_pan_display, 1226f7018c21STomi Valkeinen }; 1227f7018c21STomi Valkeinen 1228f7018c21STomi Valkeinen /* 1229f7018c21STomi Valkeinen * --------------------------------------------------------------------------- 1230f7018c21STomi Valkeinen * Sysfs interface 1231f7018c21STomi Valkeinen * --------------------------------------------------------------------------- 1232f7018c21STomi Valkeinen */ 1233f7018c21STomi Valkeinen /* omapfbX sysfs entries */ 1234f7018c21STomi Valkeinen static ssize_t omapfb_show_caps_num(struct device *dev, 1235f7018c21STomi Valkeinen struct device_attribute *attr, char *buf) 1236f7018c21STomi Valkeinen { 1237f7018c21STomi Valkeinen struct omapfb_device *fbdev = dev_get_drvdata(dev); 1238f7018c21STomi Valkeinen int plane; 1239f7018c21STomi Valkeinen size_t size; 1240f7018c21STomi Valkeinen struct omapfb_caps caps; 1241f7018c21STomi Valkeinen 1242f7018c21STomi Valkeinen plane = 0; 1243f7018c21STomi Valkeinen size = 0; 1244f7018c21STomi Valkeinen while (size < PAGE_SIZE && plane < OMAPFB_PLANE_NUM) { 1245f7018c21STomi Valkeinen omapfb_get_caps(fbdev, plane, &caps); 1246bf1b615aSTakashi Iwai size += scnprintf(&buf[size], PAGE_SIZE - size, 1247f7018c21STomi Valkeinen "plane#%d %#010x %#010x %#010x\n", 1248f7018c21STomi Valkeinen plane, caps.ctrl, caps.plane_color, caps.wnd_color); 1249f7018c21STomi Valkeinen plane++; 1250f7018c21STomi Valkeinen } 1251f7018c21STomi Valkeinen return size; 1252f7018c21STomi Valkeinen } 1253f7018c21STomi Valkeinen 1254f7018c21STomi Valkeinen static ssize_t omapfb_show_caps_text(struct device *dev, 1255f7018c21STomi Valkeinen struct device_attribute *attr, char *buf) 1256f7018c21STomi Valkeinen { 1257f7018c21STomi Valkeinen struct omapfb_device *fbdev = dev_get_drvdata(dev); 1258f7018c21STomi Valkeinen int i; 1259f7018c21STomi Valkeinen struct omapfb_caps caps; 1260f7018c21STomi Valkeinen int plane; 1261f7018c21STomi Valkeinen size_t size; 1262f7018c21STomi Valkeinen 1263f7018c21STomi Valkeinen plane = 0; 1264f7018c21STomi Valkeinen size = 0; 1265f7018c21STomi Valkeinen while (size < PAGE_SIZE && plane < OMAPFB_PLANE_NUM) { 1266f7018c21STomi Valkeinen omapfb_get_caps(fbdev, plane, &caps); 1267bf1b615aSTakashi Iwai size += scnprintf(&buf[size], PAGE_SIZE - size, 1268f7018c21STomi Valkeinen "plane#%d:\n", plane); 1269f7018c21STomi Valkeinen for (i = 0; i < ARRAY_SIZE(ctrl_caps) && 1270f7018c21STomi Valkeinen size < PAGE_SIZE; i++) { 1271f7018c21STomi Valkeinen if (ctrl_caps[i].flag & caps.ctrl) 1272bf1b615aSTakashi Iwai size += scnprintf(&buf[size], PAGE_SIZE - size, 1273f7018c21STomi Valkeinen " %s\n", ctrl_caps[i].name); 1274f7018c21STomi Valkeinen } 1275bf1b615aSTakashi Iwai size += scnprintf(&buf[size], PAGE_SIZE - size, 1276f7018c21STomi Valkeinen " plane colors:\n"); 1277f7018c21STomi Valkeinen for (i = 0; i < ARRAY_SIZE(color_caps) && 1278f7018c21STomi Valkeinen size < PAGE_SIZE; i++) { 1279f7018c21STomi Valkeinen if (color_caps[i].flag & caps.plane_color) 1280bf1b615aSTakashi Iwai size += scnprintf(&buf[size], PAGE_SIZE - size, 1281f7018c21STomi Valkeinen " %s\n", color_caps[i].name); 1282f7018c21STomi Valkeinen } 1283bf1b615aSTakashi Iwai size += scnprintf(&buf[size], PAGE_SIZE - size, 1284f7018c21STomi Valkeinen " window colors:\n"); 1285f7018c21STomi Valkeinen for (i = 0; i < ARRAY_SIZE(color_caps) && 1286f7018c21STomi Valkeinen size < PAGE_SIZE; i++) { 1287f7018c21STomi Valkeinen if (color_caps[i].flag & caps.wnd_color) 1288bf1b615aSTakashi Iwai size += scnprintf(&buf[size], PAGE_SIZE - size, 1289f7018c21STomi Valkeinen " %s\n", color_caps[i].name); 1290f7018c21STomi Valkeinen } 1291f7018c21STomi Valkeinen 1292f7018c21STomi Valkeinen plane++; 1293f7018c21STomi Valkeinen } 1294f7018c21STomi Valkeinen return size; 1295f7018c21STomi Valkeinen } 1296f7018c21STomi Valkeinen 1297f7018c21STomi Valkeinen static DEVICE_ATTR(caps_num, 0444, omapfb_show_caps_num, NULL); 1298f7018c21STomi Valkeinen static DEVICE_ATTR(caps_text, 0444, omapfb_show_caps_text, NULL); 1299f7018c21STomi Valkeinen 1300f7018c21STomi Valkeinen /* panel sysfs entries */ 1301f7018c21STomi Valkeinen static ssize_t omapfb_show_panel_name(struct device *dev, 1302f7018c21STomi Valkeinen struct device_attribute *attr, char *buf) 1303f7018c21STomi Valkeinen { 1304f7018c21STomi Valkeinen struct omapfb_device *fbdev = dev_get_drvdata(dev); 1305f7018c21STomi Valkeinen 1306f7018c21STomi Valkeinen return snprintf(buf, PAGE_SIZE, "%s\n", fbdev->panel->name); 1307f7018c21STomi Valkeinen } 1308f7018c21STomi Valkeinen 1309f7018c21STomi Valkeinen static ssize_t omapfb_show_bklight_level(struct device *dev, 1310f7018c21STomi Valkeinen struct device_attribute *attr, 1311f7018c21STomi Valkeinen char *buf) 1312f7018c21STomi Valkeinen { 1313f7018c21STomi Valkeinen struct omapfb_device *fbdev = dev_get_drvdata(dev); 1314f7018c21STomi Valkeinen int r; 1315f7018c21STomi Valkeinen 1316f7018c21STomi Valkeinen if (fbdev->panel->get_bklight_level) { 1317f7018c21STomi Valkeinen r = snprintf(buf, PAGE_SIZE, "%d\n", 1318f7018c21STomi Valkeinen fbdev->panel->get_bklight_level(fbdev->panel)); 1319f7018c21STomi Valkeinen } else 1320f7018c21STomi Valkeinen r = -ENODEV; 1321f7018c21STomi Valkeinen return r; 1322f7018c21STomi Valkeinen } 1323f7018c21STomi Valkeinen 1324f7018c21STomi Valkeinen static ssize_t omapfb_store_bklight_level(struct device *dev, 1325f7018c21STomi Valkeinen struct device_attribute *attr, 1326f7018c21STomi Valkeinen const char *buf, size_t size) 1327f7018c21STomi Valkeinen { 1328f7018c21STomi Valkeinen struct omapfb_device *fbdev = dev_get_drvdata(dev); 1329f7018c21STomi Valkeinen int r; 1330f7018c21STomi Valkeinen 1331f7018c21STomi Valkeinen if (fbdev->panel->set_bklight_level) { 1332f7018c21STomi Valkeinen unsigned int level; 1333f7018c21STomi Valkeinen 1334f7018c21STomi Valkeinen if (sscanf(buf, "%10d", &level) == 1) { 1335f7018c21STomi Valkeinen r = fbdev->panel->set_bklight_level(fbdev->panel, 1336f7018c21STomi Valkeinen level); 1337f7018c21STomi Valkeinen } else 1338f7018c21STomi Valkeinen r = -EINVAL; 1339f7018c21STomi Valkeinen } else 1340f7018c21STomi Valkeinen r = -ENODEV; 1341f7018c21STomi Valkeinen return r ? r : size; 1342f7018c21STomi Valkeinen } 1343f7018c21STomi Valkeinen 1344f7018c21STomi Valkeinen static ssize_t omapfb_show_bklight_max(struct device *dev, 1345f7018c21STomi Valkeinen struct device_attribute *attr, char *buf) 1346f7018c21STomi Valkeinen { 1347f7018c21STomi Valkeinen struct omapfb_device *fbdev = dev_get_drvdata(dev); 1348f7018c21STomi Valkeinen int r; 1349f7018c21STomi Valkeinen 1350f7018c21STomi Valkeinen if (fbdev->panel->get_bklight_level) { 1351f7018c21STomi Valkeinen r = snprintf(buf, PAGE_SIZE, "%d\n", 1352f7018c21STomi Valkeinen fbdev->panel->get_bklight_max(fbdev->panel)); 1353f7018c21STomi Valkeinen } else 1354f7018c21STomi Valkeinen r = -ENODEV; 1355f7018c21STomi Valkeinen return r; 1356f7018c21STomi Valkeinen } 1357f7018c21STomi Valkeinen 1358f7018c21STomi Valkeinen static struct device_attribute dev_attr_panel_name = 1359f7018c21STomi Valkeinen __ATTR(name, 0444, omapfb_show_panel_name, NULL); 1360f7018c21STomi Valkeinen static DEVICE_ATTR(backlight_level, 0664, 1361f7018c21STomi Valkeinen omapfb_show_bklight_level, omapfb_store_bklight_level); 1362f7018c21STomi Valkeinen static DEVICE_ATTR(backlight_max, 0444, omapfb_show_bklight_max, NULL); 1363f7018c21STomi Valkeinen 1364f7018c21STomi Valkeinen static struct attribute *panel_attrs[] = { 1365f7018c21STomi Valkeinen &dev_attr_panel_name.attr, 1366f7018c21STomi Valkeinen &dev_attr_backlight_level.attr, 1367f7018c21STomi Valkeinen &dev_attr_backlight_max.attr, 1368f7018c21STomi Valkeinen NULL, 1369f7018c21STomi Valkeinen }; 1370f7018c21STomi Valkeinen 137162bffe32SArvind Yadav static const struct attribute_group panel_attr_grp = { 1372f7018c21STomi Valkeinen .name = "panel", 1373f7018c21STomi Valkeinen .attrs = panel_attrs, 1374f7018c21STomi Valkeinen }; 1375f7018c21STomi Valkeinen 1376f7018c21STomi Valkeinen /* ctrl sysfs entries */ 1377f7018c21STomi Valkeinen static ssize_t omapfb_show_ctrl_name(struct device *dev, 1378f7018c21STomi Valkeinen struct device_attribute *attr, char *buf) 1379f7018c21STomi Valkeinen { 1380f7018c21STomi Valkeinen struct omapfb_device *fbdev = dev_get_drvdata(dev); 1381f7018c21STomi Valkeinen 1382f7018c21STomi Valkeinen return snprintf(buf, PAGE_SIZE, "%s\n", fbdev->ctrl->name); 1383f7018c21STomi Valkeinen } 1384f7018c21STomi Valkeinen 1385f7018c21STomi Valkeinen static struct device_attribute dev_attr_ctrl_name = 1386f7018c21STomi Valkeinen __ATTR(name, 0444, omapfb_show_ctrl_name, NULL); 1387f7018c21STomi Valkeinen 1388f7018c21STomi Valkeinen static struct attribute *ctrl_attrs[] = { 1389f7018c21STomi Valkeinen &dev_attr_ctrl_name.attr, 1390f7018c21STomi Valkeinen NULL, 1391f7018c21STomi Valkeinen }; 1392f7018c21STomi Valkeinen 139362bffe32SArvind Yadav static const struct attribute_group ctrl_attr_grp = { 1394f7018c21STomi Valkeinen .name = "ctrl", 1395f7018c21STomi Valkeinen .attrs = ctrl_attrs, 1396f7018c21STomi Valkeinen }; 1397f7018c21STomi Valkeinen 1398f7018c21STomi Valkeinen static int omapfb_register_sysfs(struct omapfb_device *fbdev) 1399f7018c21STomi Valkeinen { 1400f7018c21STomi Valkeinen int r; 1401f7018c21STomi Valkeinen 1402f7018c21STomi Valkeinen if ((r = device_create_file(fbdev->dev, &dev_attr_caps_num))) 1403f7018c21STomi Valkeinen goto fail0; 1404f7018c21STomi Valkeinen 1405f7018c21STomi Valkeinen if ((r = device_create_file(fbdev->dev, &dev_attr_caps_text))) 1406f7018c21STomi Valkeinen goto fail1; 1407f7018c21STomi Valkeinen 1408f7018c21STomi Valkeinen if ((r = sysfs_create_group(&fbdev->dev->kobj, &panel_attr_grp))) 1409f7018c21STomi Valkeinen goto fail2; 1410f7018c21STomi Valkeinen 1411f7018c21STomi Valkeinen if ((r = sysfs_create_group(&fbdev->dev->kobj, &ctrl_attr_grp))) 1412f7018c21STomi Valkeinen goto fail3; 1413f7018c21STomi Valkeinen 1414f7018c21STomi Valkeinen return 0; 1415f7018c21STomi Valkeinen fail3: 1416f7018c21STomi Valkeinen sysfs_remove_group(&fbdev->dev->kobj, &panel_attr_grp); 1417f7018c21STomi Valkeinen fail2: 1418f7018c21STomi Valkeinen device_remove_file(fbdev->dev, &dev_attr_caps_text); 1419f7018c21STomi Valkeinen fail1: 1420f7018c21STomi Valkeinen device_remove_file(fbdev->dev, &dev_attr_caps_num); 1421f7018c21STomi Valkeinen fail0: 1422f7018c21STomi Valkeinen dev_err(fbdev->dev, "unable to register sysfs interface\n"); 1423f7018c21STomi Valkeinen return r; 1424f7018c21STomi Valkeinen } 1425f7018c21STomi Valkeinen 1426f7018c21STomi Valkeinen static void omapfb_unregister_sysfs(struct omapfb_device *fbdev) 1427f7018c21STomi Valkeinen { 1428f7018c21STomi Valkeinen sysfs_remove_group(&fbdev->dev->kobj, &ctrl_attr_grp); 1429f7018c21STomi Valkeinen sysfs_remove_group(&fbdev->dev->kobj, &panel_attr_grp); 1430f7018c21STomi Valkeinen device_remove_file(fbdev->dev, &dev_attr_caps_num); 1431f7018c21STomi Valkeinen device_remove_file(fbdev->dev, &dev_attr_caps_text); 1432f7018c21STomi Valkeinen } 1433f7018c21STomi Valkeinen 1434f7018c21STomi Valkeinen /* 1435f7018c21STomi Valkeinen * --------------------------------------------------------------------------- 1436f7018c21STomi Valkeinen * LDM callbacks 1437f7018c21STomi Valkeinen * --------------------------------------------------------------------------- 1438f7018c21STomi Valkeinen */ 1439f7018c21STomi Valkeinen /* Initialize system fb_info object and set the default video mode. 1440f7018c21STomi Valkeinen * The frame buffer memory already allocated by lcddma_init 1441f7018c21STomi Valkeinen */ 1442f7018c21STomi Valkeinen static int fbinfo_init(struct omapfb_device *fbdev, struct fb_info *info) 1443f7018c21STomi Valkeinen { 1444f7018c21STomi Valkeinen struct fb_var_screeninfo *var = &info->var; 1445f7018c21STomi Valkeinen struct fb_fix_screeninfo *fix = &info->fix; 1446f7018c21STomi Valkeinen int r = 0; 1447f7018c21STomi Valkeinen 1448f7018c21STomi Valkeinen info->fbops = &omapfb_ops; 1449f7018c21STomi Valkeinen info->flags = FBINFO_FLAG_DEFAULT; 1450f7018c21STomi Valkeinen 1451f7018c21STomi Valkeinen strncpy(fix->id, MODULE_NAME, sizeof(fix->id)); 1452f7018c21STomi Valkeinen 1453f7018c21STomi Valkeinen info->pseudo_palette = fbdev->pseudo_palette; 1454f7018c21STomi Valkeinen 1455f7018c21STomi Valkeinen var->accel_flags = def_accel ? FB_ACCELF_TEXT : 0; 1456f7018c21STomi Valkeinen var->xres = def_vxres; 1457f7018c21STomi Valkeinen var->yres = def_vyres; 1458f7018c21STomi Valkeinen var->xres_virtual = def_vxres; 1459f7018c21STomi Valkeinen var->yres_virtual = def_vyres; 1460f7018c21STomi Valkeinen var->rotate = def_rotate; 1461f7018c21STomi Valkeinen var->bits_per_pixel = fbdev->panel->bpp; 1462f7018c21STomi Valkeinen 1463f7018c21STomi Valkeinen set_fb_var(info, var); 1464f7018c21STomi Valkeinen set_fb_fix(info, 1); 1465f7018c21STomi Valkeinen 1466f7018c21STomi Valkeinen r = fb_alloc_cmap(&info->cmap, 16, 0); 1467f7018c21STomi Valkeinen if (r != 0) 1468f7018c21STomi Valkeinen dev_err(fbdev->dev, "unable to allocate color map memory\n"); 1469f7018c21STomi Valkeinen 1470f7018c21STomi Valkeinen return r; 1471f7018c21STomi Valkeinen } 1472f7018c21STomi Valkeinen 1473f7018c21STomi Valkeinen /* Release the fb_info object */ 1474f7018c21STomi Valkeinen static void fbinfo_cleanup(struct omapfb_device *fbdev, struct fb_info *fbi) 1475f7018c21STomi Valkeinen { 1476f7018c21STomi Valkeinen fb_dealloc_cmap(&fbi->cmap); 1477f7018c21STomi Valkeinen } 1478f7018c21STomi Valkeinen 1479f7018c21STomi Valkeinen static void planes_cleanup(struct omapfb_device *fbdev) 1480f7018c21STomi Valkeinen { 1481f7018c21STomi Valkeinen int i; 1482f7018c21STomi Valkeinen 1483f7018c21STomi Valkeinen for (i = 0; i < fbdev->mem_desc.region_cnt; i++) { 1484f7018c21STomi Valkeinen if (fbdev->fb_info[i] == NULL) 1485f7018c21STomi Valkeinen break; 1486f7018c21STomi Valkeinen fbinfo_cleanup(fbdev, fbdev->fb_info[i]); 1487f7018c21STomi Valkeinen framebuffer_release(fbdev->fb_info[i]); 1488f7018c21STomi Valkeinen } 1489f7018c21STomi Valkeinen } 1490f7018c21STomi Valkeinen 1491f7018c21STomi Valkeinen static int planes_init(struct omapfb_device *fbdev) 1492f7018c21STomi Valkeinen { 1493f7018c21STomi Valkeinen struct fb_info *fbi; 1494f7018c21STomi Valkeinen int i; 1495f7018c21STomi Valkeinen int r; 1496f7018c21STomi Valkeinen 1497f7018c21STomi Valkeinen for (i = 0; i < fbdev->mem_desc.region_cnt; i++) { 1498f7018c21STomi Valkeinen struct omapfb_plane_struct *plane; 1499f7018c21STomi Valkeinen fbi = framebuffer_alloc(sizeof(struct omapfb_plane_struct), 1500f7018c21STomi Valkeinen fbdev->dev); 1501f7018c21STomi Valkeinen if (fbi == NULL) { 1502f7018c21STomi Valkeinen planes_cleanup(fbdev); 1503f7018c21STomi Valkeinen return -ENOMEM; 1504f7018c21STomi Valkeinen } 1505f7018c21STomi Valkeinen plane = fbi->par; 1506f7018c21STomi Valkeinen plane->idx = i; 1507f7018c21STomi Valkeinen plane->fbdev = fbdev; 1508f7018c21STomi Valkeinen plane->info.mirror = def_mirror; 1509f7018c21STomi Valkeinen fbdev->fb_info[i] = fbi; 1510f7018c21STomi Valkeinen 1511f7018c21STomi Valkeinen if ((r = fbinfo_init(fbdev, fbi)) < 0) { 1512f7018c21STomi Valkeinen framebuffer_release(fbi); 1513f7018c21STomi Valkeinen planes_cleanup(fbdev); 1514f7018c21STomi Valkeinen return r; 1515f7018c21STomi Valkeinen } 1516f7018c21STomi Valkeinen plane->info.out_width = fbi->var.xres; 1517f7018c21STomi Valkeinen plane->info.out_height = fbi->var.yres; 1518f7018c21STomi Valkeinen } 1519f7018c21STomi Valkeinen return 0; 1520f7018c21STomi Valkeinen } 1521f7018c21STomi Valkeinen 1522f7018c21STomi Valkeinen /* 1523f7018c21STomi Valkeinen * Free driver resources. Can be called to rollback an aborted initialization 1524f7018c21STomi Valkeinen * sequence. 1525f7018c21STomi Valkeinen */ 1526f7018c21STomi Valkeinen static void omapfb_free_resources(struct omapfb_device *fbdev, int state) 1527f7018c21STomi Valkeinen { 1528f7018c21STomi Valkeinen int i; 1529f7018c21STomi Valkeinen 1530f7018c21STomi Valkeinen switch (state) { 1531f7018c21STomi Valkeinen case OMAPFB_ACTIVE: 1532f7018c21STomi Valkeinen for (i = 0; i < fbdev->mem_desc.region_cnt; i++) 1533f7018c21STomi Valkeinen unregister_framebuffer(fbdev->fb_info[i]); 153470a2783cSGustavo A. R. Silva /* fall through */ 1535f7018c21STomi Valkeinen case 7: 1536f7018c21STomi Valkeinen omapfb_unregister_sysfs(fbdev); 153770a2783cSGustavo A. R. Silva /* fall through */ 1538f7018c21STomi Valkeinen case 6: 1539561eb9d0SLars-Peter Clausen if (fbdev->panel->disable) 1540f7018c21STomi Valkeinen fbdev->panel->disable(fbdev->panel); 154170a2783cSGustavo A. R. Silva /* fall through */ 1542f7018c21STomi Valkeinen case 5: 1543f7018c21STomi Valkeinen omapfb_set_update_mode(fbdev, OMAPFB_UPDATE_DISABLED); 154470a2783cSGustavo A. R. Silva /* fall through */ 1545f7018c21STomi Valkeinen case 4: 1546f7018c21STomi Valkeinen planes_cleanup(fbdev); 154770a2783cSGustavo A. R. Silva /* fall through */ 1548f7018c21STomi Valkeinen case 3: 1549f7018c21STomi Valkeinen ctrl_cleanup(fbdev); 155070a2783cSGustavo A. R. Silva /* fall through */ 1551f7018c21STomi Valkeinen case 2: 1552561eb9d0SLars-Peter Clausen if (fbdev->panel->cleanup) 1553f7018c21STomi Valkeinen fbdev->panel->cleanup(fbdev->panel); 155470a2783cSGustavo A. R. Silva /* fall through */ 1555f7018c21STomi Valkeinen case 1: 1556f7018c21STomi Valkeinen dev_set_drvdata(fbdev->dev, NULL); 1557f7018c21STomi Valkeinen kfree(fbdev); 1558f7018c21STomi Valkeinen case 0: 1559f7018c21STomi Valkeinen /* nothing to free */ 1560f7018c21STomi Valkeinen break; 1561f7018c21STomi Valkeinen default: 1562f7018c21STomi Valkeinen BUG(); 1563f7018c21STomi Valkeinen } 1564f7018c21STomi Valkeinen } 1565f7018c21STomi Valkeinen 1566f7018c21STomi Valkeinen static int omapfb_find_ctrl(struct omapfb_device *fbdev) 1567f7018c21STomi Valkeinen { 1568f7018c21STomi Valkeinen struct omapfb_platform_data *conf; 1569f7018c21STomi Valkeinen char name[17]; 1570f7018c21STomi Valkeinen int i; 1571f7018c21STomi Valkeinen 1572f7018c21STomi Valkeinen conf = dev_get_platdata(fbdev->dev); 1573f7018c21STomi Valkeinen 1574f7018c21STomi Valkeinen fbdev->ctrl = NULL; 1575f7018c21STomi Valkeinen 1576f7018c21STomi Valkeinen strncpy(name, conf->lcd.ctrl_name, sizeof(name) - 1); 1577f7018c21STomi Valkeinen name[sizeof(name) - 1] = '\0'; 1578f7018c21STomi Valkeinen 1579f7018c21STomi Valkeinen if (strcmp(name, "internal") == 0) { 1580f7018c21STomi Valkeinen fbdev->ctrl = fbdev->int_ctrl; 1581f7018c21STomi Valkeinen return 0; 1582f7018c21STomi Valkeinen } 1583f7018c21STomi Valkeinen 1584f7018c21STomi Valkeinen for (i = 0; i < ARRAY_SIZE(ctrls); i++) { 1585f7018c21STomi Valkeinen dev_dbg(fbdev->dev, "ctrl %s\n", ctrls[i]->name); 1586f7018c21STomi Valkeinen if (strcmp(ctrls[i]->name, name) == 0) { 1587f7018c21STomi Valkeinen fbdev->ctrl = ctrls[i]; 1588f7018c21STomi Valkeinen break; 1589f7018c21STomi Valkeinen } 1590f7018c21STomi Valkeinen } 1591f7018c21STomi Valkeinen 1592f7018c21STomi Valkeinen if (fbdev->ctrl == NULL) { 1593f7018c21STomi Valkeinen dev_dbg(fbdev->dev, "ctrl %s not supported\n", name); 1594f7018c21STomi Valkeinen return -1; 1595f7018c21STomi Valkeinen } 1596f7018c21STomi Valkeinen 1597f7018c21STomi Valkeinen return 0; 1598f7018c21STomi Valkeinen } 1599f7018c21STomi Valkeinen 1600f7018c21STomi Valkeinen /* 1601f7018c21STomi Valkeinen * Called by LDM binding to probe and attach a new device. 1602f7018c21STomi Valkeinen * Initialization sequence: 1603f7018c21STomi Valkeinen * 1. allocate system omapfb_device structure 1604f7018c21STomi Valkeinen * 2. select controller type according to platform configuration 1605f7018c21STomi Valkeinen * init LCD panel 1606f7018c21STomi Valkeinen * 3. init LCD controller and LCD DMA 1607f7018c21STomi Valkeinen * 4. init system fb_info structure for all planes 1608f7018c21STomi Valkeinen * 5. setup video mode for first plane and enable it 1609f7018c21STomi Valkeinen * 6. enable LCD panel 1610f7018c21STomi Valkeinen * 7. register sysfs attributes 1611f7018c21STomi Valkeinen * OMAPFB_ACTIVE: register system fb_info structure for all planes 1612f7018c21STomi Valkeinen */ 1613f7018c21STomi Valkeinen static int omapfb_do_probe(struct platform_device *pdev, 1614f7018c21STomi Valkeinen struct lcd_panel *panel) 1615f7018c21STomi Valkeinen { 1616f7018c21STomi Valkeinen struct omapfb_device *fbdev = NULL; 1617f7018c21STomi Valkeinen int init_state; 1618f7018c21STomi Valkeinen unsigned long phz, hhz, vhz; 1619f7018c21STomi Valkeinen unsigned long vram; 1620f7018c21STomi Valkeinen int i; 1621f7018c21STomi Valkeinen int r = 0; 1622f7018c21STomi Valkeinen 1623f7018c21STomi Valkeinen init_state = 0; 1624f7018c21STomi Valkeinen 1625f7018c21STomi Valkeinen if (pdev->num_resources != 0) { 1626f7018c21STomi Valkeinen dev_err(&pdev->dev, "probed for an unknown device\n"); 1627f7018c21STomi Valkeinen r = -ENODEV; 1628f7018c21STomi Valkeinen goto cleanup; 1629f7018c21STomi Valkeinen } 1630f7018c21STomi Valkeinen 1631f7018c21STomi Valkeinen if (dev_get_platdata(&pdev->dev) == NULL) { 1632f7018c21STomi Valkeinen dev_err(&pdev->dev, "missing platform data\n"); 1633f7018c21STomi Valkeinen r = -ENOENT; 1634f7018c21STomi Valkeinen goto cleanup; 1635f7018c21STomi Valkeinen } 1636f7018c21STomi Valkeinen 163785d108deSMarkus Elfring fbdev = kzalloc(sizeof(*fbdev), GFP_KERNEL); 1638f7018c21STomi Valkeinen if (fbdev == NULL) { 1639f7018c21STomi Valkeinen dev_err(&pdev->dev, 1640f7018c21STomi Valkeinen "unable to allocate memory for device info\n"); 1641f7018c21STomi Valkeinen r = -ENOMEM; 1642f7018c21STomi Valkeinen goto cleanup; 1643f7018c21STomi Valkeinen } 1644f7018c21STomi Valkeinen init_state++; 1645f7018c21STomi Valkeinen 1646f7018c21STomi Valkeinen fbdev->dev = &pdev->dev; 1647f7018c21STomi Valkeinen fbdev->panel = panel; 1648f7018c21STomi Valkeinen fbdev->dssdev = &omapdss_device; 1649f7018c21STomi Valkeinen platform_set_drvdata(pdev, fbdev); 1650f7018c21STomi Valkeinen 1651f7018c21STomi Valkeinen mutex_init(&fbdev->rqueue_mutex); 1652f7018c21STomi Valkeinen 1653f7018c21STomi Valkeinen fbdev->int_ctrl = &omap1_int_ctrl; 1654f7018c21STomi Valkeinen #ifdef CONFIG_FB_OMAP_LCDC_EXTERNAL 1655f7018c21STomi Valkeinen fbdev->ext_if = &omap1_ext_if; 1656f7018c21STomi Valkeinen #endif 1657f7018c21STomi Valkeinen if (omapfb_find_ctrl(fbdev) < 0) { 1658f7018c21STomi Valkeinen dev_err(fbdev->dev, 1659f7018c21STomi Valkeinen "LCD controller not found, board not supported\n"); 1660f7018c21STomi Valkeinen r = -ENODEV; 1661f7018c21STomi Valkeinen goto cleanup; 1662f7018c21STomi Valkeinen } 1663f7018c21STomi Valkeinen 1664561eb9d0SLars-Peter Clausen if (fbdev->panel->init) { 1665f7018c21STomi Valkeinen r = fbdev->panel->init(fbdev->panel, fbdev); 1666f7018c21STomi Valkeinen if (r) 1667f7018c21STomi Valkeinen goto cleanup; 1668561eb9d0SLars-Peter Clausen } 1669f7018c21STomi Valkeinen 1670f7018c21STomi Valkeinen pr_info("omapfb: configured for panel %s\n", fbdev->panel->name); 1671f7018c21STomi Valkeinen 1672f7018c21STomi Valkeinen def_vxres = def_vxres ? def_vxres : fbdev->panel->x_res; 1673f7018c21STomi Valkeinen def_vyres = def_vyres ? def_vyres : fbdev->panel->y_res; 1674f7018c21STomi Valkeinen 1675f7018c21STomi Valkeinen init_state++; 1676f7018c21STomi Valkeinen 1677f7018c21STomi Valkeinen r = ctrl_init(fbdev); 1678f7018c21STomi Valkeinen if (r) 1679f7018c21STomi Valkeinen goto cleanup; 1680f7018c21STomi Valkeinen if (fbdev->ctrl->mmap != NULL) 1681f7018c21STomi Valkeinen omapfb_ops.fb_mmap = omapfb_mmap; 1682f7018c21STomi Valkeinen init_state++; 1683f7018c21STomi Valkeinen 1684f7018c21STomi Valkeinen r = planes_init(fbdev); 1685f7018c21STomi Valkeinen if (r) 1686f7018c21STomi Valkeinen goto cleanup; 1687f7018c21STomi Valkeinen init_state++; 1688f7018c21STomi Valkeinen 1689f7018c21STomi Valkeinen #ifdef CONFIG_FB_OMAP_DMA_TUNE 1690f7018c21STomi Valkeinen /* Set DMA priority for EMIFF access to highest */ 1691f7018c21STomi Valkeinen omap_set_dma_priority(0, OMAP_DMA_PORT_EMIFF, 15); 1692f7018c21STomi Valkeinen #endif 1693f7018c21STomi Valkeinen 1694f7018c21STomi Valkeinen r = ctrl_change_mode(fbdev->fb_info[0]); 1695f7018c21STomi Valkeinen if (r) { 1696f7018c21STomi Valkeinen dev_err(fbdev->dev, "mode setting failed\n"); 1697f7018c21STomi Valkeinen goto cleanup; 1698f7018c21STomi Valkeinen } 1699f7018c21STomi Valkeinen 1700f7018c21STomi Valkeinen /* GFX plane is enabled by default */ 1701f7018c21STomi Valkeinen r = fbdev->ctrl->enable_plane(OMAPFB_PLANE_GFX, 1); 1702f7018c21STomi Valkeinen if (r) 1703f7018c21STomi Valkeinen goto cleanup; 1704f7018c21STomi Valkeinen 1705f7018c21STomi Valkeinen omapfb_set_update_mode(fbdev, manual_update ? 1706f7018c21STomi Valkeinen OMAPFB_MANUAL_UPDATE : OMAPFB_AUTO_UPDATE); 1707f7018c21STomi Valkeinen init_state++; 1708f7018c21STomi Valkeinen 1709561eb9d0SLars-Peter Clausen if (fbdev->panel->enable) { 1710f7018c21STomi Valkeinen r = fbdev->panel->enable(fbdev->panel); 1711f7018c21STomi Valkeinen if (r) 1712f7018c21STomi Valkeinen goto cleanup; 1713561eb9d0SLars-Peter Clausen } 1714f7018c21STomi Valkeinen init_state++; 1715f7018c21STomi Valkeinen 1716f7018c21STomi Valkeinen r = omapfb_register_sysfs(fbdev); 1717f7018c21STomi Valkeinen if (r) 1718f7018c21STomi Valkeinen goto cleanup; 1719f7018c21STomi Valkeinen init_state++; 1720f7018c21STomi Valkeinen 1721f7018c21STomi Valkeinen vram = 0; 1722f7018c21STomi Valkeinen for (i = 0; i < fbdev->mem_desc.region_cnt; i++) { 1723f7018c21STomi Valkeinen r = register_framebuffer(fbdev->fb_info[i]); 1724f7018c21STomi Valkeinen if (r != 0) { 1725f7018c21STomi Valkeinen dev_err(fbdev->dev, 1726f7018c21STomi Valkeinen "registering framebuffer %d failed\n", i); 1727f7018c21STomi Valkeinen goto cleanup; 1728f7018c21STomi Valkeinen } 1729f7018c21STomi Valkeinen vram += fbdev->mem_desc.region[i].size; 1730f7018c21STomi Valkeinen } 1731f7018c21STomi Valkeinen 1732f7018c21STomi Valkeinen fbdev->state = OMAPFB_ACTIVE; 1733f7018c21STomi Valkeinen 1734f7018c21STomi Valkeinen panel = fbdev->panel; 1735f7018c21STomi Valkeinen phz = panel->pixel_clock * 1000; 1736f7018c21STomi Valkeinen hhz = phz * 10 / (panel->hfp + panel->x_res + panel->hbp + panel->hsw); 1737f7018c21STomi Valkeinen vhz = hhz / (panel->vfp + panel->y_res + panel->vbp + panel->vsw); 1738f7018c21STomi Valkeinen 1739f7018c21STomi Valkeinen omapfb_dev = fbdev; 1740f7018c21STomi Valkeinen 1741f7018c21STomi Valkeinen pr_info("omapfb: Framebuffer initialized. Total vram %lu planes %d\n", 1742f7018c21STomi Valkeinen vram, fbdev->mem_desc.region_cnt); 1743f7018c21STomi Valkeinen pr_info("omapfb: Pixclock %lu kHz hfreq %lu.%lu kHz " 1744f7018c21STomi Valkeinen "vfreq %lu.%lu Hz\n", 1745f7018c21STomi Valkeinen phz / 1000, hhz / 10000, hhz % 10, vhz / 10, vhz % 10); 1746f7018c21STomi Valkeinen 1747f7018c21STomi Valkeinen return 0; 1748f7018c21STomi Valkeinen 1749f7018c21STomi Valkeinen cleanup: 1750f7018c21STomi Valkeinen omapfb_free_resources(fbdev, init_state); 1751f7018c21STomi Valkeinen 1752f7018c21STomi Valkeinen return r; 1753f7018c21STomi Valkeinen } 1754f7018c21STomi Valkeinen 1755f7018c21STomi Valkeinen static int omapfb_probe(struct platform_device *pdev) 1756f7018c21STomi Valkeinen { 1757f7018c21STomi Valkeinen int r; 1758f7018c21STomi Valkeinen 1759f7018c21STomi Valkeinen BUG_ON(fbdev_pdev != NULL); 1760f7018c21STomi Valkeinen 1761f7018c21STomi Valkeinen r = platform_device_register(&omapdss_device); 1762f7018c21STomi Valkeinen if (r) { 1763f7018c21STomi Valkeinen dev_err(&pdev->dev, "can't register omapdss device\n"); 1764f7018c21STomi Valkeinen return r; 1765f7018c21STomi Valkeinen } 1766f7018c21STomi Valkeinen 1767f7018c21STomi Valkeinen /* Delay actual initialization until the LCD is registered */ 1768f7018c21STomi Valkeinen fbdev_pdev = pdev; 1769f7018c21STomi Valkeinen if (fbdev_panel != NULL) 1770f7018c21STomi Valkeinen omapfb_do_probe(fbdev_pdev, fbdev_panel); 1771f7018c21STomi Valkeinen return 0; 1772f7018c21STomi Valkeinen } 1773f7018c21STomi Valkeinen 1774f7018c21STomi Valkeinen void omapfb_register_panel(struct lcd_panel *panel) 1775f7018c21STomi Valkeinen { 1776f7018c21STomi Valkeinen BUG_ON(fbdev_panel != NULL); 1777f7018c21STomi Valkeinen 1778f7018c21STomi Valkeinen fbdev_panel = panel; 1779f7018c21STomi Valkeinen if (fbdev_pdev != NULL) 1780f7018c21STomi Valkeinen omapfb_do_probe(fbdev_pdev, fbdev_panel); 1781f7018c21STomi Valkeinen } 178281c44c2bSArnd Bergmann EXPORT_SYMBOL_GPL(omapfb_register_panel); 1783f7018c21STomi Valkeinen 1784f7018c21STomi Valkeinen /* Called when the device is being detached from the driver */ 1785f7018c21STomi Valkeinen static int omapfb_remove(struct platform_device *pdev) 1786f7018c21STomi Valkeinen { 1787f7018c21STomi Valkeinen struct omapfb_device *fbdev = platform_get_drvdata(pdev); 1788f7018c21STomi Valkeinen enum omapfb_state saved_state = fbdev->state; 1789f7018c21STomi Valkeinen 1790f7018c21STomi Valkeinen /* FIXME: wait till completion of pending events */ 1791f7018c21STomi Valkeinen 1792f7018c21STomi Valkeinen fbdev->state = OMAPFB_DISABLED; 1793f7018c21STomi Valkeinen omapfb_free_resources(fbdev, saved_state); 1794f7018c21STomi Valkeinen 1795f7018c21STomi Valkeinen platform_device_unregister(&omapdss_device); 1796f7018c21STomi Valkeinen fbdev->dssdev = NULL; 1797f7018c21STomi Valkeinen 1798f7018c21STomi Valkeinen return 0; 1799f7018c21STomi Valkeinen } 1800f7018c21STomi Valkeinen 1801f7018c21STomi Valkeinen /* PM suspend */ 1802f7018c21STomi Valkeinen static int omapfb_suspend(struct platform_device *pdev, pm_message_t mesg) 1803f7018c21STomi Valkeinen { 1804f7018c21STomi Valkeinen struct omapfb_device *fbdev = platform_get_drvdata(pdev); 1805f7018c21STomi Valkeinen 1806f7018c21STomi Valkeinen if (fbdev != NULL) 1807f7018c21STomi Valkeinen omapfb_blank(FB_BLANK_POWERDOWN, fbdev->fb_info[0]); 1808f7018c21STomi Valkeinen return 0; 1809f7018c21STomi Valkeinen } 1810f7018c21STomi Valkeinen 1811f7018c21STomi Valkeinen /* PM resume */ 1812f7018c21STomi Valkeinen static int omapfb_resume(struct platform_device *pdev) 1813f7018c21STomi Valkeinen { 1814f7018c21STomi Valkeinen struct omapfb_device *fbdev = platform_get_drvdata(pdev); 1815f7018c21STomi Valkeinen 1816f7018c21STomi Valkeinen if (fbdev != NULL) 1817f7018c21STomi Valkeinen omapfb_blank(FB_BLANK_UNBLANK, fbdev->fb_info[0]); 1818f7018c21STomi Valkeinen return 0; 1819f7018c21STomi Valkeinen } 1820f7018c21STomi Valkeinen 1821f7018c21STomi Valkeinen static struct platform_driver omapfb_driver = { 1822f7018c21STomi Valkeinen .probe = omapfb_probe, 1823f7018c21STomi Valkeinen .remove = omapfb_remove, 1824f7018c21STomi Valkeinen .suspend = omapfb_suspend, 1825f7018c21STomi Valkeinen .resume = omapfb_resume, 1826f7018c21STomi Valkeinen .driver = { 1827f7018c21STomi Valkeinen .name = MODULE_NAME, 1828f7018c21STomi Valkeinen }, 1829f7018c21STomi Valkeinen }; 1830f7018c21STomi Valkeinen 1831f7018c21STomi Valkeinen #ifndef MODULE 1832f7018c21STomi Valkeinen 1833f7018c21STomi Valkeinen /* Process kernel command line parameters */ 1834f7018c21STomi Valkeinen static int __init omapfb_setup(char *options) 1835f7018c21STomi Valkeinen { 1836f7018c21STomi Valkeinen char *this_opt = NULL; 1837f7018c21STomi Valkeinen int r = 0; 1838f7018c21STomi Valkeinen 1839f7018c21STomi Valkeinen pr_debug("omapfb: options %s\n", options); 1840f7018c21STomi Valkeinen 1841f7018c21STomi Valkeinen if (!options || !*options) 1842f7018c21STomi Valkeinen return 0; 1843f7018c21STomi Valkeinen 1844f7018c21STomi Valkeinen while (!r && (this_opt = strsep(&options, ",")) != NULL) { 1845f7018c21STomi Valkeinen if (!strncmp(this_opt, "accel", 5)) 1846f7018c21STomi Valkeinen def_accel = 1; 1847f7018c21STomi Valkeinen else if (!strncmp(this_opt, "vram:", 5)) { 1848f7018c21STomi Valkeinen char *suffix; 1849f7018c21STomi Valkeinen unsigned long vram; 1850f7018c21STomi Valkeinen vram = (simple_strtoul(this_opt + 5, &suffix, 0)); 1851f7018c21STomi Valkeinen switch (suffix[0]) { 1852f7018c21STomi Valkeinen case '\0': 1853f7018c21STomi Valkeinen break; 1854f7018c21STomi Valkeinen case 'm': 1855f7018c21STomi Valkeinen case 'M': 1856f7018c21STomi Valkeinen vram *= 1024; 1857f7018c21STomi Valkeinen /* Fall through */ 1858f7018c21STomi Valkeinen case 'k': 1859f7018c21STomi Valkeinen case 'K': 1860f7018c21STomi Valkeinen vram *= 1024; 1861f7018c21STomi Valkeinen break; 1862f7018c21STomi Valkeinen default: 1863f7018c21STomi Valkeinen pr_debug("omapfb: invalid vram suffix %c\n", 1864f7018c21STomi Valkeinen suffix[0]); 1865f7018c21STomi Valkeinen r = -1; 1866f7018c21STomi Valkeinen } 1867f7018c21STomi Valkeinen def_vram[def_vram_cnt++] = vram; 1868f7018c21STomi Valkeinen } 1869f7018c21STomi Valkeinen else if (!strncmp(this_opt, "vxres:", 6)) 1870f7018c21STomi Valkeinen def_vxres = simple_strtoul(this_opt + 6, NULL, 0); 1871f7018c21STomi Valkeinen else if (!strncmp(this_opt, "vyres:", 6)) 1872f7018c21STomi Valkeinen def_vyres = simple_strtoul(this_opt + 6, NULL, 0); 1873f7018c21STomi Valkeinen else if (!strncmp(this_opt, "rotate:", 7)) 1874f7018c21STomi Valkeinen def_rotate = (simple_strtoul(this_opt + 7, NULL, 0)); 1875f7018c21STomi Valkeinen else if (!strncmp(this_opt, "mirror:", 7)) 1876f7018c21STomi Valkeinen def_mirror = (simple_strtoul(this_opt + 7, NULL, 0)); 1877f7018c21STomi Valkeinen else if (!strncmp(this_opt, "manual_update", 13)) 1878f7018c21STomi Valkeinen manual_update = 1; 1879f7018c21STomi Valkeinen else { 1880f7018c21STomi Valkeinen pr_debug("omapfb: invalid option\n"); 1881f7018c21STomi Valkeinen r = -1; 1882f7018c21STomi Valkeinen } 1883f7018c21STomi Valkeinen } 1884f7018c21STomi Valkeinen 1885f7018c21STomi Valkeinen return r; 1886f7018c21STomi Valkeinen } 1887f7018c21STomi Valkeinen 1888f7018c21STomi Valkeinen #endif 1889f7018c21STomi Valkeinen 1890f7018c21STomi Valkeinen /* Register both the driver and the device */ 1891f7018c21STomi Valkeinen static int __init omapfb_init(void) 1892f7018c21STomi Valkeinen { 1893f7018c21STomi Valkeinen #ifndef MODULE 1894f7018c21STomi Valkeinen char *option; 1895f7018c21STomi Valkeinen 1896f7018c21STomi Valkeinen if (fb_get_options("omapfb", &option)) 1897f7018c21STomi Valkeinen return -ENODEV; 1898f7018c21STomi Valkeinen omapfb_setup(option); 1899f7018c21STomi Valkeinen #endif 1900f7018c21STomi Valkeinen /* Register the driver with LDM */ 1901f7018c21STomi Valkeinen if (platform_driver_register(&omapfb_driver)) { 1902f7018c21STomi Valkeinen pr_debug("failed to register omapfb driver\n"); 1903f7018c21STomi Valkeinen return -ENODEV; 1904f7018c21STomi Valkeinen } 1905f7018c21STomi Valkeinen 1906f7018c21STomi Valkeinen return 0; 1907f7018c21STomi Valkeinen } 1908f7018c21STomi Valkeinen 1909f7018c21STomi Valkeinen static void __exit omapfb_cleanup(void) 1910f7018c21STomi Valkeinen { 1911f7018c21STomi Valkeinen platform_driver_unregister(&omapfb_driver); 1912f7018c21STomi Valkeinen } 1913f7018c21STomi Valkeinen 1914f7018c21STomi Valkeinen module_param_named(accel, def_accel, uint, 0664); 1915f7018c21STomi Valkeinen module_param_array_named(vram, def_vram, ulong, &def_vram_cnt, 0664); 1916f7018c21STomi Valkeinen module_param_named(vxres, def_vxres, long, 0664); 1917f7018c21STomi Valkeinen module_param_named(vyres, def_vyres, long, 0664); 1918f7018c21STomi Valkeinen module_param_named(rotate, def_rotate, uint, 0664); 1919f7018c21STomi Valkeinen module_param_named(mirror, def_mirror, uint, 0664); 1920f7018c21STomi Valkeinen module_param_named(manual_update, manual_update, bool, 0664); 1921f7018c21STomi Valkeinen 1922f7018c21STomi Valkeinen module_init(omapfb_init); 1923f7018c21STomi Valkeinen module_exit(omapfb_cleanup); 1924f7018c21STomi Valkeinen 1925f7018c21STomi Valkeinen MODULE_DESCRIPTION("TI OMAP framebuffer driver"); 1926f7018c21STomi Valkeinen MODULE_AUTHOR("Imre Deak <imre.deak@nokia.com>"); 1927f7018c21STomi Valkeinen MODULE_LICENSE("GPL"); 1928