| /* | 
 |  * linux/drivers/video/omap2/omapfb-main.c | 
 |  * | 
 |  * Copyright (C) 2008 Nokia Corporation | 
 |  * Author: Tomi Valkeinen <tomi.valkeinen@nokia.com> | 
 |  * | 
 |  * Some code and ideas taken from drivers/video/omap/ driver | 
 |  * by Imre Deak. | 
 |  * | 
 |  * This program is free software; you can redistribute it and/or modify it | 
 |  * under the terms of the GNU General Public License version 2 as published by | 
 |  * the Free Software Foundation. | 
 |  * | 
 |  * This program is distributed in the hope that it will be useful, but WITHOUT | 
 |  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | 
 |  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for | 
 |  * more details. | 
 |  * | 
 |  * You should have received a copy of the GNU General Public License along with | 
 |  * this program.  If not, see <http://www.gnu.org/licenses/>. | 
 |  */ | 
 |  | 
 | #include <linux/module.h> | 
 | #include <linux/delay.h> | 
 | #include <linux/slab.h> | 
 | #include <linux/fb.h> | 
 | #include <linux/dma-mapping.h> | 
 | #include <linux/vmalloc.h> | 
 | #include <linux/device.h> | 
 | #include <linux/platform_device.h> | 
 | #include <linux/omapfb.h> | 
 |  | 
 | #include <video/omapdss.h> | 
 | #include <plat/vram.h> | 
 | #include <plat/vrfb.h> | 
 |  | 
 | #include "omapfb.h" | 
 |  | 
 | #define MODULE_NAME     "omapfb" | 
 |  | 
 | #define OMAPFB_PLANE_XRES_MIN		8 | 
 | #define OMAPFB_PLANE_YRES_MIN		8 | 
 |  | 
 | static char *def_mode; | 
 | static char *def_vram; | 
 | static bool def_vrfb; | 
 | static int def_rotate; | 
 | static bool def_mirror; | 
 | static bool auto_update; | 
 | static unsigned int auto_update_freq; | 
 | module_param(auto_update, bool, 0); | 
 | module_param(auto_update_freq, uint, 0644); | 
 |  | 
 | #ifdef DEBUG | 
 | bool omapfb_debug; | 
 | module_param_named(debug, omapfb_debug, bool, 0644); | 
 | static bool omapfb_test_pattern; | 
 | module_param_named(test, omapfb_test_pattern, bool, 0644); | 
 | #endif | 
 |  | 
 | static int omapfb_fb_init(struct omapfb2_device *fbdev, struct fb_info *fbi); | 
 | static int omapfb_get_recommended_bpp(struct omapfb2_device *fbdev, | 
 | 		struct omap_dss_device *dssdev); | 
 |  | 
 | #ifdef DEBUG | 
 | static void draw_pixel(struct fb_info *fbi, int x, int y, unsigned color) | 
 | { | 
 | 	struct fb_var_screeninfo *var = &fbi->var; | 
 | 	struct fb_fix_screeninfo *fix = &fbi->fix; | 
 | 	void __iomem *addr = fbi->screen_base; | 
 | 	const unsigned bytespp = var->bits_per_pixel >> 3; | 
 | 	const unsigned line_len = fix->line_length / bytespp; | 
 |  | 
 | 	int r = (color >> 16) & 0xff; | 
 | 	int g = (color >> 8) & 0xff; | 
 | 	int b = (color >> 0) & 0xff; | 
 |  | 
 | 	if (var->bits_per_pixel == 16) { | 
 | 		u16 __iomem *p = (u16 __iomem *)addr; | 
 | 		p += y * line_len + x; | 
 |  | 
 | 		r = r * 32 / 256; | 
 | 		g = g * 64 / 256; | 
 | 		b = b * 32 / 256; | 
 |  | 
 | 		__raw_writew((r << 11) | (g << 5) | (b << 0), p); | 
 | 	} else if (var->bits_per_pixel == 24) { | 
 | 		u8 __iomem *p = (u8 __iomem *)addr; | 
 | 		p += (y * line_len + x) * 3; | 
 |  | 
 | 		__raw_writeb(b, p + 0); | 
 | 		__raw_writeb(g, p + 1); | 
 | 		__raw_writeb(r, p + 2); | 
 | 	} else if (var->bits_per_pixel == 32) { | 
 | 		u32 __iomem *p = (u32 __iomem *)addr; | 
 | 		p += y * line_len + x; | 
 | 		__raw_writel(color, p); | 
 | 	} | 
 | } | 
 |  | 
 | static void fill_fb(struct fb_info *fbi) | 
 | { | 
 | 	struct fb_var_screeninfo *var = &fbi->var; | 
 | 	const short w = var->xres_virtual; | 
 | 	const short h = var->yres_virtual; | 
 | 	void __iomem *addr = fbi->screen_base; | 
 | 	int y, x; | 
 |  | 
 | 	if (!addr) | 
 | 		return; | 
 |  | 
 | 	DBG("fill_fb %dx%d, line_len %d bytes\n", w, h, fbi->fix.line_length); | 
 |  | 
 | 	for (y = 0; y < h; y++) { | 
 | 		for (x = 0; x < w; x++) { | 
 | 			if (x < 20 && y < 20) | 
 | 				draw_pixel(fbi, x, y, 0xffffff); | 
 | 			else if (x < 20 && (y > 20 && y < h - 20)) | 
 | 				draw_pixel(fbi, x, y, 0xff); | 
 | 			else if (y < 20 && (x > 20 && x < w - 20)) | 
 | 				draw_pixel(fbi, x, y, 0xff00); | 
 | 			else if (x > w - 20 && (y > 20 && y < h - 20)) | 
 | 				draw_pixel(fbi, x, y, 0xff0000); | 
 | 			else if (y > h - 20 && (x > 20 && x < w - 20)) | 
 | 				draw_pixel(fbi, x, y, 0xffff00); | 
 | 			else if (x == 20 || x == w - 20 || | 
 | 					y == 20 || y == h - 20) | 
 | 				draw_pixel(fbi, x, y, 0xffffff); | 
 | 			else if (x == y || w - x == h - y) | 
 | 				draw_pixel(fbi, x, y, 0xff00ff); | 
 | 			else if (w - x == y || x == h - y) | 
 | 				draw_pixel(fbi, x, y, 0x00ffff); | 
 | 			else if (x > 20 && y > 20 && x < w - 20 && y < h - 20) { | 
 | 				int t = x * 3 / w; | 
 | 				unsigned r = 0, g = 0, b = 0; | 
 | 				unsigned c; | 
 | 				if (var->bits_per_pixel == 16) { | 
 | 					if (t == 0) | 
 | 						b = (y % 32) * 256 / 32; | 
 | 					else if (t == 1) | 
 | 						g = (y % 64) * 256 / 64; | 
 | 					else if (t == 2) | 
 | 						r = (y % 32) * 256 / 32; | 
 | 				} else { | 
 | 					if (t == 0) | 
 | 						b = (y % 256); | 
 | 					else if (t == 1) | 
 | 						g = (y % 256); | 
 | 					else if (t == 2) | 
 | 						r = (y % 256); | 
 | 				} | 
 | 				c = (r << 16) | (g << 8) | (b << 0); | 
 | 				draw_pixel(fbi, x, y, c); | 
 | 			} else { | 
 | 				draw_pixel(fbi, x, y, 0); | 
 | 			} | 
 | 		} | 
 | 	} | 
 | } | 
 | #endif | 
 |  | 
 | static unsigned omapfb_get_vrfb_offset(const struct omapfb_info *ofbi, int rot) | 
 | { | 
 | 	const struct vrfb *vrfb = &ofbi->region->vrfb; | 
 | 	unsigned offset; | 
 |  | 
 | 	switch (rot) { | 
 | 	case FB_ROTATE_UR: | 
 | 		offset = 0; | 
 | 		break; | 
 | 	case FB_ROTATE_CW: | 
 | 		offset = vrfb->yoffset; | 
 | 		break; | 
 | 	case FB_ROTATE_UD: | 
 | 		offset = vrfb->yoffset * OMAP_VRFB_LINE_LEN + vrfb->xoffset; | 
 | 		break; | 
 | 	case FB_ROTATE_CCW: | 
 | 		offset = vrfb->xoffset * OMAP_VRFB_LINE_LEN; | 
 | 		break; | 
 | 	default: | 
 | 		BUG(); | 
 | 		return 0; | 
 | 	} | 
 |  | 
 | 	offset *= vrfb->bytespp; | 
 |  | 
 | 	return offset; | 
 | } | 
 |  | 
 | static u32 omapfb_get_region_rot_paddr(const struct omapfb_info *ofbi, int rot) | 
 | { | 
 | 	if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB) { | 
 | 		return ofbi->region->vrfb.paddr[rot] | 
 | 			+ omapfb_get_vrfb_offset(ofbi, rot); | 
 | 	} else { | 
 | 		return ofbi->region->paddr; | 
 | 	} | 
 | } | 
 |  | 
 | static u32 omapfb_get_region_paddr(const struct omapfb_info *ofbi) | 
 | { | 
 | 	if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB) | 
 | 		return ofbi->region->vrfb.paddr[0]; | 
 | 	else | 
 | 		return ofbi->region->paddr; | 
 | } | 
 |  | 
 | static void __iomem *omapfb_get_region_vaddr(const struct omapfb_info *ofbi) | 
 | { | 
 | 	if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB) | 
 | 		return ofbi->region->vrfb.vaddr[0]; | 
 | 	else | 
 | 		return ofbi->region->vaddr; | 
 | } | 
 |  | 
 | static struct omapfb_colormode omapfb_colormodes[] = { | 
 | 	{ | 
 | 		.dssmode = OMAP_DSS_COLOR_UYVY, | 
 | 		.bits_per_pixel = 16, | 
 | 		.nonstd = OMAPFB_COLOR_YUV422, | 
 | 	}, { | 
 | 		.dssmode = OMAP_DSS_COLOR_YUV2, | 
 | 		.bits_per_pixel = 16, | 
 | 		.nonstd = OMAPFB_COLOR_YUY422, | 
 | 	}, { | 
 | 		.dssmode = OMAP_DSS_COLOR_ARGB16, | 
 | 		.bits_per_pixel = 16, | 
 | 		.red	= { .length = 4, .offset = 8, .msb_right = 0 }, | 
 | 		.green	= { .length = 4, .offset = 4, .msb_right = 0 }, | 
 | 		.blue	= { .length = 4, .offset = 0, .msb_right = 0 }, | 
 | 		.transp	= { .length = 4, .offset = 12, .msb_right = 0 }, | 
 | 	}, { | 
 | 		.dssmode = OMAP_DSS_COLOR_RGB16, | 
 | 		.bits_per_pixel = 16, | 
 | 		.red	= { .length = 5, .offset = 11, .msb_right = 0 }, | 
 | 		.green	= { .length = 6, .offset = 5, .msb_right = 0 }, | 
 | 		.blue	= { .length = 5, .offset = 0, .msb_right = 0 }, | 
 | 		.transp	= { .length = 0, .offset = 0, .msb_right = 0 }, | 
 | 	}, { | 
 | 		.dssmode = OMAP_DSS_COLOR_RGB24P, | 
 | 		.bits_per_pixel = 24, | 
 | 		.red	= { .length = 8, .offset = 16, .msb_right = 0 }, | 
 | 		.green	= { .length = 8, .offset = 8, .msb_right = 0 }, | 
 | 		.blue	= { .length = 8, .offset = 0, .msb_right = 0 }, | 
 | 		.transp	= { .length = 0, .offset = 0, .msb_right = 0 }, | 
 | 	}, { | 
 | 		.dssmode = OMAP_DSS_COLOR_RGB24U, | 
 | 		.bits_per_pixel = 32, | 
 | 		.red	= { .length = 8, .offset = 16, .msb_right = 0 }, | 
 | 		.green	= { .length = 8, .offset = 8, .msb_right = 0 }, | 
 | 		.blue	= { .length = 8, .offset = 0, .msb_right = 0 }, | 
 | 		.transp	= { .length = 0, .offset = 0, .msb_right = 0 }, | 
 | 	}, { | 
 | 		.dssmode = OMAP_DSS_COLOR_ARGB32, | 
 | 		.bits_per_pixel = 32, | 
 | 		.red	= { .length = 8, .offset = 16, .msb_right = 0 }, | 
 | 		.green	= { .length = 8, .offset = 8, .msb_right = 0 }, | 
 | 		.blue	= { .length = 8, .offset = 0, .msb_right = 0 }, | 
 | 		.transp	= { .length = 8, .offset = 24, .msb_right = 0 }, | 
 | 	}, { | 
 | 		.dssmode = OMAP_DSS_COLOR_RGBA32, | 
 | 		.bits_per_pixel = 32, | 
 | 		.red	= { .length = 8, .offset = 24, .msb_right = 0 }, | 
 | 		.green	= { .length = 8, .offset = 16, .msb_right = 0 }, | 
 | 		.blue	= { .length = 8, .offset = 8, .msb_right = 0 }, | 
 | 		.transp	= { .length = 8, .offset = 0, .msb_right = 0 }, | 
 | 	}, { | 
 | 		.dssmode = OMAP_DSS_COLOR_RGBX32, | 
 | 		.bits_per_pixel = 32, | 
 | 		.red	= { .length = 8, .offset = 24, .msb_right = 0 }, | 
 | 		.green	= { .length = 8, .offset = 16, .msb_right = 0 }, | 
 | 		.blue	= { .length = 8, .offset = 8, .msb_right = 0 }, | 
 | 		.transp	= { .length = 0, .offset = 0, .msb_right = 0 }, | 
 | 	}, | 
 | }; | 
 |  | 
 | static bool cmp_var_to_colormode(struct fb_var_screeninfo *var, | 
 | 		struct omapfb_colormode *color) | 
 | { | 
 | 	bool cmp_component(struct fb_bitfield *f1, struct fb_bitfield *f2) | 
 | 	{ | 
 | 		return f1->length == f2->length && | 
 | 			f1->offset == f2->offset && | 
 | 			f1->msb_right == f2->msb_right; | 
 | 	} | 
 |  | 
 | 	if (var->bits_per_pixel == 0 || | 
 | 			var->red.length == 0 || | 
 | 			var->blue.length == 0 || | 
 | 			var->green.length == 0) | 
 | 		return 0; | 
 |  | 
 | 	return var->bits_per_pixel == color->bits_per_pixel && | 
 | 		cmp_component(&var->red, &color->red) && | 
 | 		cmp_component(&var->green, &color->green) && | 
 | 		cmp_component(&var->blue, &color->blue) && | 
 | 		cmp_component(&var->transp, &color->transp); | 
 | } | 
 |  | 
 | static void assign_colormode_to_var(struct fb_var_screeninfo *var, | 
 | 		struct omapfb_colormode *color) | 
 | { | 
 | 	var->bits_per_pixel = color->bits_per_pixel; | 
 | 	var->nonstd = color->nonstd; | 
 | 	var->red = color->red; | 
 | 	var->green = color->green; | 
 | 	var->blue = color->blue; | 
 | 	var->transp = color->transp; | 
 | } | 
 |  | 
 | static int fb_mode_to_dss_mode(struct fb_var_screeninfo *var, | 
 | 		enum omap_color_mode *mode) | 
 | { | 
 | 	enum omap_color_mode dssmode; | 
 | 	int i; | 
 |  | 
 | 	/* first match with nonstd field */ | 
 | 	if (var->nonstd) { | 
 | 		for (i = 0; i < ARRAY_SIZE(omapfb_colormodes); ++i) { | 
 | 			struct omapfb_colormode *m = &omapfb_colormodes[i]; | 
 | 			if (var->nonstd == m->nonstd) { | 
 | 				assign_colormode_to_var(var, m); | 
 | 				*mode = m->dssmode; | 
 | 				return 0; | 
 | 			} | 
 | 		} | 
 |  | 
 | 		return -EINVAL; | 
 | 	} | 
 |  | 
 | 	/* then try exact match of bpp and colors */ | 
 | 	for (i = 0; i < ARRAY_SIZE(omapfb_colormodes); ++i) { | 
 | 		struct omapfb_colormode *m = &omapfb_colormodes[i]; | 
 | 		if (cmp_var_to_colormode(var, m)) { | 
 | 			assign_colormode_to_var(var, m); | 
 | 			*mode = m->dssmode; | 
 | 			return 0; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	/* match with bpp if user has not filled color fields | 
 | 	 * properly */ | 
 | 	switch (var->bits_per_pixel) { | 
 | 	case 1: | 
 | 		dssmode = OMAP_DSS_COLOR_CLUT1; | 
 | 		break; | 
 | 	case 2: | 
 | 		dssmode = OMAP_DSS_COLOR_CLUT2; | 
 | 		break; | 
 | 	case 4: | 
 | 		dssmode = OMAP_DSS_COLOR_CLUT4; | 
 | 		break; | 
 | 	case 8: | 
 | 		dssmode = OMAP_DSS_COLOR_CLUT8; | 
 | 		break; | 
 | 	case 12: | 
 | 		dssmode = OMAP_DSS_COLOR_RGB12U; | 
 | 		break; | 
 | 	case 16: | 
 | 		dssmode = OMAP_DSS_COLOR_RGB16; | 
 | 		break; | 
 | 	case 24: | 
 | 		dssmode = OMAP_DSS_COLOR_RGB24P; | 
 | 		break; | 
 | 	case 32: | 
 | 		dssmode = OMAP_DSS_COLOR_RGB24U; | 
 | 		break; | 
 | 	default: | 
 | 		return -EINVAL; | 
 | 	} | 
 |  | 
 | 	for (i = 0; i < ARRAY_SIZE(omapfb_colormodes); ++i) { | 
 | 		struct omapfb_colormode *m = &omapfb_colormodes[i]; | 
 | 		if (dssmode == m->dssmode) { | 
 | 			assign_colormode_to_var(var, m); | 
 | 			*mode = m->dssmode; | 
 | 			return 0; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	return -EINVAL; | 
 | } | 
 |  | 
 | static int check_fb_res_bounds(struct fb_var_screeninfo *var) | 
 | { | 
 | 	int xres_min = OMAPFB_PLANE_XRES_MIN; | 
 | 	int xres_max = 2048; | 
 | 	int yres_min = OMAPFB_PLANE_YRES_MIN; | 
 | 	int yres_max = 2048; | 
 |  | 
 | 	/* XXX: some applications seem to set virtual res to 0. */ | 
 | 	if (var->xres_virtual == 0) | 
 | 		var->xres_virtual = var->xres; | 
 |  | 
 | 	if (var->yres_virtual == 0) | 
 | 		var->yres_virtual = var->yres; | 
 |  | 
 | 	if (var->xres_virtual < xres_min || var->yres_virtual < yres_min) | 
 | 		return -EINVAL; | 
 |  | 
 | 	if (var->xres < xres_min) | 
 | 		var->xres = xres_min; | 
 | 	if (var->yres < yres_min) | 
 | 		var->yres = yres_min; | 
 | 	if (var->xres > xres_max) | 
 | 		var->xres = xres_max; | 
 | 	if (var->yres > yres_max) | 
 | 		var->yres = yres_max; | 
 |  | 
 | 	if (var->xres > var->xres_virtual) | 
 | 		var->xres = var->xres_virtual; | 
 | 	if (var->yres > var->yres_virtual) | 
 | 		var->yres = var->yres_virtual; | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static void shrink_height(unsigned long max_frame_size, | 
 | 		struct fb_var_screeninfo *var) | 
 | { | 
 | 	DBG("can't fit FB into memory, reducing y\n"); | 
 | 	var->yres_virtual = max_frame_size / | 
 | 		(var->xres_virtual * var->bits_per_pixel >> 3); | 
 |  | 
 | 	if (var->yres_virtual < OMAPFB_PLANE_YRES_MIN) | 
 | 		var->yres_virtual = OMAPFB_PLANE_YRES_MIN; | 
 |  | 
 | 	if (var->yres > var->yres_virtual) | 
 | 		var->yres = var->yres_virtual; | 
 | } | 
 |  | 
 | static void shrink_width(unsigned long max_frame_size, | 
 | 		struct fb_var_screeninfo *var) | 
 | { | 
 | 	DBG("can't fit FB into memory, reducing x\n"); | 
 | 	var->xres_virtual = max_frame_size / var->yres_virtual / | 
 | 		(var->bits_per_pixel >> 3); | 
 |  | 
 | 	if (var->xres_virtual < OMAPFB_PLANE_XRES_MIN) | 
 | 		var->xres_virtual = OMAPFB_PLANE_XRES_MIN; | 
 |  | 
 | 	if (var->xres > var->xres_virtual) | 
 | 		var->xres = var->xres_virtual; | 
 | } | 
 |  | 
 | static int check_vrfb_fb_size(unsigned long region_size, | 
 | 		const struct fb_var_screeninfo *var) | 
 | { | 
 | 	unsigned long min_phys_size = omap_vrfb_min_phys_size(var->xres_virtual, | 
 | 		var->yres_virtual, var->bits_per_pixel >> 3); | 
 |  | 
 | 	return min_phys_size > region_size ? -EINVAL : 0; | 
 | } | 
 |  | 
 | static int check_fb_size(const struct omapfb_info *ofbi, | 
 | 		struct fb_var_screeninfo *var) | 
 | { | 
 | 	unsigned long max_frame_size = ofbi->region->size; | 
 | 	int bytespp = var->bits_per_pixel >> 3; | 
 | 	unsigned long line_size = var->xres_virtual * bytespp; | 
 |  | 
 | 	if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB) { | 
 | 		/* One needs to check for both VRFB and OMAPFB limitations. */ | 
 | 		if (check_vrfb_fb_size(max_frame_size, var)) | 
 | 			shrink_height(omap_vrfb_max_height( | 
 | 				max_frame_size, var->xres_virtual, bytespp) * | 
 | 				line_size, var); | 
 |  | 
 | 		if (check_vrfb_fb_size(max_frame_size, var)) { | 
 | 			DBG("cannot fit FB to memory\n"); | 
 | 			return -EINVAL; | 
 | 		} | 
 |  | 
 | 		return 0; | 
 | 	} | 
 |  | 
 | 	DBG("max frame size %lu, line size %lu\n", max_frame_size, line_size); | 
 |  | 
 | 	if (line_size * var->yres_virtual > max_frame_size) | 
 | 		shrink_height(max_frame_size, var); | 
 |  | 
 | 	if (line_size * var->yres_virtual > max_frame_size) { | 
 | 		shrink_width(max_frame_size, var); | 
 | 		line_size = var->xres_virtual * bytespp; | 
 | 	} | 
 |  | 
 | 	if (line_size * var->yres_virtual > max_frame_size) { | 
 | 		DBG("cannot fit FB to memory\n"); | 
 | 		return -EINVAL; | 
 | 	} | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | /* | 
 |  * Consider if VRFB assisted rotation is in use and if the virtual space for | 
 |  * the zero degree view needs to be mapped. The need for mapping also acts as | 
 |  * the trigger for setting up the hardware on the context in question. This | 
 |  * ensures that one does not attempt to access the virtual view before the | 
 |  * hardware is serving the address translations. | 
 |  */ | 
 | static int setup_vrfb_rotation(struct fb_info *fbi) | 
 | { | 
 | 	struct omapfb_info *ofbi = FB2OFB(fbi); | 
 | 	struct omapfb2_mem_region *rg = ofbi->region; | 
 | 	struct vrfb *vrfb = &rg->vrfb; | 
 | 	struct fb_var_screeninfo *var = &fbi->var; | 
 | 	struct fb_fix_screeninfo *fix = &fbi->fix; | 
 | 	unsigned bytespp; | 
 | 	bool yuv_mode; | 
 | 	enum omap_color_mode mode; | 
 | 	int r; | 
 | 	bool reconf; | 
 |  | 
 | 	if (!rg->size || ofbi->rotation_type != OMAP_DSS_ROT_VRFB) | 
 | 		return 0; | 
 |  | 
 | 	DBG("setup_vrfb_rotation\n"); | 
 |  | 
 | 	r = fb_mode_to_dss_mode(var, &mode); | 
 | 	if (r) | 
 | 		return r; | 
 |  | 
 | 	bytespp = var->bits_per_pixel >> 3; | 
 |  | 
 | 	yuv_mode = mode == OMAP_DSS_COLOR_YUV2 || mode == OMAP_DSS_COLOR_UYVY; | 
 |  | 
 | 	/* We need to reconfigure VRFB if the resolution changes, if yuv mode | 
 | 	 * is enabled/disabled, or if bytes per pixel changes */ | 
 |  | 
 | 	/* XXX we shouldn't allow this when framebuffer is mmapped */ | 
 |  | 
 | 	reconf = false; | 
 |  | 
 | 	if (yuv_mode != vrfb->yuv_mode) | 
 | 		reconf = true; | 
 | 	else if (bytespp != vrfb->bytespp) | 
 | 		reconf = true; | 
 | 	else if (vrfb->xres != var->xres_virtual || | 
 | 			vrfb->yres != var->yres_virtual) | 
 | 		reconf = true; | 
 |  | 
 | 	if (vrfb->vaddr[0] && reconf) { | 
 | 		fbi->screen_base = NULL; | 
 | 		fix->smem_start = 0; | 
 | 		fix->smem_len = 0; | 
 | 		iounmap(vrfb->vaddr[0]); | 
 | 		vrfb->vaddr[0] = NULL; | 
 | 		DBG("setup_vrfb_rotation: reset fb\n"); | 
 | 	} | 
 |  | 
 | 	if (vrfb->vaddr[0]) | 
 | 		return 0; | 
 |  | 
 | 	omap_vrfb_setup(&rg->vrfb, rg->paddr, | 
 | 			var->xres_virtual, | 
 | 			var->yres_virtual, | 
 | 			bytespp, yuv_mode); | 
 |  | 
 | 	/* Now one can ioremap the 0 angle view */ | 
 | 	r = omap_vrfb_map_angle(vrfb, var->yres_virtual, 0); | 
 | 	if (r) | 
 | 		return r; | 
 |  | 
 | 	/* used by open/write in fbmem.c */ | 
 | 	fbi->screen_base = ofbi->region->vrfb.vaddr[0]; | 
 |  | 
 | 	fix->smem_start = ofbi->region->vrfb.paddr[0]; | 
 |  | 
 | 	switch (var->nonstd) { | 
 | 	case OMAPFB_COLOR_YUV422: | 
 | 	case OMAPFB_COLOR_YUY422: | 
 | 		fix->line_length = | 
 | 			(OMAP_VRFB_LINE_LEN * var->bits_per_pixel) >> 2; | 
 | 		break; | 
 | 	default: | 
 | 		fix->line_length = | 
 | 			(OMAP_VRFB_LINE_LEN * var->bits_per_pixel) >> 3; | 
 | 		break; | 
 | 	} | 
 |  | 
 | 	fix->smem_len = var->yres_virtual * fix->line_length; | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | int dss_mode_to_fb_mode(enum omap_color_mode dssmode, | 
 | 			struct fb_var_screeninfo *var) | 
 | { | 
 | 	int i; | 
 |  | 
 | 	for (i = 0; i < ARRAY_SIZE(omapfb_colormodes); ++i) { | 
 | 		struct omapfb_colormode *mode = &omapfb_colormodes[i]; | 
 | 		if (dssmode == mode->dssmode) { | 
 | 			assign_colormode_to_var(var, mode); | 
 | 			return 0; | 
 | 		} | 
 | 	} | 
 | 	return -ENOENT; | 
 | } | 
 |  | 
 | void set_fb_fix(struct fb_info *fbi) | 
 | { | 
 | 	struct fb_fix_screeninfo *fix = &fbi->fix; | 
 | 	struct fb_var_screeninfo *var = &fbi->var; | 
 | 	struct omapfb_info *ofbi = FB2OFB(fbi); | 
 | 	struct omapfb2_mem_region *rg = ofbi->region; | 
 |  | 
 | 	DBG("set_fb_fix\n"); | 
 |  | 
 | 	/* used by open/write in fbmem.c */ | 
 | 	fbi->screen_base = (char __iomem *)omapfb_get_region_vaddr(ofbi); | 
 |  | 
 | 	/* used by mmap in fbmem.c */ | 
 | 	if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB) { | 
 | 		switch (var->nonstd) { | 
 | 		case OMAPFB_COLOR_YUV422: | 
 | 		case OMAPFB_COLOR_YUY422: | 
 | 			fix->line_length = | 
 | 				(OMAP_VRFB_LINE_LEN * var->bits_per_pixel) >> 2; | 
 | 			break; | 
 | 		default: | 
 | 			fix->line_length = | 
 | 				(OMAP_VRFB_LINE_LEN * var->bits_per_pixel) >> 3; | 
 | 			break; | 
 | 		} | 
 |  | 
 | 		fix->smem_len = var->yres_virtual * fix->line_length; | 
 | 	} else { | 
 | 		fix->line_length = | 
 | 			(var->xres_virtual * var->bits_per_pixel) >> 3; | 
 | 		fix->smem_len = rg->size; | 
 | 	} | 
 |  | 
 | 	fix->smem_start = omapfb_get_region_paddr(ofbi); | 
 |  | 
 | 	fix->type = FB_TYPE_PACKED_PIXELS; | 
 |  | 
 | 	if (var->nonstd) | 
 | 		fix->visual = FB_VISUAL_PSEUDOCOLOR; | 
 | 	else { | 
 | 		switch (var->bits_per_pixel) { | 
 | 		case 32: | 
 | 		case 24: | 
 | 		case 16: | 
 | 		case 12: | 
 | 			fix->visual = FB_VISUAL_TRUECOLOR; | 
 | 			/* 12bpp is stored in 16 bits */ | 
 | 			break; | 
 | 		case 1: | 
 | 		case 2: | 
 | 		case 4: | 
 | 		case 8: | 
 | 			fix->visual = FB_VISUAL_PSEUDOCOLOR; | 
 | 			break; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	fix->accel = FB_ACCEL_NONE; | 
 |  | 
 | 	fix->xpanstep = 1; | 
 | 	fix->ypanstep = 1; | 
 | } | 
 |  | 
 | /* check new var and possibly modify it to be ok */ | 
 | int check_fb_var(struct fb_info *fbi, struct fb_var_screeninfo *var) | 
 | { | 
 | 	struct omapfb_info *ofbi = FB2OFB(fbi); | 
 | 	struct omap_dss_device *display = fb2display(fbi); | 
 | 	enum omap_color_mode mode = 0; | 
 | 	int i; | 
 | 	int r; | 
 |  | 
 | 	DBG("check_fb_var %d\n", ofbi->id); | 
 |  | 
 | 	WARN_ON(!atomic_read(&ofbi->region->lock_count)); | 
 |  | 
 | 	r = fb_mode_to_dss_mode(var, &mode); | 
 | 	if (r) { | 
 | 		DBG("cannot convert var to omap dss mode\n"); | 
 | 		return r; | 
 | 	} | 
 |  | 
 | 	for (i = 0; i < ofbi->num_overlays; ++i) { | 
 | 		if ((ofbi->overlays[i]->supported_modes & mode) == 0) { | 
 | 			DBG("invalid mode\n"); | 
 | 			return -EINVAL; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	if (var->rotate > 3) | 
 | 		return -EINVAL; | 
 |  | 
 | 	if (check_fb_res_bounds(var)) | 
 | 		return -EINVAL; | 
 |  | 
 | 	/* When no memory is allocated ignore the size check */ | 
 | 	if (ofbi->region->size != 0 && check_fb_size(ofbi, var)) | 
 | 		return -EINVAL; | 
 |  | 
 | 	if (var->xres + var->xoffset > var->xres_virtual) | 
 | 		var->xoffset = var->xres_virtual - var->xres; | 
 | 	if (var->yres + var->yoffset > var->yres_virtual) | 
 | 		var->yoffset = var->yres_virtual - var->yres; | 
 |  | 
 | 	DBG("xres = %d, yres = %d, vxres = %d, vyres = %d\n", | 
 | 			var->xres, var->yres, | 
 | 			var->xres_virtual, var->yres_virtual); | 
 |  | 
 | 	if (display && display->driver->get_dimensions) { | 
 | 		u32 w, h; | 
 | 		display->driver->get_dimensions(display, &w, &h); | 
 | 		var->width = DIV_ROUND_CLOSEST(w, 1000); | 
 | 		var->height = DIV_ROUND_CLOSEST(h, 1000); | 
 | 	} else { | 
 | 		var->height = -1; | 
 | 		var->width = -1; | 
 | 	} | 
 |  | 
 | 	var->grayscale          = 0; | 
 |  | 
 | 	if (display && display->driver->get_timings) { | 
 | 		struct omap_video_timings timings; | 
 | 		display->driver->get_timings(display, &timings); | 
 |  | 
 | 		/* pixclock in ps, the rest in pixclock */ | 
 | 		var->pixclock = timings.pixel_clock != 0 ? | 
 | 			KHZ2PICOS(timings.pixel_clock) : | 
 | 			0; | 
 | 		var->left_margin = timings.hbp; | 
 | 		var->right_margin = timings.hfp; | 
 | 		var->upper_margin = timings.vbp; | 
 | 		var->lower_margin = timings.vfp; | 
 | 		var->hsync_len = timings.hsw; | 
 | 		var->vsync_len = timings.vsw; | 
 | 	} else { | 
 | 		var->pixclock = 0; | 
 | 		var->left_margin = 0; | 
 | 		var->right_margin = 0; | 
 | 		var->upper_margin = 0; | 
 | 		var->lower_margin = 0; | 
 | 		var->hsync_len = 0; | 
 | 		var->vsync_len = 0; | 
 | 	} | 
 |  | 
 | 	/* TODO: get these from panel->config */ | 
 | 	var->vmode              = FB_VMODE_NONINTERLACED; | 
 | 	var->sync               = 0; | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | /* | 
 |  * --------------------------------------------------------------------------- | 
 |  * fbdev framework callbacks | 
 |  * --------------------------------------------------------------------------- | 
 |  */ | 
 | static int omapfb_open(struct fb_info *fbi, int user) | 
 | { | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int omapfb_release(struct fb_info *fbi, int user) | 
 | { | 
 | 	return 0; | 
 | } | 
 |  | 
 | static unsigned calc_rotation_offset_dma(const struct fb_var_screeninfo *var, | 
 | 		const struct fb_fix_screeninfo *fix, int rotation) | 
 | { | 
 | 	unsigned offset; | 
 |  | 
 | 	offset = var->yoffset * fix->line_length + | 
 | 		var->xoffset * (var->bits_per_pixel >> 3); | 
 |  | 
 | 	return offset; | 
 | } | 
 |  | 
 | static unsigned calc_rotation_offset_vrfb(const struct fb_var_screeninfo *var, | 
 | 		const struct fb_fix_screeninfo *fix, int rotation) | 
 | { | 
 | 	unsigned offset; | 
 |  | 
 | 	if (rotation == FB_ROTATE_UD) | 
 | 		offset = (var->yres_virtual - var->yres) * | 
 | 			fix->line_length; | 
 | 	else if (rotation == FB_ROTATE_CW) | 
 | 		offset = (var->yres_virtual - var->yres) * | 
 | 			(var->bits_per_pixel >> 3); | 
 | 	else | 
 | 		offset = 0; | 
 |  | 
 | 	if (rotation == FB_ROTATE_UR) | 
 | 		offset += var->yoffset * fix->line_length + | 
 | 			var->xoffset * (var->bits_per_pixel >> 3); | 
 | 	else if (rotation == FB_ROTATE_UD) | 
 | 		offset -= var->yoffset * fix->line_length + | 
 | 			var->xoffset * (var->bits_per_pixel >> 3); | 
 | 	else if (rotation == FB_ROTATE_CW) | 
 | 		offset -= var->xoffset * fix->line_length + | 
 | 			var->yoffset * (var->bits_per_pixel >> 3); | 
 | 	else if (rotation == FB_ROTATE_CCW) | 
 | 		offset += var->xoffset * fix->line_length + | 
 | 			var->yoffset * (var->bits_per_pixel >> 3); | 
 |  | 
 | 	return offset; | 
 | } | 
 |  | 
 | static void omapfb_calc_addr(const struct omapfb_info *ofbi, | 
 | 			     const struct fb_var_screeninfo *var, | 
 | 			     const struct fb_fix_screeninfo *fix, | 
 | 			     int rotation, u32 *paddr) | 
 | { | 
 | 	u32 data_start_p; | 
 | 	int offset; | 
 |  | 
 | 	if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB) | 
 | 		data_start_p = omapfb_get_region_rot_paddr(ofbi, rotation); | 
 | 	else | 
 | 		data_start_p = omapfb_get_region_paddr(ofbi); | 
 |  | 
 | 	if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB) | 
 | 		offset = calc_rotation_offset_vrfb(var, fix, rotation); | 
 | 	else | 
 | 		offset = calc_rotation_offset_dma(var, fix, rotation); | 
 |  | 
 | 	data_start_p += offset; | 
 |  | 
 | 	if (offset) | 
 | 		DBG("offset %d, %d = %d\n", | 
 | 		    var->xoffset, var->yoffset, offset); | 
 |  | 
 | 	DBG("paddr %x\n", data_start_p); | 
 |  | 
 | 	*paddr = data_start_p; | 
 | } | 
 |  | 
 | /* setup overlay according to the fb */ | 
 | int omapfb_setup_overlay(struct fb_info *fbi, struct omap_overlay *ovl, | 
 | 		u16 posx, u16 posy, u16 outw, u16 outh) | 
 | { | 
 | 	int r = 0; | 
 | 	struct omapfb_info *ofbi = FB2OFB(fbi); | 
 | 	struct fb_var_screeninfo *var = &fbi->var; | 
 | 	struct fb_fix_screeninfo *fix = &fbi->fix; | 
 | 	enum omap_color_mode mode = 0; | 
 | 	u32 data_start_p = 0; | 
 | 	struct omap_overlay_info info; | 
 | 	int xres, yres; | 
 | 	int screen_width; | 
 | 	int mirror; | 
 | 	int rotation = var->rotate; | 
 | 	int i; | 
 |  | 
 | 	WARN_ON(!atomic_read(&ofbi->region->lock_count)); | 
 |  | 
 | 	for (i = 0; i < ofbi->num_overlays; i++) { | 
 | 		if (ovl != ofbi->overlays[i]) | 
 | 			continue; | 
 |  | 
 | 		rotation = (rotation + ofbi->rotation[i]) % 4; | 
 | 		break; | 
 | 	} | 
 |  | 
 | 	DBG("setup_overlay %d, posx %d, posy %d, outw %d, outh %d\n", ofbi->id, | 
 | 			posx, posy, outw, outh); | 
 |  | 
 | 	if (rotation == FB_ROTATE_CW || rotation == FB_ROTATE_CCW) { | 
 | 		xres = var->yres; | 
 | 		yres = var->xres; | 
 | 	} else { | 
 | 		xres = var->xres; | 
 | 		yres = var->yres; | 
 | 	} | 
 |  | 
 | 	if (ofbi->region->size) | 
 | 		omapfb_calc_addr(ofbi, var, fix, rotation, &data_start_p); | 
 |  | 
 | 	r = fb_mode_to_dss_mode(var, &mode); | 
 | 	if (r) { | 
 | 		DBG("fb_mode_to_dss_mode failed"); | 
 | 		goto err; | 
 | 	} | 
 |  | 
 | 	switch (var->nonstd) { | 
 | 	case OMAPFB_COLOR_YUV422: | 
 | 	case OMAPFB_COLOR_YUY422: | 
 | 		if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB) { | 
 | 			screen_width = fix->line_length | 
 | 				/ (var->bits_per_pixel >> 2); | 
 | 			break; | 
 | 		} | 
 | 	default: | 
 | 		screen_width = fix->line_length / (var->bits_per_pixel >> 3); | 
 | 		break; | 
 | 	} | 
 |  | 
 | 	ovl->get_overlay_info(ovl, &info); | 
 |  | 
 | 	if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB) | 
 | 		mirror = 0; | 
 | 	else | 
 | 		mirror = ofbi->mirror; | 
 |  | 
 | 	info.paddr = data_start_p; | 
 | 	info.screen_width = screen_width; | 
 | 	info.width = xres; | 
 | 	info.height = yres; | 
 | 	info.color_mode = mode; | 
 | 	info.rotation_type = ofbi->rotation_type; | 
 | 	info.rotation = rotation; | 
 | 	info.mirror = mirror; | 
 |  | 
 | 	info.pos_x = posx; | 
 | 	info.pos_y = posy; | 
 | 	info.out_width = outw; | 
 | 	info.out_height = outh; | 
 |  | 
 | 	r = ovl->set_overlay_info(ovl, &info); | 
 | 	if (r) { | 
 | 		DBG("ovl->setup_overlay_info failed\n"); | 
 | 		goto err; | 
 | 	} | 
 |  | 
 | 	return 0; | 
 |  | 
 | err: | 
 | 	DBG("setup_overlay failed\n"); | 
 | 	return r; | 
 | } | 
 |  | 
 | /* apply var to the overlay */ | 
 | int omapfb_apply_changes(struct fb_info *fbi, int init) | 
 | { | 
 | 	int r = 0; | 
 | 	struct omapfb_info *ofbi = FB2OFB(fbi); | 
 | 	struct fb_var_screeninfo *var = &fbi->var; | 
 | 	struct omap_overlay *ovl; | 
 | 	u16 posx, posy; | 
 | 	u16 outw, outh; | 
 | 	int i; | 
 |  | 
 | #ifdef DEBUG | 
 | 	if (omapfb_test_pattern) | 
 | 		fill_fb(fbi); | 
 | #endif | 
 |  | 
 | 	WARN_ON(!atomic_read(&ofbi->region->lock_count)); | 
 |  | 
 | 	for (i = 0; i < ofbi->num_overlays; i++) { | 
 | 		ovl = ofbi->overlays[i]; | 
 |  | 
 | 		DBG("apply_changes, fb %d, ovl %d\n", ofbi->id, ovl->id); | 
 |  | 
 | 		if (ofbi->region->size == 0) { | 
 | 			/* the fb is not available. disable the overlay */ | 
 | 			omapfb_overlay_enable(ovl, 0); | 
 | 			if (!init && ovl->manager) | 
 | 				ovl->manager->apply(ovl->manager); | 
 | 			continue; | 
 | 		} | 
 |  | 
 | 		if (init || (ovl->caps & OMAP_DSS_OVL_CAP_SCALE) == 0) { | 
 | 			int rotation = (var->rotate + ofbi->rotation[i]) % 4; | 
 | 			if (rotation == FB_ROTATE_CW || | 
 | 					rotation == FB_ROTATE_CCW) { | 
 | 				outw = var->yres; | 
 | 				outh = var->xres; | 
 | 			} else { | 
 | 				outw = var->xres; | 
 | 				outh = var->yres; | 
 | 			} | 
 | 		} else { | 
 | 			struct omap_overlay_info info; | 
 | 			ovl->get_overlay_info(ovl, &info); | 
 | 			outw = info.out_width; | 
 | 			outh = info.out_height; | 
 | 		} | 
 |  | 
 | 		if (init) { | 
 | 			posx = 0; | 
 | 			posy = 0; | 
 | 		} else { | 
 | 			struct omap_overlay_info info; | 
 | 			ovl->get_overlay_info(ovl, &info); | 
 | 			posx = info.pos_x; | 
 | 			posy = info.pos_y; | 
 | 		} | 
 |  | 
 | 		r = omapfb_setup_overlay(fbi, ovl, posx, posy, outw, outh); | 
 | 		if (r) | 
 | 			goto err; | 
 |  | 
 | 		if (!init && ovl->manager) | 
 | 			ovl->manager->apply(ovl->manager); | 
 | 	} | 
 | 	return 0; | 
 | err: | 
 | 	DBG("apply_changes failed\n"); | 
 | 	return r; | 
 | } | 
 |  | 
 | /* checks var and eventually tweaks it to something supported, | 
 |  * DO NOT MODIFY PAR */ | 
 | static int omapfb_check_var(struct fb_var_screeninfo *var, struct fb_info *fbi) | 
 | { | 
 | 	struct omapfb_info *ofbi = FB2OFB(fbi); | 
 | 	int r; | 
 |  | 
 | 	DBG("check_var(%d)\n", FB2OFB(fbi)->id); | 
 |  | 
 | 	omapfb_get_mem_region(ofbi->region); | 
 |  | 
 | 	r = check_fb_var(fbi, var); | 
 |  | 
 | 	omapfb_put_mem_region(ofbi->region); | 
 |  | 
 | 	return r; | 
 | } | 
 |  | 
 | /* set the video mode according to info->var */ | 
 | static int omapfb_set_par(struct fb_info *fbi) | 
 | { | 
 | 	struct omapfb_info *ofbi = FB2OFB(fbi); | 
 | 	int r; | 
 |  | 
 | 	DBG("set_par(%d)\n", FB2OFB(fbi)->id); | 
 |  | 
 | 	omapfb_get_mem_region(ofbi->region); | 
 |  | 
 | 	set_fb_fix(fbi); | 
 |  | 
 | 	r = setup_vrfb_rotation(fbi); | 
 | 	if (r) | 
 | 		goto out; | 
 |  | 
 | 	r = omapfb_apply_changes(fbi, 0); | 
 |  | 
 |  out: | 
 | 	omapfb_put_mem_region(ofbi->region); | 
 |  | 
 | 	return r; | 
 | } | 
 |  | 
 | static int omapfb_pan_display(struct fb_var_screeninfo *var, | 
 | 		struct fb_info *fbi) | 
 | { | 
 | 	struct omapfb_info *ofbi = FB2OFB(fbi); | 
 | 	struct fb_var_screeninfo new_var; | 
 | 	int r; | 
 |  | 
 | 	DBG("pan_display(%d)\n", FB2OFB(fbi)->id); | 
 |  | 
 | 	if (var->xoffset == fbi->var.xoffset && | 
 | 	    var->yoffset == fbi->var.yoffset) | 
 | 		return 0; | 
 |  | 
 | 	new_var = fbi->var; | 
 | 	new_var.xoffset = var->xoffset; | 
 | 	new_var.yoffset = var->yoffset; | 
 |  | 
 | 	fbi->var = new_var; | 
 |  | 
 | 	omapfb_get_mem_region(ofbi->region); | 
 |  | 
 | 	r = omapfb_apply_changes(fbi, 0); | 
 |  | 
 | 	omapfb_put_mem_region(ofbi->region); | 
 |  | 
 | 	return r; | 
 | } | 
 |  | 
 | static void mmap_user_open(struct vm_area_struct *vma) | 
 | { | 
 | 	struct omapfb2_mem_region *rg = vma->vm_private_data; | 
 |  | 
 | 	omapfb_get_mem_region(rg); | 
 | 	atomic_inc(&rg->map_count); | 
 | 	omapfb_put_mem_region(rg); | 
 | } | 
 |  | 
 | static void mmap_user_close(struct vm_area_struct *vma) | 
 | { | 
 | 	struct omapfb2_mem_region *rg = vma->vm_private_data; | 
 |  | 
 | 	omapfb_get_mem_region(rg); | 
 | 	atomic_dec(&rg->map_count); | 
 | 	omapfb_put_mem_region(rg); | 
 | } | 
 |  | 
 | static struct vm_operations_struct mmap_user_ops = { | 
 | 	.open = mmap_user_open, | 
 | 	.close = mmap_user_close, | 
 | }; | 
 |  | 
 | static int omapfb_mmap(struct fb_info *fbi, struct vm_area_struct *vma) | 
 | { | 
 | 	struct omapfb_info *ofbi = FB2OFB(fbi); | 
 | 	struct fb_fix_screeninfo *fix = &fbi->fix; | 
 | 	struct omapfb2_mem_region *rg; | 
 | 	unsigned long off; | 
 | 	unsigned long start; | 
 | 	u32 len; | 
 | 	int r = -EINVAL; | 
 |  | 
 | 	if (vma->vm_end - vma->vm_start == 0) | 
 | 		return 0; | 
 | 	if (vma->vm_pgoff > (~0UL >> PAGE_SHIFT)) | 
 | 		return -EINVAL; | 
 | 	off = vma->vm_pgoff << PAGE_SHIFT; | 
 |  | 
 | 	rg = omapfb_get_mem_region(ofbi->region); | 
 |  | 
 | 	start = omapfb_get_region_paddr(ofbi); | 
 | 	len = fix->smem_len; | 
 | 	if (off >= len) | 
 | 		goto error; | 
 | 	if ((vma->vm_end - vma->vm_start + off) > len) | 
 | 		goto error; | 
 |  | 
 | 	off += start; | 
 |  | 
 | 	DBG("user mmap region start %lx, len %d, off %lx\n", start, len, off); | 
 |  | 
 | 	vma->vm_pgoff = off >> PAGE_SHIFT; | 
 | 	vma->vm_flags |= VM_IO | VM_RESERVED; | 
 | 	vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot); | 
 | 	vma->vm_ops = &mmap_user_ops; | 
 | 	vma->vm_private_data = rg; | 
 | 	if (io_remap_pfn_range(vma, vma->vm_start, off >> PAGE_SHIFT, | 
 | 			       vma->vm_end - vma->vm_start, | 
 | 			       vma->vm_page_prot)) { | 
 | 		r = -EAGAIN; | 
 | 		goto error; | 
 | 	} | 
 |  | 
 | 	/* vm_ops.open won't be called for mmap itself. */ | 
 | 	atomic_inc(&rg->map_count); | 
 |  | 
 | 	omapfb_put_mem_region(rg); | 
 |  | 
 | 	return 0; | 
 |  | 
 |  error: | 
 | 	omapfb_put_mem_region(ofbi->region); | 
 |  | 
 | 	return r; | 
 | } | 
 |  | 
 | /* Store a single color palette entry into a pseudo palette or the hardware | 
 |  * palette if one is available. For now we support only 16bpp and thus store | 
 |  * the entry only to the pseudo palette. | 
 |  */ | 
 | static int _setcolreg(struct fb_info *fbi, u_int regno, u_int red, u_int green, | 
 | 		u_int blue, u_int transp, int update_hw_pal) | 
 | { | 
 | 	/*struct omapfb_info *ofbi = FB2OFB(fbi);*/ | 
 | 	/*struct omapfb2_device *fbdev = ofbi->fbdev;*/ | 
 | 	struct fb_var_screeninfo *var = &fbi->var; | 
 | 	int r = 0; | 
 |  | 
 | 	enum omapfb_color_format mode = OMAPFB_COLOR_RGB24U; /* XXX */ | 
 |  | 
 | 	/*switch (plane->color_mode) {*/ | 
 | 	switch (mode) { | 
 | 	case OMAPFB_COLOR_YUV422: | 
 | 	case OMAPFB_COLOR_YUV420: | 
 | 	case OMAPFB_COLOR_YUY422: | 
 | 		r = -EINVAL; | 
 | 		break; | 
 | 	case OMAPFB_COLOR_CLUT_8BPP: | 
 | 	case OMAPFB_COLOR_CLUT_4BPP: | 
 | 	case OMAPFB_COLOR_CLUT_2BPP: | 
 | 	case OMAPFB_COLOR_CLUT_1BPP: | 
 | 		/* | 
 | 		   if (fbdev->ctrl->setcolreg) | 
 | 		   r = fbdev->ctrl->setcolreg(regno, red, green, blue, | 
 | 		   transp, update_hw_pal); | 
 | 		   */ | 
 | 		/* Fallthrough */ | 
 | 		r = -EINVAL; | 
 | 		break; | 
 | 	case OMAPFB_COLOR_RGB565: | 
 | 	case OMAPFB_COLOR_RGB444: | 
 | 	case OMAPFB_COLOR_RGB24P: | 
 | 	case OMAPFB_COLOR_RGB24U: | 
 | 		if (r != 0) | 
 | 			break; | 
 |  | 
 | 		if (regno < 16) { | 
 | 			u16 pal; | 
 | 			pal = ((red >> (16 - var->red.length)) << | 
 | 					var->red.offset) | | 
 | 				((green >> (16 - var->green.length)) << | 
 | 				 var->green.offset) | | 
 | 				(blue >> (16 - var->blue.length)); | 
 | 			((u32 *)(fbi->pseudo_palette))[regno] = pal; | 
 | 		} | 
 | 		break; | 
 | 	default: | 
 | 		BUG(); | 
 | 	} | 
 | 	return r; | 
 | } | 
 |  | 
 | static int omapfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue, | 
 | 		u_int transp, struct fb_info *info) | 
 | { | 
 | 	DBG("setcolreg\n"); | 
 |  | 
 | 	return _setcolreg(info, regno, red, green, blue, transp, 1); | 
 | } | 
 |  | 
 | static int omapfb_setcmap(struct fb_cmap *cmap, struct fb_info *info) | 
 | { | 
 | 	int count, index, r; | 
 | 	u16 *red, *green, *blue, *transp; | 
 | 	u16 trans = 0xffff; | 
 |  | 
 | 	DBG("setcmap\n"); | 
 |  | 
 | 	red     = cmap->red; | 
 | 	green   = cmap->green; | 
 | 	blue    = cmap->blue; | 
 | 	transp  = cmap->transp; | 
 | 	index   = cmap->start; | 
 |  | 
 | 	for (count = 0; count < cmap->len; count++) { | 
 | 		if (transp) | 
 | 			trans = *transp++; | 
 | 		r = _setcolreg(info, index++, *red++, *green++, *blue++, trans, | 
 | 				count == cmap->len - 1); | 
 | 		if (r != 0) | 
 | 			return r; | 
 | 	} | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int omapfb_blank(int blank, struct fb_info *fbi) | 
 | { | 
 | 	struct omapfb_info *ofbi = FB2OFB(fbi); | 
 | 	struct omapfb2_device *fbdev = ofbi->fbdev; | 
 | 	struct omap_dss_device *display = fb2display(fbi); | 
 | 	struct omapfb_display_data *d; | 
 | 	int r = 0; | 
 |  | 
 | 	if (!display) | 
 | 		return -EINVAL; | 
 |  | 
 | 	omapfb_lock(fbdev); | 
 |  | 
 | 	d = get_display_data(fbdev, display); | 
 |  | 
 | 	switch (blank) { | 
 | 	case FB_BLANK_UNBLANK: | 
 | 		if (display->state != OMAP_DSS_DISPLAY_SUSPENDED) | 
 | 			goto exit; | 
 |  | 
 | 		if (display->driver->resume) | 
 | 			r = display->driver->resume(display); | 
 |  | 
 | 		if ((display->caps & OMAP_DSS_DISPLAY_CAP_MANUAL_UPDATE) && | 
 | 				d->update_mode == OMAPFB_AUTO_UPDATE && | 
 | 				!d->auto_update_work_enabled) | 
 | 			omapfb_start_auto_update(fbdev, display); | 
 |  | 
 | 		break; | 
 |  | 
 | 	case FB_BLANK_NORMAL: | 
 | 		/* FB_BLANK_NORMAL could be implemented. | 
 | 		 * Needs DSS additions. */ | 
 | 	case FB_BLANK_VSYNC_SUSPEND: | 
 | 	case FB_BLANK_HSYNC_SUSPEND: | 
 | 	case FB_BLANK_POWERDOWN: | 
 | 		if (display->state != OMAP_DSS_DISPLAY_ACTIVE) | 
 | 			goto exit; | 
 |  | 
 | 		if (d->auto_update_work_enabled) | 
 | 			omapfb_stop_auto_update(fbdev, display); | 
 |  | 
 | 		if (display->driver->suspend) | 
 | 			r = display->driver->suspend(display); | 
 |  | 
 | 		break; | 
 |  | 
 | 	default: | 
 | 		r = -EINVAL; | 
 | 	} | 
 |  | 
 | exit: | 
 | 	omapfb_unlock(fbdev); | 
 |  | 
 | 	return r; | 
 | } | 
 |  | 
 | #if 0 | 
 | /* XXX fb_read and fb_write are needed for VRFB */ | 
 | ssize_t omapfb_write(struct fb_info *info, const char __user *buf, | 
 | 		size_t count, loff_t *ppos) | 
 | { | 
 | 	DBG("omapfb_write %d, %lu\n", count, (unsigned long)*ppos); | 
 | 	/* XXX needed for VRFB */ | 
 | 	return count; | 
 | } | 
 | #endif | 
 |  | 
 | static struct fb_ops omapfb_ops = { | 
 | 	.owner          = THIS_MODULE, | 
 | 	.fb_open        = omapfb_open, | 
 | 	.fb_release     = omapfb_release, | 
 | 	.fb_fillrect    = cfb_fillrect, | 
 | 	.fb_copyarea    = cfb_copyarea, | 
 | 	.fb_imageblit   = cfb_imageblit, | 
 | 	.fb_blank       = omapfb_blank, | 
 | 	.fb_ioctl       = omapfb_ioctl, | 
 | 	.fb_check_var   = omapfb_check_var, | 
 | 	.fb_set_par     = omapfb_set_par, | 
 | 	.fb_pan_display = omapfb_pan_display, | 
 | 	.fb_mmap	= omapfb_mmap, | 
 | 	.fb_setcolreg	= omapfb_setcolreg, | 
 | 	.fb_setcmap	= omapfb_setcmap, | 
 | 	/*.fb_write	= omapfb_write,*/ | 
 | }; | 
 |  | 
 | static void omapfb_free_fbmem(struct fb_info *fbi) | 
 | { | 
 | 	struct omapfb_info *ofbi = FB2OFB(fbi); | 
 | 	struct omapfb2_device *fbdev = ofbi->fbdev; | 
 | 	struct omapfb2_mem_region *rg; | 
 |  | 
 | 	rg = ofbi->region; | 
 |  | 
 | 	WARN_ON(atomic_read(&rg->map_count)); | 
 |  | 
 | 	if (rg->paddr) | 
 | 		if (omap_vram_free(rg->paddr, rg->size)) | 
 | 			dev_err(fbdev->dev, "VRAM FREE failed\n"); | 
 |  | 
 | 	if (rg->vaddr) | 
 | 		iounmap(rg->vaddr); | 
 |  | 
 | 	if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB) { | 
 | 		/* unmap the 0 angle rotation */ | 
 | 		if (rg->vrfb.vaddr[0]) { | 
 | 			iounmap(rg->vrfb.vaddr[0]); | 
 | 			omap_vrfb_release_ctx(&rg->vrfb); | 
 | 			rg->vrfb.vaddr[0] = NULL; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	rg->vaddr = NULL; | 
 | 	rg->paddr = 0; | 
 | 	rg->alloc = 0; | 
 | 	rg->size = 0; | 
 | } | 
 |  | 
 | static void clear_fb_info(struct fb_info *fbi) | 
 | { | 
 | 	memset(&fbi->var, 0, sizeof(fbi->var)); | 
 | 	memset(&fbi->fix, 0, sizeof(fbi->fix)); | 
 | 	strlcpy(fbi->fix.id, MODULE_NAME, sizeof(fbi->fix.id)); | 
 | } | 
 |  | 
 | static int omapfb_free_all_fbmem(struct omapfb2_device *fbdev) | 
 | { | 
 | 	int i; | 
 |  | 
 | 	DBG("free all fbmem\n"); | 
 |  | 
 | 	for (i = 0; i < fbdev->num_fbs; i++) { | 
 | 		struct fb_info *fbi = fbdev->fbs[i]; | 
 | 		omapfb_free_fbmem(fbi); | 
 | 		clear_fb_info(fbi); | 
 | 	} | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int omapfb_alloc_fbmem(struct fb_info *fbi, unsigned long size, | 
 | 		unsigned long paddr) | 
 | { | 
 | 	struct omapfb_info *ofbi = FB2OFB(fbi); | 
 | 	struct omapfb2_device *fbdev = ofbi->fbdev; | 
 | 	struct omapfb2_mem_region *rg; | 
 | 	void __iomem *vaddr; | 
 | 	int r; | 
 |  | 
 | 	rg = ofbi->region; | 
 |  | 
 | 	rg->paddr = 0; | 
 | 	rg->vaddr = NULL; | 
 | 	memset(&rg->vrfb, 0, sizeof rg->vrfb); | 
 | 	rg->size = 0; | 
 | 	rg->type = 0; | 
 | 	rg->alloc = false; | 
 | 	rg->map = false; | 
 |  | 
 | 	size = PAGE_ALIGN(size); | 
 |  | 
 | 	if (!paddr) { | 
 | 		DBG("allocating %lu bytes for fb %d\n", size, ofbi->id); | 
 | 		r = omap_vram_alloc(size, &paddr); | 
 | 	} else { | 
 | 		DBG("reserving %lu bytes at %lx for fb %d\n", size, paddr, | 
 | 				ofbi->id); | 
 | 		r = omap_vram_reserve(paddr, size); | 
 | 	} | 
 |  | 
 | 	if (r) { | 
 | 		dev_err(fbdev->dev, "failed to allocate framebuffer\n"); | 
 | 		return -ENOMEM; | 
 | 	} | 
 |  | 
 | 	if (ofbi->rotation_type != OMAP_DSS_ROT_VRFB) { | 
 | 		vaddr = ioremap_wc(paddr, size); | 
 |  | 
 | 		if (!vaddr) { | 
 | 			dev_err(fbdev->dev, "failed to ioremap framebuffer\n"); | 
 | 			omap_vram_free(paddr, size); | 
 | 			return -ENOMEM; | 
 | 		} | 
 |  | 
 | 		DBG("allocated VRAM paddr %lx, vaddr %p\n", paddr, vaddr); | 
 | 	} else { | 
 | 		r = omap_vrfb_request_ctx(&rg->vrfb); | 
 | 		if (r) { | 
 | 			dev_err(fbdev->dev, "vrfb create ctx failed\n"); | 
 | 			return r; | 
 | 		} | 
 |  | 
 | 		vaddr = NULL; | 
 | 	} | 
 |  | 
 | 	rg->paddr = paddr; | 
 | 	rg->vaddr = vaddr; | 
 | 	rg->size = size; | 
 | 	rg->alloc = 1; | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | /* allocate fbmem using display resolution as reference */ | 
 | static int omapfb_alloc_fbmem_display(struct fb_info *fbi, unsigned long size, | 
 | 		unsigned long paddr) | 
 | { | 
 | 	struct omapfb_info *ofbi = FB2OFB(fbi); | 
 | 	struct omapfb2_device *fbdev = ofbi->fbdev; | 
 | 	struct omap_dss_device *display; | 
 | 	int bytespp; | 
 |  | 
 | 	display =  fb2display(fbi); | 
 |  | 
 | 	if (!display) | 
 | 		return 0; | 
 |  | 
 | 	switch (omapfb_get_recommended_bpp(fbdev, display)) { | 
 | 	case 16: | 
 | 		bytespp = 2; | 
 | 		break; | 
 | 	case 24: | 
 | 		bytespp = 4; | 
 | 		break; | 
 | 	default: | 
 | 		bytespp = 4; | 
 | 		break; | 
 | 	} | 
 |  | 
 | 	if (!size) { | 
 | 		u16 w, h; | 
 |  | 
 | 		display->driver->get_resolution(display, &w, &h); | 
 |  | 
 | 		if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB) { | 
 | 			size = max(omap_vrfb_min_phys_size(w, h, bytespp), | 
 | 					omap_vrfb_min_phys_size(h, w, bytespp)); | 
 |  | 
 | 			DBG("adjusting fb mem size for VRFB, %u -> %lu\n", | 
 | 					w * h * bytespp, size); | 
 | 		} else { | 
 | 			size = w * h * bytespp; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	if (!size) | 
 | 		return 0; | 
 |  | 
 | 	return omapfb_alloc_fbmem(fbi, size, paddr); | 
 | } | 
 |  | 
 | static int omapfb_parse_vram_param(const char *param, int max_entries, | 
 | 		unsigned long *sizes, unsigned long *paddrs) | 
 | { | 
 | 	int fbnum; | 
 | 	unsigned long size; | 
 | 	unsigned long paddr = 0; | 
 | 	char *p, *start; | 
 |  | 
 | 	start = (char *)param; | 
 |  | 
 | 	while (1) { | 
 | 		p = start; | 
 |  | 
 | 		fbnum = simple_strtoul(p, &p, 10); | 
 |  | 
 | 		if (p == start) | 
 | 			return -EINVAL; | 
 |  | 
 | 		if (*p != ':') | 
 | 			return -EINVAL; | 
 |  | 
 | 		if (fbnum >= max_entries) | 
 | 			return -EINVAL; | 
 |  | 
 | 		size = memparse(p + 1, &p); | 
 |  | 
 | 		if (!size) | 
 | 			return -EINVAL; | 
 |  | 
 | 		paddr = 0; | 
 |  | 
 | 		if (*p == '@') { | 
 | 			paddr = simple_strtoul(p + 1, &p, 16); | 
 |  | 
 | 			if (!paddr) | 
 | 				return -EINVAL; | 
 |  | 
 | 		} | 
 |  | 
 | 		paddrs[fbnum] = paddr; | 
 | 		sizes[fbnum] = size; | 
 |  | 
 | 		if (*p == 0) | 
 | 			break; | 
 |  | 
 | 		if (*p != ',') | 
 | 			return -EINVAL; | 
 |  | 
 | 		++p; | 
 |  | 
 | 		start = p; | 
 | 	} | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int omapfb_allocate_all_fbs(struct omapfb2_device *fbdev) | 
 | { | 
 | 	int i, r; | 
 | 	unsigned long vram_sizes[10]; | 
 | 	unsigned long vram_paddrs[10]; | 
 |  | 
 | 	memset(&vram_sizes, 0, sizeof(vram_sizes)); | 
 | 	memset(&vram_paddrs, 0, sizeof(vram_paddrs)); | 
 |  | 
 | 	if (def_vram &&	omapfb_parse_vram_param(def_vram, 10, | 
 | 				vram_sizes, vram_paddrs)) { | 
 | 		dev_err(fbdev->dev, "failed to parse vram parameter\n"); | 
 |  | 
 | 		memset(&vram_sizes, 0, sizeof(vram_sizes)); | 
 | 		memset(&vram_paddrs, 0, sizeof(vram_paddrs)); | 
 | 	} | 
 |  | 
 | 	for (i = 0; i < fbdev->num_fbs; i++) { | 
 | 		/* allocate memory automatically only for fb0, or if | 
 | 		 * excplicitly defined with vram or plat data option */ | 
 | 		if (i == 0 || vram_sizes[i] != 0) { | 
 | 			r = omapfb_alloc_fbmem_display(fbdev->fbs[i], | 
 | 					vram_sizes[i], vram_paddrs[i]); | 
 |  | 
 | 			if (r) | 
 | 				return r; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	for (i = 0; i < fbdev->num_fbs; i++) { | 
 | 		struct omapfb_info *ofbi = FB2OFB(fbdev->fbs[i]); | 
 | 		struct omapfb2_mem_region *rg; | 
 | 		rg = ofbi->region; | 
 |  | 
 | 		DBG("region%d phys %08x virt %p size=%lu\n", | 
 | 				i, | 
 | 				rg->paddr, | 
 | 				rg->vaddr, | 
 | 				rg->size); | 
 | 	} | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | int omapfb_realloc_fbmem(struct fb_info *fbi, unsigned long size, int type) | 
 | { | 
 | 	struct omapfb_info *ofbi = FB2OFB(fbi); | 
 | 	struct omapfb2_device *fbdev = ofbi->fbdev; | 
 | 	struct omap_dss_device *display = fb2display(fbi); | 
 | 	struct omapfb2_mem_region *rg = ofbi->region; | 
 | 	unsigned long old_size = rg->size; | 
 | 	unsigned long old_paddr = rg->paddr; | 
 | 	int old_type = rg->type; | 
 | 	int r; | 
 |  | 
 | 	if (type != OMAPFB_MEMTYPE_SDRAM) | 
 | 		return -EINVAL; | 
 |  | 
 | 	size = PAGE_ALIGN(size); | 
 |  | 
 | 	if (old_size == size && old_type == type) | 
 | 		return 0; | 
 |  | 
 | 	if (display && display->driver->sync) | 
 | 			display->driver->sync(display); | 
 |  | 
 | 	omapfb_free_fbmem(fbi); | 
 |  | 
 | 	if (size == 0) { | 
 | 		clear_fb_info(fbi); | 
 | 		return 0; | 
 | 	} | 
 |  | 
 | 	r = omapfb_alloc_fbmem(fbi, size, 0); | 
 |  | 
 | 	if (r) { | 
 | 		if (old_size) | 
 | 			omapfb_alloc_fbmem(fbi, old_size, old_paddr); | 
 |  | 
 | 		if (rg->size == 0) | 
 | 			clear_fb_info(fbi); | 
 |  | 
 | 		return r; | 
 | 	} | 
 |  | 
 | 	if (old_size == size) | 
 | 		return 0; | 
 |  | 
 | 	if (old_size == 0) { | 
 | 		DBG("initializing fb %d\n", ofbi->id); | 
 | 		r = omapfb_fb_init(fbdev, fbi); | 
 | 		if (r) { | 
 | 			DBG("omapfb_fb_init failed\n"); | 
 | 			goto err; | 
 | 		} | 
 | 		r = omapfb_apply_changes(fbi, 1); | 
 | 		if (r) { | 
 | 			DBG("omapfb_apply_changes failed\n"); | 
 | 			goto err; | 
 | 		} | 
 | 	} else { | 
 | 		struct fb_var_screeninfo new_var; | 
 | 		memcpy(&new_var, &fbi->var, sizeof(new_var)); | 
 | 		r = check_fb_var(fbi, &new_var); | 
 | 		if (r) | 
 | 			goto err; | 
 | 		memcpy(&fbi->var, &new_var, sizeof(fbi->var)); | 
 | 		set_fb_fix(fbi); | 
 | 		r = setup_vrfb_rotation(fbi); | 
 | 		if (r) | 
 | 			goto err; | 
 | 	} | 
 |  | 
 | 	return 0; | 
 | err: | 
 | 	omapfb_free_fbmem(fbi); | 
 | 	clear_fb_info(fbi); | 
 | 	return r; | 
 | } | 
 |  | 
 | static void omapfb_auto_update_work(struct work_struct *work) | 
 | { | 
 | 	struct omap_dss_device *dssdev; | 
 | 	struct omap_dss_driver *dssdrv; | 
 | 	struct omapfb_display_data *d; | 
 | 	u16 w, h; | 
 | 	unsigned int freq; | 
 | 	struct omapfb2_device *fbdev; | 
 |  | 
 | 	d = container_of(work, struct omapfb_display_data, | 
 | 			auto_update_work.work); | 
 |  | 
 | 	dssdev = d->dssdev; | 
 | 	dssdrv = dssdev->driver; | 
 | 	fbdev = d->fbdev; | 
 |  | 
 | 	if (!dssdrv || !dssdrv->update) | 
 | 		return; | 
 |  | 
 | 	if (dssdrv->sync) | 
 | 		dssdrv->sync(dssdev); | 
 |  | 
 | 	dssdrv->get_resolution(dssdev, &w, &h); | 
 | 	dssdrv->update(dssdev, 0, 0, w, h); | 
 |  | 
 | 	freq = auto_update_freq; | 
 | 	if (freq == 0) | 
 | 		freq = 20; | 
 | 	queue_delayed_work(fbdev->auto_update_wq, | 
 | 			&d->auto_update_work, HZ / freq); | 
 | } | 
 |  | 
 | void omapfb_start_auto_update(struct omapfb2_device *fbdev, | 
 | 		struct omap_dss_device *display) | 
 | { | 
 | 	struct omapfb_display_data *d; | 
 |  | 
 | 	if (fbdev->auto_update_wq == NULL) { | 
 | 		struct workqueue_struct *wq; | 
 |  | 
 | 		wq = create_singlethread_workqueue("omapfb_auto_update"); | 
 |  | 
 | 		if (wq == NULL) { | 
 | 			dev_err(fbdev->dev, "Failed to create workqueue for " | 
 | 					"auto-update\n"); | 
 | 			return; | 
 | 		} | 
 |  | 
 | 		fbdev->auto_update_wq = wq; | 
 | 	} | 
 |  | 
 | 	d = get_display_data(fbdev, display); | 
 |  | 
 | 	INIT_DELAYED_WORK(&d->auto_update_work, omapfb_auto_update_work); | 
 |  | 
 | 	d->auto_update_work_enabled = true; | 
 |  | 
 | 	omapfb_auto_update_work(&d->auto_update_work.work); | 
 | } | 
 |  | 
 | void omapfb_stop_auto_update(struct omapfb2_device *fbdev, | 
 | 		struct omap_dss_device *display) | 
 | { | 
 | 	struct omapfb_display_data *d; | 
 |  | 
 | 	d = get_display_data(fbdev, display); | 
 |  | 
 | 	cancel_delayed_work_sync(&d->auto_update_work); | 
 |  | 
 | 	d->auto_update_work_enabled = false; | 
 | } | 
 |  | 
 | /* initialize fb_info, var, fix to something sane based on the display */ | 
 | static int omapfb_fb_init(struct omapfb2_device *fbdev, struct fb_info *fbi) | 
 | { | 
 | 	struct fb_var_screeninfo *var = &fbi->var; | 
 | 	struct omap_dss_device *display = fb2display(fbi); | 
 | 	struct omapfb_info *ofbi = FB2OFB(fbi); | 
 | 	int r = 0; | 
 |  | 
 | 	fbi->fbops = &omapfb_ops; | 
 | 	fbi->flags = FBINFO_FLAG_DEFAULT; | 
 | 	fbi->pseudo_palette = fbdev->pseudo_palette; | 
 |  | 
 | 	if (ofbi->region->size == 0) { | 
 | 		clear_fb_info(fbi); | 
 | 		return 0; | 
 | 	} | 
 |  | 
 | 	var->nonstd = 0; | 
 | 	var->bits_per_pixel = 0; | 
 |  | 
 | 	var->rotate = def_rotate; | 
 |  | 
 | 	if (display) { | 
 | 		u16 w, h; | 
 | 		int rotation = (var->rotate + ofbi->rotation[0]) % 4; | 
 |  | 
 | 		display->driver->get_resolution(display, &w, &h); | 
 |  | 
 | 		if (rotation == FB_ROTATE_CW || | 
 | 				rotation == FB_ROTATE_CCW) { | 
 | 			var->xres = h; | 
 | 			var->yres = w; | 
 | 		} else { | 
 | 			var->xres = w; | 
 | 			var->yres = h; | 
 | 		} | 
 |  | 
 | 		var->xres_virtual = var->xres; | 
 | 		var->yres_virtual = var->yres; | 
 |  | 
 | 		if (!var->bits_per_pixel) { | 
 | 			switch (omapfb_get_recommended_bpp(fbdev, display)) { | 
 | 			case 16: | 
 | 				var->bits_per_pixel = 16; | 
 | 				break; | 
 | 			case 24: | 
 | 				var->bits_per_pixel = 32; | 
 | 				break; | 
 | 			default: | 
 | 				dev_err(fbdev->dev, "illegal display " | 
 | 						"bpp\n"); | 
 | 				return -EINVAL; | 
 | 			} | 
 | 		} | 
 | 	} else { | 
 | 		/* if there's no display, let's just guess some basic values */ | 
 | 		var->xres = 320; | 
 | 		var->yres = 240; | 
 | 		var->xres_virtual = var->xres; | 
 | 		var->yres_virtual = var->yres; | 
 | 		if (!var->bits_per_pixel) | 
 | 			var->bits_per_pixel = 16; | 
 | 	} | 
 |  | 
 | 	r = check_fb_var(fbi, var); | 
 | 	if (r) | 
 | 		goto err; | 
 |  | 
 | 	set_fb_fix(fbi); | 
 | 	r = setup_vrfb_rotation(fbi); | 
 | 	if (r) | 
 | 		goto err; | 
 |  | 
 | 	r = fb_alloc_cmap(&fbi->cmap, 256, 0); | 
 | 	if (r) | 
 | 		dev_err(fbdev->dev, "unable to allocate color map memory\n"); | 
 |  | 
 | err: | 
 | 	return r; | 
 | } | 
 |  | 
 | static void fbinfo_cleanup(struct omapfb2_device *fbdev, struct fb_info *fbi) | 
 | { | 
 | 	fb_dealloc_cmap(&fbi->cmap); | 
 | } | 
 |  | 
 |  | 
 | static void omapfb_free_resources(struct omapfb2_device *fbdev) | 
 | { | 
 | 	int i; | 
 |  | 
 | 	DBG("free_resources\n"); | 
 |  | 
 | 	if (fbdev == NULL) | 
 | 		return; | 
 |  | 
 | 	for (i = 0; i < fbdev->num_fbs; i++) | 
 | 		unregister_framebuffer(fbdev->fbs[i]); | 
 |  | 
 | 	/* free the reserved fbmem */ | 
 | 	omapfb_free_all_fbmem(fbdev); | 
 |  | 
 | 	for (i = 0; i < fbdev->num_fbs; i++) { | 
 | 		fbinfo_cleanup(fbdev, fbdev->fbs[i]); | 
 | 		framebuffer_release(fbdev->fbs[i]); | 
 | 	} | 
 |  | 
 | 	for (i = 0; i < fbdev->num_displays; i++) { | 
 | 		struct omap_dss_device *dssdev = fbdev->displays[i].dssdev; | 
 |  | 
 | 		if (fbdev->displays[i].auto_update_work_enabled) | 
 | 			omapfb_stop_auto_update(fbdev, dssdev); | 
 |  | 
 | 		if (dssdev->state != OMAP_DSS_DISPLAY_DISABLED) | 
 | 			dssdev->driver->disable(dssdev); | 
 |  | 
 | 		omap_dss_put_device(dssdev); | 
 | 	} | 
 |  | 
 | 	if (fbdev->auto_update_wq != NULL) { | 
 | 		flush_workqueue(fbdev->auto_update_wq); | 
 | 		destroy_workqueue(fbdev->auto_update_wq); | 
 | 		fbdev->auto_update_wq = NULL; | 
 | 	} | 
 |  | 
 | 	dev_set_drvdata(fbdev->dev, NULL); | 
 | 	kfree(fbdev); | 
 | } | 
 |  | 
 | static int omapfb_create_framebuffers(struct omapfb2_device *fbdev) | 
 | { | 
 | 	int r, i; | 
 |  | 
 | 	fbdev->num_fbs = 0; | 
 |  | 
 | 	DBG("create %d framebuffers\n",	CONFIG_FB_OMAP2_NUM_FBS); | 
 |  | 
 | 	/* allocate fb_infos */ | 
 | 	for (i = 0; i < CONFIG_FB_OMAP2_NUM_FBS; i++) { | 
 | 		struct fb_info *fbi; | 
 | 		struct omapfb_info *ofbi; | 
 |  | 
 | 		fbi = framebuffer_alloc(sizeof(struct omapfb_info), | 
 | 				fbdev->dev); | 
 |  | 
 | 		if (fbi == NULL) { | 
 | 			dev_err(fbdev->dev, | 
 | 				"unable to allocate memory for plane info\n"); | 
 | 			return -ENOMEM; | 
 | 		} | 
 |  | 
 | 		clear_fb_info(fbi); | 
 |  | 
 | 		fbdev->fbs[i] = fbi; | 
 |  | 
 | 		ofbi = FB2OFB(fbi); | 
 | 		ofbi->fbdev = fbdev; | 
 | 		ofbi->id = i; | 
 |  | 
 | 		ofbi->region = &fbdev->regions[i]; | 
 | 		ofbi->region->id = i; | 
 | 		init_rwsem(&ofbi->region->lock); | 
 |  | 
 | 		/* assign these early, so that fb alloc can use them */ | 
 | 		ofbi->rotation_type = def_vrfb ? OMAP_DSS_ROT_VRFB : | 
 | 			OMAP_DSS_ROT_DMA; | 
 | 		ofbi->mirror = def_mirror; | 
 |  | 
 | 		fbdev->num_fbs++; | 
 | 	} | 
 |  | 
 | 	DBG("fb_infos allocated\n"); | 
 |  | 
 | 	/* assign overlays for the fbs */ | 
 | 	for (i = 0; i < min(fbdev->num_fbs, fbdev->num_overlays); i++) { | 
 | 		struct omapfb_info *ofbi = FB2OFB(fbdev->fbs[i]); | 
 |  | 
 | 		ofbi->overlays[0] = fbdev->overlays[i]; | 
 | 		ofbi->num_overlays = 1; | 
 | 	} | 
 |  | 
 | 	/* allocate fb memories */ | 
 | 	r = omapfb_allocate_all_fbs(fbdev); | 
 | 	if (r) { | 
 | 		dev_err(fbdev->dev, "failed to allocate fbmem\n"); | 
 | 		return r; | 
 | 	} | 
 |  | 
 | 	DBG("fbmems allocated\n"); | 
 |  | 
 | 	/* setup fb_infos */ | 
 | 	for (i = 0; i < fbdev->num_fbs; i++) { | 
 | 		struct fb_info *fbi = fbdev->fbs[i]; | 
 | 		struct omapfb_info *ofbi = FB2OFB(fbi); | 
 |  | 
 | 		omapfb_get_mem_region(ofbi->region); | 
 | 		r = omapfb_fb_init(fbdev, fbi); | 
 | 		omapfb_put_mem_region(ofbi->region); | 
 |  | 
 | 		if (r) { | 
 | 			dev_err(fbdev->dev, "failed to setup fb_info\n"); | 
 | 			return r; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	DBG("fb_infos initialized\n"); | 
 |  | 
 | 	for (i = 0; i < fbdev->num_fbs; i++) { | 
 | 		r = register_framebuffer(fbdev->fbs[i]); | 
 | 		if (r != 0) { | 
 | 			dev_err(fbdev->dev, | 
 | 				"registering framebuffer %d failed\n", i); | 
 | 			return r; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	DBG("framebuffers registered\n"); | 
 |  | 
 | 	for (i = 0; i < fbdev->num_fbs; i++) { | 
 | 		struct fb_info *fbi = fbdev->fbs[i]; | 
 | 		struct omapfb_info *ofbi = FB2OFB(fbi); | 
 |  | 
 | 		omapfb_get_mem_region(ofbi->region); | 
 | 		r = omapfb_apply_changes(fbi, 1); | 
 | 		omapfb_put_mem_region(ofbi->region); | 
 |  | 
 | 		if (r) { | 
 | 			dev_err(fbdev->dev, "failed to change mode\n"); | 
 | 			return r; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	/* Enable fb0 */ | 
 | 	if (fbdev->num_fbs > 0) { | 
 | 		struct omapfb_info *ofbi = FB2OFB(fbdev->fbs[0]); | 
 |  | 
 | 		if (ofbi->num_overlays > 0) { | 
 | 			struct omap_overlay *ovl = ofbi->overlays[0]; | 
 |  | 
 | 			ovl->manager->apply(ovl->manager); | 
 |  | 
 | 			r = omapfb_overlay_enable(ovl, 1); | 
 |  | 
 | 			if (r) { | 
 | 				dev_err(fbdev->dev, | 
 | 						"failed to enable overlay\n"); | 
 | 				return r; | 
 | 			} | 
 | 		} | 
 | 	} | 
 |  | 
 | 	DBG("create_framebuffers done\n"); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int omapfb_mode_to_timings(const char *mode_str, | 
 | 		struct omap_video_timings *timings, u8 *bpp) | 
 | { | 
 | 	struct fb_info *fbi; | 
 | 	struct fb_var_screeninfo *var; | 
 | 	struct fb_ops *fbops; | 
 | 	int r; | 
 |  | 
 | #ifdef CONFIG_OMAP2_DSS_VENC | 
 | 	if (strcmp(mode_str, "pal") == 0) { | 
 | 		*timings = omap_dss_pal_timings; | 
 | 		*bpp = 24; | 
 | 		return 0; | 
 | 	} else if (strcmp(mode_str, "ntsc") == 0) { | 
 | 		*timings = omap_dss_ntsc_timings; | 
 | 		*bpp = 24; | 
 | 		return 0; | 
 | 	} | 
 | #endif | 
 |  | 
 | 	/* this is quite a hack, but I wanted to use the modedb and for | 
 | 	 * that we need fb_info and var, so we create dummy ones */ | 
 |  | 
 | 	*bpp = 0; | 
 | 	fbi = NULL; | 
 | 	var = NULL; | 
 | 	fbops = NULL; | 
 |  | 
 | 	fbi = kzalloc(sizeof(*fbi), GFP_KERNEL); | 
 | 	if (fbi == NULL) { | 
 | 		r = -ENOMEM; | 
 | 		goto err; | 
 | 	} | 
 |  | 
 | 	var = kzalloc(sizeof(*var), GFP_KERNEL); | 
 | 	if (var == NULL) { | 
 | 		r = -ENOMEM; | 
 | 		goto err; | 
 | 	} | 
 |  | 
 | 	fbops = kzalloc(sizeof(*fbops), GFP_KERNEL); | 
 | 	if (fbops == NULL) { | 
 | 		r = -ENOMEM; | 
 | 		goto err; | 
 | 	} | 
 |  | 
 | 	fbi->fbops = fbops; | 
 |  | 
 | 	r = fb_find_mode(var, fbi, mode_str, NULL, 0, NULL, 24); | 
 | 	if (r == 0) { | 
 | 		r = -EINVAL; | 
 | 		goto err; | 
 | 	} | 
 |  | 
 | 	timings->pixel_clock = PICOS2KHZ(var->pixclock); | 
 | 	timings->hbp = var->left_margin; | 
 | 	timings->hfp = var->right_margin; | 
 | 	timings->vbp = var->upper_margin; | 
 | 	timings->vfp = var->lower_margin; | 
 | 	timings->hsw = var->hsync_len; | 
 | 	timings->vsw = var->vsync_len; | 
 | 	timings->x_res = var->xres; | 
 | 	timings->y_res = var->yres; | 
 |  | 
 | 	switch (var->bits_per_pixel) { | 
 | 	case 16: | 
 | 		*bpp = 16; | 
 | 		break; | 
 | 	case 24: | 
 | 	case 32: | 
 | 	default: | 
 | 		*bpp = 24; | 
 | 		break; | 
 | 	} | 
 |  | 
 | 	r = 0; | 
 |  | 
 | err: | 
 | 	kfree(fbi); | 
 | 	kfree(var); | 
 | 	kfree(fbops); | 
 |  | 
 | 	return r; | 
 | } | 
 |  | 
 | static int omapfb_set_def_mode(struct omapfb2_device *fbdev, | 
 | 		struct omap_dss_device *display, char *mode_str) | 
 | { | 
 | 	int r; | 
 | 	u8 bpp; | 
 | 	struct omap_video_timings timings, temp_timings; | 
 | 	struct omapfb_display_data *d; | 
 |  | 
 | 	r = omapfb_mode_to_timings(mode_str, &timings, &bpp); | 
 | 	if (r) | 
 | 		return r; | 
 |  | 
 | 	d = get_display_data(fbdev, display); | 
 | 	d->bpp_override = bpp; | 
 |  | 
 | 	if (display->driver->check_timings) { | 
 | 		r = display->driver->check_timings(display, &timings); | 
 | 		if (r) | 
 | 			return r; | 
 | 	} else { | 
 | 		/* If check_timings is not present compare xres and yres */ | 
 | 		if (display->driver->get_timings) { | 
 | 			display->driver->get_timings(display, &temp_timings); | 
 |  | 
 | 			if (temp_timings.x_res != timings.x_res || | 
 | 				temp_timings.y_res != timings.y_res) | 
 | 				return -EINVAL; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	if (display->driver->set_timings) | 
 | 			display->driver->set_timings(display, &timings); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int omapfb_get_recommended_bpp(struct omapfb2_device *fbdev, | 
 | 		struct omap_dss_device *dssdev) | 
 | { | 
 | 	struct omapfb_display_data *d; | 
 |  | 
 | 	BUG_ON(dssdev->driver->get_recommended_bpp == NULL); | 
 |  | 
 | 	d = get_display_data(fbdev, dssdev); | 
 |  | 
 | 	if (d->bpp_override != 0) | 
 | 		return d->bpp_override; | 
 |  | 
 | 	return dssdev->driver->get_recommended_bpp(dssdev); | 
 | } | 
 |  | 
 | static int omapfb_parse_def_modes(struct omapfb2_device *fbdev) | 
 | { | 
 | 	char *str, *options, *this_opt; | 
 | 	int r = 0; | 
 |  | 
 | 	str = kstrdup(def_mode, GFP_KERNEL); | 
 | 	if (!str) | 
 | 		return -ENOMEM; | 
 | 	options = str; | 
 |  | 
 | 	while (!r && (this_opt = strsep(&options, ",")) != NULL) { | 
 | 		char *p, *display_str, *mode_str; | 
 | 		struct omap_dss_device *display; | 
 | 		int i; | 
 |  | 
 | 		p = strchr(this_opt, ':'); | 
 | 		if (!p) { | 
 | 			r = -EINVAL; | 
 | 			break; | 
 | 		} | 
 |  | 
 | 		*p = 0; | 
 | 		display_str = this_opt; | 
 | 		mode_str = p + 1; | 
 |  | 
 | 		display = NULL; | 
 | 		for (i = 0; i < fbdev->num_displays; ++i) { | 
 | 			if (strcmp(fbdev->displays[i].dssdev->name, | 
 | 						display_str) == 0) { | 
 | 				display = fbdev->displays[i].dssdev; | 
 | 				break; | 
 | 			} | 
 | 		} | 
 |  | 
 | 		if (!display) { | 
 | 			r = -EINVAL; | 
 | 			break; | 
 | 		} | 
 |  | 
 | 		r = omapfb_set_def_mode(fbdev, display, mode_str); | 
 | 		if (r) | 
 | 			break; | 
 | 	} | 
 |  | 
 | 	kfree(str); | 
 |  | 
 | 	return r; | 
 | } | 
 |  | 
 | static void fb_videomode_to_omap_timings(struct fb_videomode *m, | 
 | 		struct omap_video_timings *t) | 
 | { | 
 | 	t->x_res = m->xres; | 
 | 	t->y_res = m->yres; | 
 | 	t->pixel_clock = PICOS2KHZ(m->pixclock); | 
 | 	t->hsw = m->hsync_len; | 
 | 	t->hfp = m->right_margin; | 
 | 	t->hbp = m->left_margin; | 
 | 	t->vsw = m->vsync_len; | 
 | 	t->vfp = m->lower_margin; | 
 | 	t->vbp = m->upper_margin; | 
 | } | 
 |  | 
 | static int omapfb_find_best_mode(struct omap_dss_device *display, | 
 | 		struct omap_video_timings *timings) | 
 | { | 
 | 	struct fb_monspecs *specs; | 
 | 	u8 *edid; | 
 | 	int r, i, best_xres, best_idx, len; | 
 |  | 
 | 	if (!display->driver->read_edid) | 
 | 		return -ENODEV; | 
 |  | 
 | 	len = 0x80 * 2; | 
 | 	edid = kmalloc(len, GFP_KERNEL); | 
 |  | 
 | 	r = display->driver->read_edid(display, edid, len); | 
 | 	if (r < 0) | 
 | 		goto err1; | 
 |  | 
 | 	specs = kzalloc(sizeof(*specs), GFP_KERNEL); | 
 |  | 
 | 	fb_edid_to_monspecs(edid, specs); | 
 |  | 
 | 	if (edid[126] > 0) | 
 | 		fb_edid_add_monspecs(edid + 0x80, specs); | 
 |  | 
 | 	best_xres = 0; | 
 | 	best_idx = -1; | 
 |  | 
 | 	for (i = 0; i < specs->modedb_len; ++i) { | 
 | 		struct fb_videomode *m; | 
 | 		struct omap_video_timings t; | 
 |  | 
 | 		m = &specs->modedb[i]; | 
 |  | 
 | 		if (m->pixclock == 0) | 
 | 			continue; | 
 |  | 
 | 		/* skip repeated pixel modes */ | 
 | 		if (m->xres == 2880 || m->xres == 1440) | 
 | 			continue; | 
 |  | 
 | 		fb_videomode_to_omap_timings(m, &t); | 
 |  | 
 | 		r = display->driver->check_timings(display, &t); | 
 | 		if (r == 0 && best_xres < m->xres) { | 
 | 			best_xres = m->xres; | 
 | 			best_idx = i; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	if (best_xres == 0) { | 
 | 		r = -ENOENT; | 
 | 		goto err2; | 
 | 	} | 
 |  | 
 | 	fb_videomode_to_omap_timings(&specs->modedb[best_idx], timings); | 
 |  | 
 | 	r = 0; | 
 |  | 
 | err2: | 
 | 	fb_destroy_modedb(specs->modedb); | 
 | 	kfree(specs); | 
 | err1: | 
 | 	kfree(edid); | 
 |  | 
 | 	return r; | 
 | } | 
 |  | 
 | static int omapfb_init_display(struct omapfb2_device *fbdev, | 
 | 		struct omap_dss_device *dssdev) | 
 | { | 
 | 	struct omap_dss_driver *dssdrv = dssdev->driver; | 
 | 	struct omapfb_display_data *d; | 
 | 	int r; | 
 |  | 
 | 	r = dssdrv->enable(dssdev); | 
 | 	if (r) { | 
 | 		dev_warn(fbdev->dev, "Failed to enable display '%s'\n", | 
 | 				dssdev->name); | 
 | 		return r; | 
 | 	} | 
 |  | 
 | 	d = get_display_data(fbdev, dssdev); | 
 |  | 
 | 	d->fbdev = fbdev; | 
 |  | 
 | 	if (dssdev->caps & OMAP_DSS_DISPLAY_CAP_MANUAL_UPDATE) { | 
 | 		u16 w, h; | 
 |  | 
 | 		if (auto_update) { | 
 | 			omapfb_start_auto_update(fbdev, dssdev); | 
 | 			d->update_mode = OMAPFB_AUTO_UPDATE; | 
 | 		} else { | 
 | 			d->update_mode = OMAPFB_MANUAL_UPDATE; | 
 | 		} | 
 |  | 
 | 		if (dssdrv->enable_te) { | 
 | 			r = dssdrv->enable_te(dssdev, 1); | 
 | 			if (r) { | 
 | 				dev_err(fbdev->dev, "Failed to set TE\n"); | 
 | 				return r; | 
 | 			} | 
 | 		} | 
 |  | 
 | 		dssdrv->get_resolution(dssdev, &w, &h); | 
 | 		r = dssdrv->update(dssdev, 0, 0, w, h); | 
 | 		if (r) { | 
 | 			dev_err(fbdev->dev, | 
 | 					"Failed to update display\n"); | 
 | 			return r; | 
 | 		} | 
 | 	} else { | 
 | 		d->update_mode = OMAPFB_AUTO_UPDATE; | 
 | 	} | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int __init omapfb_probe(struct platform_device *pdev) | 
 | { | 
 | 	struct omapfb2_device *fbdev = NULL; | 
 | 	int r = 0; | 
 | 	int i; | 
 | 	struct omap_overlay *ovl; | 
 | 	struct omap_dss_device *def_display; | 
 | 	struct omap_dss_device *dssdev; | 
 |  | 
 | 	DBG("omapfb_probe\n"); | 
 |  | 
 | 	if (pdev->num_resources != 0) { | 
 | 		dev_err(&pdev->dev, "probed for an unknown device\n"); | 
 | 		r = -ENODEV; | 
 | 		goto err0; | 
 | 	} | 
 |  | 
 | 	fbdev = kzalloc(sizeof(struct omapfb2_device), GFP_KERNEL); | 
 | 	if (fbdev == NULL) { | 
 | 		r = -ENOMEM; | 
 | 		goto err0; | 
 | 	} | 
 |  | 
 | 	/* TODO : Replace cpu check with omap_has_vrfb once HAS_FEATURE | 
 | 	*	 available for OMAP2 and OMAP3 | 
 | 	*/ | 
 | 	if (def_vrfb && !cpu_is_omap24xx() && !cpu_is_omap34xx()) { | 
 | 		def_vrfb = 0; | 
 | 		dev_warn(&pdev->dev, "VRFB is not supported on this hardware, " | 
 | 				"ignoring the module parameter vrfb=y\n"); | 
 | 	} | 
 |  | 
 |  | 
 | 	mutex_init(&fbdev->mtx); | 
 |  | 
 | 	fbdev->dev = &pdev->dev; | 
 | 	platform_set_drvdata(pdev, fbdev); | 
 |  | 
 | 	r = 0; | 
 | 	fbdev->num_displays = 0; | 
 | 	dssdev = NULL; | 
 | 	for_each_dss_dev(dssdev) { | 
 | 		struct omapfb_display_data *d; | 
 |  | 
 | 		omap_dss_get_device(dssdev); | 
 |  | 
 | 		if (!dssdev->driver) { | 
 | 			dev_warn(&pdev->dev, "no driver for display: %s\n", | 
 | 				dssdev->name); | 
 | 			omap_dss_put_device(dssdev); | 
 | 			continue; | 
 | 		} | 
 |  | 
 | 		d = &fbdev->displays[fbdev->num_displays++]; | 
 | 		d->dssdev = dssdev; | 
 | 		if (dssdev->caps & OMAP_DSS_DISPLAY_CAP_MANUAL_UPDATE) | 
 | 			d->update_mode = OMAPFB_MANUAL_UPDATE; | 
 | 		else | 
 | 			d->update_mode = OMAPFB_AUTO_UPDATE; | 
 | 	} | 
 |  | 
 | 	if (r) | 
 | 		goto cleanup; | 
 |  | 
 | 	if (fbdev->num_displays == 0) { | 
 | 		dev_err(&pdev->dev, "no displays\n"); | 
 | 		r = -EINVAL; | 
 | 		goto cleanup; | 
 | 	} | 
 |  | 
 | 	fbdev->num_overlays = omap_dss_get_num_overlays(); | 
 | 	for (i = 0; i < fbdev->num_overlays; i++) | 
 | 		fbdev->overlays[i] = omap_dss_get_overlay(i); | 
 |  | 
 | 	fbdev->num_managers = omap_dss_get_num_overlay_managers(); | 
 | 	for (i = 0; i < fbdev->num_managers; i++) | 
 | 		fbdev->managers[i] = omap_dss_get_overlay_manager(i); | 
 |  | 
 | 	/* gfx overlay should be the default one. find a display | 
 | 	 * connected to that, and use it as default display */ | 
 | 	ovl = omap_dss_get_overlay(0); | 
 | 	if (ovl->manager && ovl->manager->device) { | 
 | 		def_display = ovl->manager->device; | 
 | 	} else { | 
 | 		dev_warn(&pdev->dev, "cannot find default display\n"); | 
 | 		def_display = NULL; | 
 | 	} | 
 |  | 
 | 	if (def_mode && strlen(def_mode) > 0) { | 
 | 		if (omapfb_parse_def_modes(fbdev)) | 
 | 			dev_warn(&pdev->dev, "cannot parse default modes\n"); | 
 | 	} else if (def_display && def_display->driver->set_timings && | 
 | 			def_display->driver->check_timings) { | 
 | 		struct omap_video_timings t; | 
 |  | 
 | 		r = omapfb_find_best_mode(def_display, &t); | 
 |  | 
 | 		if (r == 0) | 
 | 			def_display->driver->set_timings(def_display, &t); | 
 | 	} | 
 |  | 
 | 	r = omapfb_create_framebuffers(fbdev); | 
 | 	if (r) | 
 | 		goto cleanup; | 
 |  | 
 | 	for (i = 0; i < fbdev->num_managers; i++) { | 
 | 		struct omap_overlay_manager *mgr; | 
 | 		mgr = fbdev->managers[i]; | 
 | 		r = mgr->apply(mgr); | 
 | 		if (r) | 
 | 			dev_warn(fbdev->dev, "failed to apply dispc config\n"); | 
 | 	} | 
 |  | 
 | 	DBG("mgr->apply'ed\n"); | 
 |  | 
 | 	if (def_display) { | 
 | 		r = omapfb_init_display(fbdev, def_display); | 
 | 		if (r) { | 
 | 			dev_err(fbdev->dev, | 
 | 					"failed to initialize default " | 
 | 					"display\n"); | 
 | 			goto cleanup; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	DBG("create sysfs for fbs\n"); | 
 | 	r = omapfb_create_sysfs(fbdev); | 
 | 	if (r) { | 
 | 		dev_err(fbdev->dev, "failed to create sysfs entries\n"); | 
 | 		goto cleanup; | 
 | 	} | 
 |  | 
 | 	return 0; | 
 |  | 
 | cleanup: | 
 | 	omapfb_free_resources(fbdev); | 
 | err0: | 
 | 	dev_err(&pdev->dev, "failed to setup omapfb\n"); | 
 | 	return r; | 
 | } | 
 |  | 
 | static int __exit omapfb_remove(struct platform_device *pdev) | 
 | { | 
 | 	struct omapfb2_device *fbdev = platform_get_drvdata(pdev); | 
 |  | 
 | 	/* FIXME: wait till completion of pending events */ | 
 |  | 
 | 	omapfb_remove_sysfs(fbdev); | 
 |  | 
 | 	omapfb_free_resources(fbdev); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static struct platform_driver omapfb_driver = { | 
 | 	.remove         = __exit_p(omapfb_remove), | 
 | 	.driver         = { | 
 | 		.name   = "omapfb", | 
 | 		.owner  = THIS_MODULE, | 
 | 	}, | 
 | }; | 
 |  | 
 | static int __init omapfb_init(void) | 
 | { | 
 | 	DBG("omapfb_init\n"); | 
 |  | 
 | 	if (platform_driver_probe(&omapfb_driver, omapfb_probe)) { | 
 | 		printk(KERN_ERR "failed to register omapfb driver\n"); | 
 | 		return -ENODEV; | 
 | 	} | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static void __exit omapfb_exit(void) | 
 | { | 
 | 	DBG("omapfb_exit\n"); | 
 | 	platform_driver_unregister(&omapfb_driver); | 
 | } | 
 |  | 
 | module_param_named(mode, def_mode, charp, 0); | 
 | module_param_named(vram, def_vram, charp, 0); | 
 | module_param_named(rotate, def_rotate, int, 0); | 
 | module_param_named(vrfb, def_vrfb, bool, 0); | 
 | module_param_named(mirror, def_mirror, bool, 0); | 
 |  | 
 | /* late_initcall to let panel/ctrl drivers loaded first. | 
 |  * I guess better option would be a more dynamic approach, | 
 |  * so that omapfb reacts to new panels when they are loaded */ | 
 | late_initcall(omapfb_init); | 
 | /*module_init(omapfb_init);*/ | 
 | module_exit(omapfb_exit); | 
 |  | 
 | MODULE_AUTHOR("Tomi Valkeinen <tomi.valkeinen@nokia.com>"); | 
 | MODULE_DESCRIPTION("OMAP2/3 Framebuffer"); | 
 | MODULE_LICENSE("GPL v2"); |