2 * linux/drivers/video/omap2/omapfb-main.c
4 * Copyright (C) 2008 Nokia Corporation
5 * Author: Tomi Valkeinen <tomi.valkeinen@nokia.com>
7 * Some code and ideas taken from drivers/video/omap/ driver
10 * This program is free software; you can redistribute it and/or modify it
11 * under the terms of the GNU General Public License version 2 as published by
12 * the Free Software Foundation.
14 * This program is distributed in the hope that it will be useful, but WITHOUT
15 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
16 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
19 * You should have received a copy of the GNU General Public License along with
20 * this program. If not, see <http://www.gnu.org/licenses/>.
23 #include <linux/module.h>
24 #include <linux/delay.h>
26 #include <linux/dma-mapping.h>
27 #include <linux/vmalloc.h>
28 #include <linux/device.h>
29 #include <linux/platform_device.h>
30 #include <linux/omapfb.h>
32 #include <mach/display.h>
33 #include <mach/vram.h>
34 #include <mach/vrfb.h>
38 #define MODULE_NAME "omapfb"
40 static char *def_mode;
41 static char *def_vram;
43 static int def_rotate;
44 static int def_mirror;
47 unsigned int omapfb_debug;
48 module_param_named(debug, omapfb_debug, bool, 0644);
49 static unsigned int omapfb_test_pattern;
50 module_param_named(test, omapfb_test_pattern, bool, 0644);
54 static void draw_pixel(struct fb_info *fbi, int x, int y, unsigned color)
56 struct fb_var_screeninfo *var = &fbi->var;
57 struct fb_fix_screeninfo *fix = &fbi->fix;
58 void __iomem *addr = fbi->screen_base;
59 const unsigned bytespp = var->bits_per_pixel >> 3;
60 const unsigned line_len = fix->line_length / bytespp;
62 int r = (color >> 16) & 0xff;
63 int g = (color >> 8) & 0xff;
64 int b = (color >> 0) & 0xff;
66 if (var->bits_per_pixel == 16) {
67 u16 __iomem *p = (u16 __iomem *)addr;
68 p += y * line_len + x;
74 __raw_writew((r << 11) | (g << 5) | (b << 0), p);
75 } else if (var->bits_per_pixel == 24) {
76 u8 __iomem *p = (u8 __iomem *)addr;
77 p += (y * line_len + x) * 3;
79 __raw_writeb(b, p + 0);
80 __raw_writeb(g, p + 1);
81 __raw_writeb(r, p + 2);
82 } else if (var->bits_per_pixel == 32) {
83 u32 __iomem *p = (u32 __iomem *)addr;
84 p += y * line_len + x;
85 __raw_writel(color, p);
89 static void fill_fb(struct fb_info *fbi)
91 struct fb_var_screeninfo *var = &fbi->var;
92 const short w = var->xres_virtual;
93 const short h = var->yres_virtual;
94 void __iomem *addr = fbi->screen_base;
100 DBG("fill_fb %dx%d, line_len %d bytes\n", w, h, fbi->fix.line_length);
102 for (y = 0; y < h; y++) {
103 for (x = 0; x < w; x++) {
104 if (x < 20 && y < 20)
105 draw_pixel(fbi, x, y, 0xffffff);
106 else if (x < 20 && (y > 20 && y < h - 20))
107 draw_pixel(fbi, x, y, 0xff);
108 else if (y < 20 && (x > 20 && x < w - 20))
109 draw_pixel(fbi, x, y, 0xff00);
110 else if (x > w - 20 && (y > 20 && y < h - 20))
111 draw_pixel(fbi, x, y, 0xff0000);
112 else if (y > h - 20 && (x > 20 && x < w - 20))
113 draw_pixel(fbi, x, y, 0xffff00);
114 else if (x == 20 || x == w - 20 ||
115 y == 20 || y == h - 20)
116 draw_pixel(fbi, x, y, 0xffffff);
117 else if (x == y || w - x == h - y)
118 draw_pixel(fbi, x, y, 0xff00ff);
119 else if (w - x == y || x == h - y)
120 draw_pixel(fbi, x, y, 0x00ffff);
121 else if (x > 20 && y > 20 && x < w - 20 && y < h - 20) {
123 unsigned r = 0, g = 0, b = 0;
125 if (var->bits_per_pixel == 16) {
127 b = (y % 32) * 256 / 32;
129 g = (y % 64) * 256 / 64;
131 r = (y % 32) * 256 / 32;
140 c = (r << 16) | (g << 8) | (b << 0);
141 draw_pixel(fbi, x, y, c);
143 draw_pixel(fbi, x, y, 0);
150 static unsigned omapfb_get_vrfb_offset(struct omapfb_info *ofbi, int rot)
152 struct vrfb *vrfb = &ofbi->region.vrfb;
160 offset = vrfb->yoffset;
163 offset = vrfb->yoffset * OMAP_VRFB_LINE_LEN + vrfb->xoffset;
166 offset = vrfb->xoffset * OMAP_VRFB_LINE_LEN;
172 offset *= vrfb->bytespp;
177 static u32 omapfb_get_region_rot_paddr(struct omapfb_info *ofbi)
179 if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB) {
180 return ofbi->region.vrfb.paddr[ofbi->rotation]
181 + omapfb_get_vrfb_offset(ofbi, ofbi->rotation);
183 return ofbi->region.paddr;
187 u32 omapfb_get_region_paddr(struct omapfb_info *ofbi)
189 if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB)
190 return ofbi->region.vrfb.paddr[0];
192 return ofbi->region.paddr;
195 void __iomem *omapfb_get_region_vaddr(struct omapfb_info *ofbi)
197 if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB)
198 return ofbi->region.vrfb.vaddr[0];
200 return ofbi->region.vaddr;
203 static struct omapfb_colormode omapfb_colormodes[] = {
205 .dssmode = OMAP_DSS_COLOR_UYVY,
206 .bits_per_pixel = 16,
207 .nonstd = OMAPFB_COLOR_YUV422,
209 .dssmode = OMAP_DSS_COLOR_YUV2,
210 .bits_per_pixel = 16,
211 .nonstd = OMAPFB_COLOR_YUY422,
213 .dssmode = OMAP_DSS_COLOR_ARGB16,
214 .bits_per_pixel = 16,
215 .red = { .length = 4, .offset = 8, .msb_right = 0 },
216 .green = { .length = 4, .offset = 4, .msb_right = 0 },
217 .blue = { .length = 4, .offset = 0, .msb_right = 0 },
218 .transp = { .length = 4, .offset = 12, .msb_right = 0 },
220 .dssmode = OMAP_DSS_COLOR_RGB16,
221 .bits_per_pixel = 16,
222 .red = { .length = 5, .offset = 11, .msb_right = 0 },
223 .green = { .length = 6, .offset = 5, .msb_right = 0 },
224 .blue = { .length = 5, .offset = 0, .msb_right = 0 },
225 .transp = { .length = 0, .offset = 0, .msb_right = 0 },
227 .dssmode = OMAP_DSS_COLOR_RGB24P,
228 .bits_per_pixel = 24,
229 .red = { .length = 8, .offset = 16, .msb_right = 0 },
230 .green = { .length = 8, .offset = 8, .msb_right = 0 },
231 .blue = { .length = 8, .offset = 0, .msb_right = 0 },
232 .transp = { .length = 0, .offset = 0, .msb_right = 0 },
234 .dssmode = OMAP_DSS_COLOR_RGB24U,
235 .bits_per_pixel = 32,
236 .red = { .length = 8, .offset = 16, .msb_right = 0 },
237 .green = { .length = 8, .offset = 8, .msb_right = 0 },
238 .blue = { .length = 8, .offset = 0, .msb_right = 0 },
239 .transp = { .length = 0, .offset = 0, .msb_right = 0 },
241 .dssmode = OMAP_DSS_COLOR_ARGB32,
242 .bits_per_pixel = 32,
243 .red = { .length = 8, .offset = 16, .msb_right = 0 },
244 .green = { .length = 8, .offset = 8, .msb_right = 0 },
245 .blue = { .length = 8, .offset = 0, .msb_right = 0 },
246 .transp = { .length = 8, .offset = 24, .msb_right = 0 },
248 .dssmode = OMAP_DSS_COLOR_RGBA32,
249 .bits_per_pixel = 32,
250 .red = { .length = 8, .offset = 24, .msb_right = 0 },
251 .green = { .length = 8, .offset = 16, .msb_right = 0 },
252 .blue = { .length = 8, .offset = 8, .msb_right = 0 },
253 .transp = { .length = 8, .offset = 0, .msb_right = 0 },
255 .dssmode = OMAP_DSS_COLOR_RGBX32,
256 .bits_per_pixel = 32,
257 .red = { .length = 8, .offset = 24, .msb_right = 0 },
258 .green = { .length = 8, .offset = 16, .msb_right = 0 },
259 .blue = { .length = 8, .offset = 8, .msb_right = 0 },
260 .transp = { .length = 0, .offset = 0, .msb_right = 0 },
264 static bool cmp_var_to_colormode(struct fb_var_screeninfo *var,
265 struct omapfb_colormode *color)
267 bool cmp_component(struct fb_bitfield *f1, struct fb_bitfield *f2)
269 return f1->length == f2->length &&
270 f1->offset == f2->offset &&
271 f1->msb_right == f2->msb_right;
274 if (var->bits_per_pixel == 0 ||
275 var->red.length == 0 ||
276 var->blue.length == 0 ||
277 var->green.length == 0)
280 return var->bits_per_pixel == color->bits_per_pixel &&
281 cmp_component(&var->red, &color->red) &&
282 cmp_component(&var->green, &color->green) &&
283 cmp_component(&var->blue, &color->blue) &&
284 cmp_component(&var->transp, &color->transp);
287 static void assign_colormode_to_var(struct fb_var_screeninfo *var,
288 struct omapfb_colormode *color)
290 var->bits_per_pixel = color->bits_per_pixel;
291 var->nonstd = color->nonstd;
292 var->red = color->red;
293 var->green = color->green;
294 var->blue = color->blue;
295 var->transp = color->transp;
298 static enum omap_color_mode fb_mode_to_dss_mode(struct fb_var_screeninfo *var)
300 enum omap_color_mode dssmode;
303 /* first match with nonstd field */
305 for (i = 0; i < ARRAY_SIZE(omapfb_colormodes); ++i) {
306 struct omapfb_colormode *mode = &omapfb_colormodes[i];
307 if (var->nonstd == mode->nonstd) {
308 assign_colormode_to_var(var, mode);
309 return mode->dssmode;
316 /* then try exact match of bpp and colors */
317 for (i = 0; i < ARRAY_SIZE(omapfb_colormodes); ++i) {
318 struct omapfb_colormode *mode = &omapfb_colormodes[i];
319 if (cmp_var_to_colormode(var, mode)) {
320 assign_colormode_to_var(var, mode);
321 return mode->dssmode;
325 /* match with bpp if user has not filled color fields
327 switch (var->bits_per_pixel) {
329 dssmode = OMAP_DSS_COLOR_CLUT1;
332 dssmode = OMAP_DSS_COLOR_CLUT2;
335 dssmode = OMAP_DSS_COLOR_CLUT4;
338 dssmode = OMAP_DSS_COLOR_CLUT8;
341 dssmode = OMAP_DSS_COLOR_RGB12U;
344 dssmode = OMAP_DSS_COLOR_RGB16;
347 dssmode = OMAP_DSS_COLOR_RGB24P;
350 dssmode = OMAP_DSS_COLOR_RGB24U;
356 for (i = 0; i < ARRAY_SIZE(omapfb_colormodes); ++i) {
357 struct omapfb_colormode *mode = &omapfb_colormodes[i];
358 if (dssmode == mode->dssmode) {
359 assign_colormode_to_var(var, mode);
360 return mode->dssmode;
367 static int dss_mode_to_fb_mode(enum omap_color_mode dssmode,
368 struct fb_var_screeninfo *var)
372 for (i = 0; i < ARRAY_SIZE(omapfb_colormodes); ++i) {
373 struct omapfb_colormode *mode = &omapfb_colormodes[i];
374 if (dssmode == mode->dssmode) {
375 assign_colormode_to_var(var, mode);
382 void set_fb_fix(struct fb_info *fbi)
384 struct fb_fix_screeninfo *fix = &fbi->fix;
385 struct fb_var_screeninfo *var = &fbi->var;
386 struct omapfb_info *ofbi = FB2OFB(fbi);
387 struct omapfb2_mem_region *rg = &ofbi->region;
391 /* used by open/write in fbmem.c */
392 fbi->screen_base = (char __iomem *)omapfb_get_region_vaddr(ofbi);
394 /* used by mmap in fbmem.c */
395 if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB) {
396 switch (var->nonstd) {
397 case OMAPFB_COLOR_YUV422:
398 case OMAPFB_COLOR_YUY422:
400 (OMAP_VRFB_LINE_LEN * var->bits_per_pixel) >> 2;
404 (OMAP_VRFB_LINE_LEN * var->bits_per_pixel) >> 3;
409 (var->xres_virtual * var->bits_per_pixel) >> 3;
410 fix->smem_start = omapfb_get_region_paddr(ofbi);
411 fix->smem_len = rg->size;
413 fix->type = FB_TYPE_PACKED_PIXELS;
416 fix->visual = FB_VISUAL_PSEUDOCOLOR;
418 switch (var->bits_per_pixel) {
423 fix->visual = FB_VISUAL_TRUECOLOR;
424 /* 12bpp is stored in 16 bits */
430 fix->visual = FB_VISUAL_PSEUDOCOLOR;
435 fix->accel = FB_ACCEL_NONE;
440 if (rg->size && ofbi->rotation_type == OMAP_DSS_ROT_VRFB) {
441 enum omap_color_mode mode = 0;
442 mode = fb_mode_to_dss_mode(var);
444 omap_vrfb_setup(&rg->vrfb, rg->paddr,
451 /* check new var and possibly modify it to be ok */
452 int check_fb_var(struct fb_info *fbi, struct fb_var_screeninfo *var)
454 struct omapfb_info *ofbi = FB2OFB(fbi);
455 struct omap_display *display = fb2display(fbi);
456 unsigned long max_frame_size;
457 unsigned long line_size;
458 int xres_min, yres_min;
459 int xres_max, yres_max;
460 enum omap_color_mode mode = 0;
464 DBG("check_fb_var %d\n", ofbi->id);
466 if (ofbi->region.size == 0)
469 mode = fb_mode_to_dss_mode(var);
471 DBG("cannot convert var to omap dss mode\n");
475 for (i = 0; i < ofbi->num_overlays; ++i) {
476 if ((ofbi->overlays[i]->supported_modes & mode) == 0) {
477 DBG("invalid mode\n");
482 if (var->rotate < 0 || var->rotate > 3)
485 if (var->rotate != fbi->var.rotate) {
486 DBG("rotation changing\n");
488 ofbi->rotation = var->rotate;
490 if (abs(var->rotate - fbi->var.rotate) != 2) {
492 DBG("rotate changing 90/270 degrees. "
493 "swapping x/y res\n");
496 var->yres = var->xres;
499 tmp = var->yres_virtual;
500 var->yres_virtual = var->xres_virtual;
501 var->xres_virtual = tmp;
505 xres_min = OMAPFB_PLANE_XRES_MIN;
507 yres_min = OMAPFB_PLANE_YRES_MIN;
510 bytespp = var->bits_per_pixel >> 3;
512 /* XXX: some applications seem to set virtual res to 0. */
513 if (var->xres_virtual == 0)
514 var->xres_virtual = var->xres;
516 if (var->yres_virtual == 0)
517 var->yres_virtual = var->yres;
519 if (var->xres_virtual < xres_min || var->yres_virtual < yres_min)
522 if (var->xres < xres_min)
523 var->xres = xres_min;
524 if (var->yres < yres_min)
525 var->yres = yres_min;
526 if (var->xres > xres_max)
527 var->xres = xres_max;
528 if (var->yres > yres_max)
529 var->yres = yres_max;
531 if (var->xres > var->xres_virtual)
532 var->xres = var->xres_virtual;
533 if (var->yres > var->yres_virtual)
534 var->yres = var->yres_virtual;
536 if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB)
537 line_size = OMAP_VRFB_LINE_LEN * bytespp;
539 line_size = var->xres_virtual * bytespp;
541 max_frame_size = ofbi->region.size;
543 DBG("max frame size %lu, line size %lu\n", max_frame_size, line_size);
545 if (line_size * var->yres_virtual > max_frame_size) {
546 DBG("can't fit FB into memory, reducing y\n");
547 var->yres_virtual = max_frame_size / line_size;
549 if (var->yres_virtual < yres_min)
550 var->yres_virtual = yres_min;
552 if (var->yres > var->yres_virtual)
553 var->yres = var->yres_virtual;
556 if (line_size * var->yres_virtual > max_frame_size) {
557 DBG("can't fit FB into memory, reducing x\n");
558 if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB)
561 var->xres_virtual = max_frame_size / var->yres_virtual /
564 if (var->xres_virtual < xres_min)
565 var->xres_virtual = xres_min;
567 if (var->xres > var->xres_virtual)
568 var->xres = var->xres_virtual;
570 line_size = var->xres_virtual * bytespp;
573 if (line_size * var->yres_virtual > max_frame_size) {
574 DBG("cannot fit FB to memory\n");
578 if (var->xres + var->xoffset > var->xres_virtual)
579 var->xoffset = var->xres_virtual - var->xres;
580 if (var->yres + var->yoffset > var->yres_virtual)
581 var->yoffset = var->yres_virtual - var->yres;
583 DBG("xres = %d, yres = %d, vxres = %d, vyres = %d\n",
584 var->xres, var->yres,
585 var->xres_virtual, var->yres_virtual);
591 if (display && display->get_timings) {
592 struct omap_video_timings timings;
593 display->get_timings(display, &timings);
595 /* pixclock in ps, the rest in pixclock */
596 var->pixclock = timings.pixel_clock != 0 ?
597 KHZ2PICOS(timings.pixel_clock) :
599 var->left_margin = timings.hfp;
600 var->right_margin = timings.hbp;
601 var->upper_margin = timings.vfp;
602 var->lower_margin = timings.vbp;
603 var->hsync_len = timings.hsw;
604 var->vsync_len = timings.vsw;
607 var->left_margin = 0;
608 var->right_margin = 0;
609 var->upper_margin = 0;
610 var->lower_margin = 0;
615 /* TODO: get these from panel->config */
616 var->vmode = FB_VMODE_NONINTERLACED;
623 * ---------------------------------------------------------------------------
624 * fbdev framework callbacks
625 * ---------------------------------------------------------------------------
627 static int omapfb_open(struct fb_info *fbi, int user)
632 static int omapfb_release(struct fb_info *fbi, int user)
634 struct omapfb_info *ofbi = FB2OFB(fbi);
635 struct omapfb2_device *fbdev = ofbi->fbdev;
636 struct omap_display *display = fb2display(fbi);
638 DBG("Closing fb with plane index %d\n", ofbi->id);
642 if (display && display->get_update_mode && display->update) {
643 /* XXX this update should be removed, I think. But it's
644 * good for debugging */
645 if (display->get_update_mode(display) ==
646 OMAP_DSS_UPDATE_MANUAL) {
650 display->sync(display);
652 display->get_resolution(display, &w, &h);
653 display->update(display, 0, 0, w, h);
658 if (display && display->sync)
659 display->sync(display);
661 omapfb_unlock(fbdev);
666 /* setup overlay according to the fb */
667 static int omapfb_setup_overlay(struct fb_info *fbi, struct omap_overlay *ovl,
668 u16 posx, u16 posy, u16 outw, u16 outh)
671 struct omapfb_info *ofbi = FB2OFB(fbi);
672 struct fb_var_screeninfo *var = &fbi->var;
673 struct fb_fix_screeninfo *fix = &fbi->fix;
674 enum omap_color_mode mode = 0;
677 void __iomem *data_start_v;
678 struct omap_overlay_info info;
683 DBG("setup_overlay %d, posx %d, posy %d, outw %d, outh %d\n", ofbi->id,
684 posx, posy, outw, outh);
686 if (ofbi->rotation == FB_ROTATE_CW || ofbi->rotation == FB_ROTATE_CCW) {
694 offset = ((var->yoffset * var->xres_virtual +
695 var->xoffset) * var->bits_per_pixel) >> 3;
697 if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB) {
698 data_start_p = omapfb_get_region_rot_paddr(ofbi);
701 data_start_p = omapfb_get_region_paddr(ofbi);
702 data_start_v = omapfb_get_region_vaddr(ofbi);
705 data_start_p += offset;
706 data_start_v += offset;
708 mode = fb_mode_to_dss_mode(var);
710 if (mode == -EINVAL) {
711 DBG("fb_mode_to_dss_mode failed");
716 switch (var->nonstd) {
717 case OMAPFB_COLOR_YUV422:
718 case OMAPFB_COLOR_YUY422:
719 if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB) {
720 screen_width = fix->line_length
721 / (var->bits_per_pixel >> 2);
725 screen_width = fix->line_length / (var->bits_per_pixel >> 3);
729 ovl->get_overlay_info(ovl, &info);
731 if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB)
734 mirror = ofbi->mirror;
736 info.paddr = data_start_p;
737 info.vaddr = data_start_v;
738 info.screen_width = screen_width;
741 info.color_mode = mode;
742 info.rotation_type = ofbi->rotation_type;
743 info.rotation = ofbi->rotation;
744 info.mirror = mirror;
748 info.out_width = outw;
749 info.out_height = outh;
751 r = ovl->set_overlay_info(ovl, &info);
753 DBG("ovl->setup_overlay_info failed\n");
760 DBG("setup_overlay failed\n");
764 /* apply var to the overlay */
765 int omapfb_apply_changes(struct fb_info *fbi, int init)
768 struct omapfb_info *ofbi = FB2OFB(fbi);
769 struct fb_var_screeninfo *var = &fbi->var;
770 struct omap_overlay *ovl;
776 if (omapfb_test_pattern)
780 for (i = 0; i < ofbi->num_overlays; i++) {
781 ovl = ofbi->overlays[i];
783 DBG("apply_changes, fb %d, ovl %d\n", ofbi->id, ovl->id);
785 if (ofbi->region.size == 0) {
786 /* the fb is not available. disable the overlay */
787 omapfb_overlay_enable(ovl, 0);
788 if (!init && ovl->manager)
789 ovl->manager->apply(ovl->manager);
793 if (init || (ovl->caps & OMAP_DSS_OVL_CAP_SCALE) == 0) {
794 if (ofbi->rotation == FB_ROTATE_CW ||
795 ofbi->rotation == FB_ROTATE_CCW) {
803 outw = ovl->info.out_width;
804 outh = ovl->info.out_height;
811 posx = ovl->info.pos_x;
812 posy = ovl->info.pos_y;
815 r = omapfb_setup_overlay(fbi, ovl, posx, posy, outw, outh);
819 if (!init && ovl->manager)
820 ovl->manager->apply(ovl->manager);
824 DBG("apply_changes failed\n");
828 /* checks var and eventually tweaks it to something supported,
829 * DO NOT MODIFY PAR */
830 static int omapfb_check_var(struct fb_var_screeninfo *var, struct fb_info *fbi)
834 DBG("check_var(%d)\n", FB2OFB(fbi)->id);
836 r = check_fb_var(fbi, var);
841 /* set the video mode according to info->var */
842 static int omapfb_set_par(struct fb_info *fbi)
846 DBG("set_par(%d)\n", FB2OFB(fbi)->id);
849 r = omapfb_apply_changes(fbi, 0);
854 static int omapfb_pan_display(struct fb_var_screeninfo *var,
857 struct omapfb_info *ofbi = FB2OFB(fbi);
858 struct omapfb2_device *fbdev = ofbi->fbdev;
861 DBG("pan_display(%d)\n", ofbi->id);
865 if (var->xoffset != fbi->var.xoffset ||
866 var->yoffset != fbi->var.yoffset) {
867 struct fb_var_screeninfo new_var;
870 new_var.xoffset = var->xoffset;
871 new_var.yoffset = var->yoffset;
873 r = check_fb_var(fbi, &new_var);
878 r = omapfb_apply_changes(fbi, 0);
882 omapfb_unlock(fbdev);
887 static void mmap_user_open(struct vm_area_struct *vma)
889 struct omapfb_info *ofbi = (struct omapfb_info *)vma->vm_private_data;
891 atomic_inc(&ofbi->map_count);
894 static void mmap_user_close(struct vm_area_struct *vma)
896 struct omapfb_info *ofbi = (struct omapfb_info *)vma->vm_private_data;
898 atomic_dec(&ofbi->map_count);
901 static struct vm_operations_struct mmap_user_ops = {
902 .open = mmap_user_open,
903 .close = mmap_user_close,
906 static int omapfb_mmap(struct fb_info *fbi, struct vm_area_struct *vma)
908 struct omapfb_info *ofbi = FB2OFB(fbi);
909 struct fb_fix_screeninfo *fix = &fbi->fix;
914 if (vma->vm_end - vma->vm_start == 0)
916 if (vma->vm_pgoff > (~0UL >> PAGE_SHIFT))
918 off = vma->vm_pgoff << PAGE_SHIFT;
920 start = omapfb_get_region_paddr(ofbi);
924 if ((vma->vm_end - vma->vm_start + off) > len)
929 DBG("user mmap region start %lx, len %d, off %lx\n", start, len, off);
931 vma->vm_pgoff = off >> PAGE_SHIFT;
932 vma->vm_flags |= VM_IO | VM_RESERVED;
933 vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot);
934 vma->vm_ops = &mmap_user_ops;
935 vma->vm_private_data = ofbi;
936 if (io_remap_pfn_range(vma, vma->vm_start, off >> PAGE_SHIFT,
937 vma->vm_end - vma->vm_start, vma->vm_page_prot))
939 /* vm_ops.open won't be called for mmap itself. */
940 atomic_inc(&ofbi->map_count);
944 /* Store a single color palette entry into a pseudo palette or the hardware
945 * palette if one is available. For now we support only 16bpp and thus store
946 * the entry only to the pseudo palette.
948 static int _setcolreg(struct fb_info *fbi, u_int regno, u_int red, u_int green,
949 u_int blue, u_int transp, int update_hw_pal)
951 /*struct omapfb_info *ofbi = FB2OFB(fbi);*/
952 /*struct omapfb2_device *fbdev = ofbi->fbdev;*/
953 struct fb_var_screeninfo *var = &fbi->var;
956 enum omapfb_color_format mode = OMAPFB_COLOR_RGB24U; /* XXX */
958 /*switch (plane->color_mode) {*/
960 case OMAPFB_COLOR_YUV422:
961 case OMAPFB_COLOR_YUV420:
962 case OMAPFB_COLOR_YUY422:
965 case OMAPFB_COLOR_CLUT_8BPP:
966 case OMAPFB_COLOR_CLUT_4BPP:
967 case OMAPFB_COLOR_CLUT_2BPP:
968 case OMAPFB_COLOR_CLUT_1BPP:
970 if (fbdev->ctrl->setcolreg)
971 r = fbdev->ctrl->setcolreg(regno, red, green, blue,
972 transp, update_hw_pal);
977 case OMAPFB_COLOR_RGB565:
978 case OMAPFB_COLOR_RGB444:
979 case OMAPFB_COLOR_RGB24P:
980 case OMAPFB_COLOR_RGB24U:
991 pal = ((red >> (16 - var->red.length)) <<
993 ((green >> (16 - var->green.length)) <<
995 (blue >> (16 - var->blue.length));
996 ((u32 *)(fbi->pseudo_palette))[regno] = pal;
1005 static int omapfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
1006 u_int transp, struct fb_info *info)
1010 return _setcolreg(info, regno, red, green, blue, transp, 1);
1013 static int omapfb_setcmap(struct fb_cmap *cmap, struct fb_info *info)
1015 int count, index, r;
1016 u16 *red, *green, *blue, *transp;
1022 green = cmap->green;
1024 transp = cmap->transp;
1025 index = cmap->start;
1027 for (count = 0; count < cmap->len; count++) {
1030 r = _setcolreg(info, index++, *red++, *green++, *blue++, trans,
1031 count == cmap->len - 1);
1039 static int omapfb_blank(int blank, struct fb_info *fbi)
1041 struct omapfb_info *ofbi = FB2OFB(fbi);
1042 struct omapfb2_device *fbdev = ofbi->fbdev;
1043 struct omap_display *display = fb2display(fbi);
1050 case FB_BLANK_UNBLANK:
1051 if (display->state != OMAP_DSS_DISPLAY_SUSPENDED)
1054 if (display->resume)
1055 r = display->resume(display);
1057 if (r == 0 && display->get_update_mode &&
1058 display->get_update_mode(display) ==
1059 OMAP_DSS_UPDATE_MANUAL)
1064 case FB_BLANK_NORMAL:
1065 /* FB_BLANK_NORMAL could be implemented.
1066 * Needs DSS additions. */
1067 case FB_BLANK_VSYNC_SUSPEND:
1068 case FB_BLANK_HSYNC_SUSPEND:
1069 case FB_BLANK_POWERDOWN:
1070 if (display->state != OMAP_DSS_DISPLAY_ACTIVE)
1073 if (display->suspend)
1074 r = display->suspend(display);
1083 omapfb_unlock(fbdev);
1085 if (r == 0 && do_update && display->update) {
1087 display->get_resolution(display, &w, &h);
1089 r = display->update(display, 0, 0, w, h);
1096 /* XXX fb_read and fb_write are needed for VRFB */
1097 ssize_t omapfb_write(struct fb_info *info, const char __user *buf,
1098 size_t count, loff_t *ppos)
1100 DBG("omapfb_write %d, %lu\n", count, (unsigned long)*ppos);
1101 // XXX needed for VRFB
1106 static struct fb_ops omapfb_ops = {
1107 .owner = THIS_MODULE,
1108 .fb_open = omapfb_open,
1109 .fb_release = omapfb_release,
1110 .fb_fillrect = cfb_fillrect,
1111 .fb_copyarea = cfb_copyarea,
1112 .fb_imageblit = cfb_imageblit,
1113 .fb_blank = omapfb_blank,
1114 .fb_ioctl = omapfb_ioctl,
1115 .fb_check_var = omapfb_check_var,
1116 .fb_set_par = omapfb_set_par,
1117 .fb_pan_display = omapfb_pan_display,
1118 .fb_mmap = omapfb_mmap,
1119 .fb_setcolreg = omapfb_setcolreg,
1120 .fb_setcmap = omapfb_setcmap,
1121 //.fb_write = omapfb_write,
1124 static void omapfb_free_fbmem(struct fb_info *fbi)
1126 struct omapfb_info *ofbi = FB2OFB(fbi);
1127 struct omapfb2_device *fbdev = ofbi->fbdev;
1128 struct omapfb2_mem_region *rg;
1133 if (omap_vram_free(rg->paddr, rg->size))
1134 dev_err(fbdev->dev, "VRAM FREE failed\n");
1139 if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB) {
1140 /* unmap the 0 angle rotation */
1141 if (rg->vrfb.vaddr[0]) {
1142 iounmap(rg->vrfb.vaddr[0]);
1143 omap_vrfb_release_ctx(&rg->vrfb);
1153 static int omapfb_free_all_fbmem(struct omapfb2_device *fbdev)
1157 DBG("free all fbmem\n");
1159 for (i = 0; i < fbdev->num_fbs; i++) {
1160 struct fb_info *fbi = fbdev->fbs[i];
1161 omapfb_free_fbmem(fbi);
1162 memset(&fbi->fix, 0, sizeof(fbi->fix));
1163 memset(&fbi->var, 0, sizeof(fbi->var));
1169 static int omapfb_alloc_fbmem(struct fb_info *fbi, unsigned long size,
1170 unsigned long paddr)
1172 struct omapfb_info *ofbi = FB2OFB(fbi);
1173 struct omapfb2_device *fbdev = ofbi->fbdev;
1174 struct omapfb2_mem_region *rg;
1175 void __iomem *vaddr;
1180 memset(rg, 0, sizeof(*rg));
1182 size = PAGE_ALIGN(size);
1185 DBG("allocating %lu bytes for fb %d\n", size, ofbi->id);
1186 r = omap_vram_alloc(OMAPFB_MEMTYPE_SDRAM, size, &paddr);
1189 DBG("reserving %lu bytes at %lx for fb %d\n", size, paddr,
1191 r = omap_vram_reserve(paddr, size);
1195 dev_err(fbdev->dev, "failed to allocate framebuffer\n");
1199 if (ofbi->rotation_type != OMAP_DSS_ROT_VRFB) {
1200 vaddr = ioremap_wc(paddr, size);
1203 dev_err(fbdev->dev, "failed to ioremap framebuffer\n");
1204 omap_vram_free(paddr, size);
1208 DBG("allocated VRAM paddr %lx, vaddr %p\n", paddr, vaddr);
1211 memset_io(vaddr, 0, size);
1215 r = omap_vrfb_request_ctx(&rg->vrfb);
1217 dev_err(fbdev->dev, "vrfb create ctx failed\n");
1221 /* only ioremap the 0 angle view */
1222 va = ioremap_wc(rg->vrfb.paddr[0], size);
1225 printk(KERN_ERR "vrfb: ioremap failed\n");
1226 omap_vrfb_release_ctx(&rg->vrfb);
1230 DBG("ioremapped vrfb area 0 to %p\n", va);
1232 rg->vrfb.vaddr[0] = va;
1237 memset_io(va, 0, size);
1248 /* allocate fbmem using display resolution as reference */
1249 static int omapfb_alloc_fbmem_display(struct fb_info *fbi, unsigned long size,
1250 unsigned long paddr)
1252 struct omapfb_info *ofbi = FB2OFB(fbi);
1253 struct omap_display *display;
1256 display = fb2display(fbi);
1261 switch (display->get_recommended_bpp(display)) {
1276 display->get_resolution(display, &w, &h);
1278 if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB) {
1280 int oldw = w, oldh = h;
1283 omap_vrfb_adjust_size(&w, &h, bytespp);
1285 /* Because we change the resolution of the 0 degree view,
1286 * we need to alloc max(w, h) for height */
1288 w = OMAP_VRFB_LINE_LEN;
1290 DBG("adjusting fb mem size for VRFB, %dx%d -> %dx%d\n",
1294 size = w * h * bytespp;
1297 return omapfb_alloc_fbmem(fbi, size, paddr);
1300 static enum omap_color_mode fb_format_to_dss_mode(enum omapfb_color_format format)
1302 enum omap_color_mode mode;
1305 case OMAPFB_COLOR_RGB565:
1306 mode = OMAP_DSS_COLOR_RGB16;
1308 case OMAPFB_COLOR_YUV422:
1309 mode = OMAP_DSS_COLOR_YUV2;
1311 case OMAPFB_COLOR_CLUT_8BPP:
1312 mode = OMAP_DSS_COLOR_CLUT8;
1314 case OMAPFB_COLOR_CLUT_4BPP:
1315 mode = OMAP_DSS_COLOR_CLUT4;
1317 case OMAPFB_COLOR_CLUT_2BPP:
1318 mode = OMAP_DSS_COLOR_CLUT2;
1320 case OMAPFB_COLOR_CLUT_1BPP:
1321 mode = OMAP_DSS_COLOR_CLUT1;
1323 case OMAPFB_COLOR_RGB444:
1324 mode = OMAP_DSS_COLOR_RGB12U;
1326 case OMAPFB_COLOR_YUY422:
1327 mode = OMAP_DSS_COLOR_UYVY;
1329 case OMAPFB_COLOR_ARGB16:
1330 mode = OMAP_DSS_COLOR_ARGB16;
1332 case OMAPFB_COLOR_RGB24U:
1333 mode = OMAP_DSS_COLOR_RGB24U;
1335 case OMAPFB_COLOR_RGB24P:
1336 mode = OMAP_DSS_COLOR_RGB24P;
1338 case OMAPFB_COLOR_ARGB32:
1339 mode = OMAP_DSS_COLOR_ARGB32;
1341 case OMAPFB_COLOR_RGBA32:
1342 mode = OMAP_DSS_COLOR_RGBA32;
1344 case OMAPFB_COLOR_RGBX32:
1345 mode = OMAP_DSS_COLOR_RGBX32;
1354 static int omapfb_parse_vram_param(const char *param, int max_entries,
1355 unsigned long *sizes, unsigned long *paddrs)
1359 unsigned long paddr = 0;
1362 start = (char *)param;
1367 fbnum = simple_strtoul(p, &p, 10);
1375 if (fbnum >= max_entries)
1378 size = memparse(p + 1, &p);
1386 paddr = simple_strtoul(p + 1, &p, 16);
1393 paddrs[fbnum] = paddr;
1394 sizes[fbnum] = size;
1410 static int omapfb_allocate_all_fbs(struct omapfb2_device *fbdev)
1413 unsigned long vram_sizes[10];
1414 unsigned long vram_paddrs[10];
1416 memset(&vram_sizes, 0, sizeof(vram_sizes));
1417 memset(&vram_paddrs, 0, sizeof(vram_paddrs));
1419 if (def_vram && omapfb_parse_vram_param(def_vram, 10,
1420 vram_sizes, vram_paddrs)) {
1421 dev_err(fbdev->dev, "failed to parse vram parameter\n");
1423 memset(&vram_sizes, 0, sizeof(vram_sizes));
1424 memset(&vram_paddrs, 0, sizeof(vram_paddrs));
1427 if (fbdev->dev->platform_data) {
1428 struct omapfb_platform_data *opd;
1429 opd = fbdev->dev->platform_data;
1430 for (i = 0; i < opd->mem_desc.region_cnt; ++i) {
1431 if (!vram_sizes[i]) {
1433 unsigned long paddr;
1435 size = opd->mem_desc.region[i].size;
1436 paddr = opd->mem_desc.region[i].paddr;
1438 vram_sizes[i] = size;
1439 vram_paddrs[i] = paddr;
1444 for (i = 0; i < fbdev->num_fbs; i++) {
1445 /* allocate memory automatically only for fb0, or if
1446 * excplicitly defined with vram or plat data option */
1447 if (i == 0 || vram_sizes[i] != 0) {
1448 r = omapfb_alloc_fbmem_display(fbdev->fbs[i],
1449 vram_sizes[i], vram_paddrs[i]);
1456 for (i = 0; i < fbdev->num_fbs; i++) {
1457 struct omapfb_info *ofbi = FB2OFB(fbdev->fbs[i]);
1458 struct omapfb2_mem_region *rg;
1461 DBG("region%d phys %08x virt %p size=%lu\n",
1471 int omapfb_realloc_fbmem(struct fb_info *fbi, unsigned long size, int type)
1473 struct omapfb_info *ofbi = FB2OFB(fbi);
1474 struct omapfb2_device *fbdev = ofbi->fbdev;
1475 struct omap_display *display = fb2display(fbi);
1476 struct omapfb2_mem_region *rg = &ofbi->region;
1477 unsigned long old_size = rg->size;
1478 unsigned long old_paddr = rg->paddr;
1479 int old_type = rg->type;
1482 if (type > OMAPFB_MEMTYPE_MAX)
1485 size = PAGE_ALIGN(size);
1487 if (old_size == size && old_type == type)
1490 if (display && display->sync)
1491 display->sync(display);
1493 omapfb_free_fbmem(fbi);
1496 memset(&fbi->fix, 0, sizeof(fbi->fix));
1497 memset(&fbi->var, 0, sizeof(fbi->var));
1501 r = omapfb_alloc_fbmem(fbi, size, 0);
1505 omapfb_alloc_fbmem(fbi, old_size, old_paddr);
1507 if (rg->size == 0) {
1508 memset(&fbi->fix, 0, sizeof(fbi->fix));
1509 memset(&fbi->var, 0, sizeof(fbi->var));
1515 if (old_size == size)
1518 if (old_size == 0) {
1519 DBG("initializing fb %d\n", ofbi->id);
1520 r = omapfb_fb_init(fbdev, fbi);
1522 DBG("omapfb_fb_init failed\n");
1525 r = omapfb_apply_changes(fbi, 1);
1527 DBG("omapfb_apply_changes failed\n");
1531 struct fb_var_screeninfo new_var;
1532 memcpy(&new_var, &fbi->var, sizeof(new_var));
1533 r = check_fb_var(fbi, &new_var);
1536 memcpy(&fbi->var, &new_var, sizeof(fbi->var));
1542 omapfb_free_fbmem(fbi);
1543 memset(&fbi->fix, 0, sizeof(fbi->fix));
1544 memset(&fbi->var, 0, sizeof(fbi->var));
1548 /* initialize fb_info, var, fix to something sane based on the display */
1549 int omapfb_fb_init(struct omapfb2_device *fbdev, struct fb_info *fbi)
1551 struct fb_var_screeninfo *var = &fbi->var;
1552 struct fb_fix_screeninfo *fix = &fbi->fix;
1553 struct omap_display *display = fb2display(fbi);
1554 struct omapfb_info *ofbi = FB2OFB(fbi);
1557 fbi->fbops = &omapfb_ops;
1558 fbi->flags = FBINFO_FLAG_DEFAULT;
1559 fbi->pseudo_palette = fbdev->pseudo_palette;
1561 strncpy(fix->id, MODULE_NAME, sizeof(fix->id));
1563 if (ofbi->region.size == 0) {
1564 memset(&fbi->fix, 0, sizeof(fbi->fix));
1565 memset(&fbi->var, 0, sizeof(fbi->var));
1570 var->bits_per_pixel = 0;
1572 var->rotate = ofbi->rotation;
1575 * Check if there is a default color format set in the board file,
1576 * and use this format instead the default deducted from the
1579 if (fbdev->dev->platform_data) {
1580 struct omapfb_platform_data *opd;
1583 opd = fbdev->dev->platform_data;
1584 if (opd->mem_desc.region[id].format_used) {
1585 enum omap_color_mode mode;
1586 enum omapfb_color_format format;
1588 format = opd->mem_desc.region[id].format;
1589 mode = fb_format_to_dss_mode(format);
1594 r = dss_mode_to_fb_mode(mode, var);
1602 display->get_resolution(display, &w, &h);
1604 if (ofbi->rotation == FB_ROTATE_CW ||
1605 ofbi->rotation == FB_ROTATE_CCW) {
1613 var->xres_virtual = var->xres;
1614 var->yres_virtual = var->yres;
1616 if (!var->bits_per_pixel) {
1617 switch (display->get_recommended_bpp(display)) {
1619 var->bits_per_pixel = 16;
1622 var->bits_per_pixel = 32;
1625 dev_err(fbdev->dev, "illegal display bpp\n");
1630 /* if there's no display, let's just guess some basic values */
1633 var->xres_virtual = var->xres;
1634 var->yres_virtual = var->yres;
1635 if (!var->bits_per_pixel)
1636 var->bits_per_pixel = 16;
1639 r = check_fb_var(fbi, var);
1645 r = fb_alloc_cmap(&fbi->cmap, 256, 0);
1647 dev_err(fbdev->dev, "unable to allocate color map memory\n");
1653 static void fbinfo_cleanup(struct omapfb2_device *fbdev, struct fb_info *fbi)
1655 fb_dealloc_cmap(&fbi->cmap);
1659 static void omapfb_free_resources(struct omapfb2_device *fbdev)
1663 DBG("free_resources\n");
1668 for (i = 0; i < fbdev->num_fbs; i++)
1669 unregister_framebuffer(fbdev->fbs[i]);
1671 /* free the reserved fbmem */
1672 omapfb_free_all_fbmem(fbdev);
1674 for (i = 0; i < fbdev->num_fbs; i++) {
1675 fbinfo_cleanup(fbdev, fbdev->fbs[i]);
1676 framebuffer_release(fbdev->fbs[i]);
1679 for (i = 0; i < fbdev->num_displays; i++) {
1680 if (fbdev->displays[i]->state != OMAP_DSS_DISPLAY_DISABLED)
1681 fbdev->displays[i]->disable(fbdev->displays[i]);
1683 omap_dss_put_display(fbdev->displays[i]);
1686 dev_set_drvdata(fbdev->dev, NULL);
1690 static int omapfb_create_framebuffers(struct omapfb2_device *fbdev)
1696 DBG("create %d framebuffers\n", CONFIG_FB_OMAP2_NUM_FBS);
1698 /* allocate fb_infos */
1699 for (i = 0; i < CONFIG_FB_OMAP2_NUM_FBS; i++) {
1700 struct fb_info *fbi;
1701 struct omapfb_info *ofbi;
1703 fbi = framebuffer_alloc(sizeof(struct omapfb_info),
1708 "unable to allocate memory for plane info\n");
1712 fbdev->fbs[i] = fbi;
1715 ofbi->fbdev = fbdev;
1718 /* assign these early, so that fb alloc can use them */
1719 ofbi->rotation_type = def_vrfb ? OMAP_DSS_ROT_VRFB :
1721 ofbi->rotation = def_rotate;
1722 ofbi->mirror = def_mirror;
1727 DBG("fb_infos allocated\n");
1729 /* assign overlays for the fbs */
1730 for (i = 0; i < min(fbdev->num_fbs, fbdev->num_overlays); i++) {
1731 struct omapfb_info *ofbi = FB2OFB(fbdev->fbs[i]);
1733 ofbi->overlays[0] = fbdev->overlays[i];
1734 ofbi->num_overlays = 1;
1737 /* allocate fb memories */
1738 r = omapfb_allocate_all_fbs(fbdev);
1740 dev_err(fbdev->dev, "failed to allocate fbmem\n");
1744 DBG("fbmems allocated\n");
1746 /* setup fb_infos */
1747 for (i = 0; i < fbdev->num_fbs; i++) {
1748 r = omapfb_fb_init(fbdev, fbdev->fbs[i]);
1750 dev_err(fbdev->dev, "failed to setup fb_info\n");
1755 DBG("fb_infos initialized\n");
1757 for (i = 0; i < fbdev->num_fbs; i++) {
1758 r = register_framebuffer(fbdev->fbs[i]);
1761 "registering framebuffer %d failed\n", i);
1766 DBG("framebuffers registered\n");
1768 for (i = 0; i < fbdev->num_fbs; i++) {
1769 r = omapfb_apply_changes(fbdev->fbs[i], 1);
1771 dev_err(fbdev->dev, "failed to change mode\n");
1776 DBG("create sysfs for fbs\n");
1777 r = omapfb_create_sysfs(fbdev);
1779 dev_err(fbdev->dev, "failed to create sysfs entries\n");
1784 if (fbdev->num_fbs > 0) {
1785 struct omapfb_info *ofbi = FB2OFB(fbdev->fbs[0]);
1787 if (ofbi->num_overlays > 0 ) {
1788 struct omap_overlay *ovl = ofbi->overlays[0];
1790 r = omapfb_overlay_enable(ovl, 1);
1794 "failed to enable overlay\n");
1800 DBG("create_framebuffers done\n");
1805 int omapfb_mode_to_timings(const char *mode_str,
1806 struct omap_video_timings *timings, u8 *bpp)
1809 struct fb_var_screeninfo var;
1810 struct fb_ops fbops;
1813 #ifdef CONFIG_OMAP2_DSS_VENC
1814 if (strcmp(mode_str, "pal") == 0) {
1815 *timings = omap_dss_pal_timings;
1818 } else if (strcmp(mode_str, "ntsc") == 0) {
1819 *timings = omap_dss_ntsc_timings;
1825 /* this is quite a hack, but I wanted to use the modedb and for
1826 * that we need fb_info and var, so we create dummy ones */
1828 memset(&fbi, 0, sizeof(fbi));
1829 memset(&var, 0, sizeof(var));
1830 memset(&fbops, 0, sizeof(fbops));
1833 r = fb_find_mode(&var, &fbi, mode_str, NULL, 0, NULL, 24);
1836 timings->pixel_clock = PICOS2KHZ(var.pixclock);
1837 timings->hfp = var.left_margin;
1838 timings->hbp = var.right_margin;
1839 timings->vfp = var.upper_margin;
1840 timings->vbp = var.lower_margin;
1841 timings->hsw = var.hsync_len;
1842 timings->vsw = var.vsync_len;
1843 timings->x_res = var.xres;
1844 timings->y_res = var.yres;
1846 switch (var.bits_per_pixel) {
1863 static int omapfb_set_def_mode(struct omap_display *display, char *mode_str)
1867 struct omap_video_timings timings;
1869 r = omapfb_mode_to_timings(mode_str, &timings, &bpp);
1873 display->panel->recommended_bpp = bpp;
1875 if (!display->check_timings || !display->set_timings)
1878 r = display->check_timings(display, &timings);
1882 display->set_timings(display, &timings);
1887 static int omapfb_parse_def_modes(struct omapfb2_device *fbdev)
1889 char *str, *options, *this_opt;
1892 str = kmalloc(strlen(def_mode) + 1, GFP_KERNEL);
1893 strcpy(str, def_mode);
1896 while (!r && (this_opt = strsep(&options, ",")) != NULL) {
1897 char *p, *display_str, *mode_str;
1898 struct omap_display *display;
1901 p = strchr(this_opt, ':');
1908 display_str = this_opt;
1912 for (i = 0; i < fbdev->num_displays; ++i) {
1913 if (strcmp(fbdev->displays[i]->name,
1914 display_str) == 0) {
1915 display = fbdev->displays[i];
1925 r = omapfb_set_def_mode(display, mode_str);
1935 static int omapfb_probe(struct platform_device *pdev)
1937 struct omapfb2_device *fbdev = NULL;
1940 struct omap_overlay *ovl;
1941 struct omap_display *def_display;
1943 DBG("omapfb_probe\n");
1945 if (pdev->num_resources != 0) {
1946 dev_err(&pdev->dev, "probed for an unknown device\n");
1951 fbdev = kzalloc(sizeof(struct omapfb2_device), GFP_KERNEL);
1952 if (fbdev == NULL) {
1957 mutex_init(&fbdev->mtx);
1959 fbdev->dev = &pdev->dev;
1960 platform_set_drvdata(pdev, fbdev);
1962 fbdev->num_displays = 0;
1963 t = omap_dss_get_num_displays();
1964 for (i = 0; i < t; i++) {
1965 struct omap_display *display;
1966 display = omap_dss_get_display(i);
1968 dev_err(&pdev->dev, "can't get display %d\n", i);
1973 fbdev->displays[fbdev->num_displays++] = display;
1976 if (fbdev->num_displays == 0) {
1977 dev_err(&pdev->dev, "no displays\n");
1982 fbdev->num_overlays = omap_dss_get_num_overlays();
1983 for (i = 0; i < fbdev->num_overlays; i++)
1984 fbdev->overlays[i] = omap_dss_get_overlay(i);
1986 fbdev->num_managers = omap_dss_get_num_overlay_managers();
1987 for (i = 0; i < fbdev->num_managers; i++)
1988 fbdev->managers[i] = omap_dss_get_overlay_manager(i);
1991 /* gfx overlay should be the default one. find a display
1992 * connected to that, and use it as default display */
1993 ovl = omap_dss_get_overlay(0);
1994 if (ovl->manager && ovl->manager->display) {
1995 def_display = ovl->manager->display;
1997 dev_err(&pdev->dev, "cannot find default display\n");
2002 if (def_mode && strlen(def_mode) > 0) {
2003 if (omapfb_parse_def_modes(fbdev))
2004 dev_err(&pdev->dev, "cannot parse default modes\n");
2007 r = omapfb_create_framebuffers(fbdev);
2011 for (i = 0; i < fbdev->num_managers; i++) {
2012 struct omap_overlay_manager *mgr;
2013 mgr = fbdev->managers[i];
2014 r = mgr->apply(mgr);
2016 dev_err(fbdev->dev, "failed to apply dispc config\n");
2021 DBG("mgr->apply'ed\n");
2023 r = def_display->enable(def_display);
2025 dev_err(fbdev->dev, "Failed to enable display '%s'\n",
2030 /* set the update mode */
2031 if (def_display->caps & OMAP_DSS_DISPLAY_CAP_MANUAL_UPDATE) {
2032 #ifdef CONFIG_FB_OMAP2_FORCE_AUTO_UPDATE
2033 if (def_display->set_update_mode)
2034 def_display->set_update_mode(def_display,
2035 OMAP_DSS_UPDATE_AUTO);
2036 if (def_display->enable_te)
2037 def_display->enable_te(def_display, 1);
2039 if (def_display->set_update_mode)
2040 def_display->set_update_mode(def_display,
2041 OMAP_DSS_UPDATE_MANUAL);
2042 if (def_display->enable_te)
2043 def_display->enable_te(def_display, 0);
2046 if (def_display->set_update_mode)
2047 def_display->set_update_mode(def_display,
2048 OMAP_DSS_UPDATE_AUTO);
2051 for (i = 0; i < fbdev->num_displays; i++) {
2052 struct omap_display *display = fbdev->displays[i];
2055 if (!display->get_update_mode || !display->update)
2058 if (display->get_update_mode(display) ==
2059 OMAP_DSS_UPDATE_MANUAL) {
2061 display->get_resolution(display, &w, &h);
2062 display->update(display, 0, 0, w, h);
2066 DBG("display->updated\n");
2071 omapfb_free_resources(fbdev);
2073 dev_err(&pdev->dev, "failed to setup omapfb\n");
2077 static int omapfb_remove(struct platform_device *pdev)
2079 struct omapfb2_device *fbdev = platform_get_drvdata(pdev);
2081 /* FIXME: wait till completion of pending events */
2083 omapfb_remove_sysfs(fbdev);
2085 omapfb_free_resources(fbdev);
2090 static struct platform_driver omapfb_driver = {
2091 .probe = omapfb_probe,
2092 .remove = omapfb_remove,
2095 .owner = THIS_MODULE,
2099 static int __init omapfb_init(void)
2101 DBG("omapfb_init\n");
2103 if (platform_driver_register(&omapfb_driver)) {
2104 printk(KERN_ERR "failed to register omapfb driver\n");
2111 static void __exit omapfb_exit(void)
2113 DBG("omapfb_exit\n");
2114 platform_driver_unregister(&omapfb_driver);
2117 module_param_named(mode, def_mode, charp, 0);
2118 module_param_named(vram, def_vram, charp, 0);
2119 module_param_named(rotate, def_rotate, int, 0);
2120 module_param_named(vrfb, def_vrfb, bool, 0);
2121 module_param_named(mirror, def_mirror, bool, 0);
2123 /* late_initcall to let panel/ctrl drivers loaded first.
2124 * I guess better option would be a more dynamic approach,
2125 * so that omapfb reacts to new panels when they are loaded */
2126 late_initcall(omapfb_init);
2127 /*module_init(omapfb_init);*/
2128 module_exit(omapfb_exit);
2130 MODULE_AUTHOR("Tomi Valkeinen <tomi.valkeinen@nokia.com>");
2131 MODULE_DESCRIPTION("OMAP2/3 Framebuffer");
2132 MODULE_LICENSE("GPL v2");