mirror of
https://github.com/FEX-Emu/linux.git
synced 2024-12-30 05:15:03 +00:00
cd354f1ae7
After Al Viro (finally) succeeded in removing the sched.h #include in module.h recently, it makes sense again to remove other superfluous sched.h includes. There are quite a lot of files which include it but don't actually need anything defined in there. Presumably these includes were once needed for macros that used to live in sched.h, but moved to other header files in the course of cleaning it up. To ease the pain, this time I did not fiddle with any header files and only removed #includes from .c-files, which tend to cause less trouble. Compile tested against 2.6.20-rc2 and 2.6.20-rc2-mm2 (with offsets) on alpha, arm, i386, ia64, mips, powerpc, and x86_64 with allnoconfig, defconfig, allmodconfig, and allyesconfig as well as a few randconfigs on x86_64 and all configs in arch/arm/configs on arm. I also checked that no new warnings were introduced by the patch (actually, some warnings are removed that were emitted by unnecessarily included header files). Signed-off-by: Tim Schmielau <tim@physik3.uni-rostock.de> Acked-by: Russell King <rmk+kernel@arm.linux.org.uk> Signed-off-by: Andrew Morton <akpm@linux-foundation.org> Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
689 lines
17 KiB
C
689 lines
17 KiB
C
/*
|
|
* linux/drivers/video/imxfb.c
|
|
*
|
|
* Freescale i.MX Frame Buffer device driver
|
|
*
|
|
* Copyright (C) 2004 Sascha Hauer, Pengutronix
|
|
* Based on acornfb.c Copyright (C) Russell King.
|
|
*
|
|
* This file is subject to the terms and conditions of the GNU General Public
|
|
* License. See the file COPYING in the main directory of this archive for
|
|
* more details.
|
|
*
|
|
* Please direct your questions and comments on this driver to the following
|
|
* email address:
|
|
*
|
|
* linux-arm-kernel@lists.arm.linux.org.uk
|
|
*/
|
|
|
|
//#define DEBUG 1
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/string.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/fb.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/init.h>
|
|
#include <linux/ioport.h>
|
|
#include <linux/cpufreq.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/dma-mapping.h>
|
|
|
|
#include <asm/hardware.h>
|
|
#include <asm/io.h>
|
|
#include <asm/uaccess.h>
|
|
#include <asm/arch/imxfb.h>
|
|
|
|
/*
|
|
* Complain if VAR is out of range.
|
|
*/
|
|
#define DEBUG_VAR 1
|
|
|
|
#include "imxfb.h"
|
|
|
|
static struct imxfb_rgb def_rgb_16 = {
|
|
.red = { .offset = 8, .length = 4, },
|
|
.green = { .offset = 4, .length = 4, },
|
|
.blue = { .offset = 0, .length = 4, },
|
|
.transp = { .offset = 0, .length = 0, },
|
|
};
|
|
|
|
static struct imxfb_rgb def_rgb_8 = {
|
|
.red = { .offset = 0, .length = 8, },
|
|
.green = { .offset = 0, .length = 8, },
|
|
.blue = { .offset = 0, .length = 8, },
|
|
.transp = { .offset = 0, .length = 0, },
|
|
};
|
|
|
|
static int imxfb_activate_var(struct fb_var_screeninfo *var, struct fb_info *info);
|
|
|
|
static inline u_int chan_to_field(u_int chan, struct fb_bitfield *bf)
|
|
{
|
|
chan &= 0xffff;
|
|
chan >>= 16 - bf->length;
|
|
return chan << bf->offset;
|
|
}
|
|
|
|
#define LCDC_PALETTE(x) __REG2(IMX_LCDC_BASE+0x800, (x)<<2)
|
|
static int
|
|
imxfb_setpalettereg(u_int regno, u_int red, u_int green, u_int blue,
|
|
u_int trans, struct fb_info *info)
|
|
{
|
|
struct imxfb_info *fbi = info->par;
|
|
u_int val, ret = 1;
|
|
|
|
#define CNVT_TOHW(val,width) ((((val)<<(width))+0x7FFF-(val))>>16)
|
|
if (regno < fbi->palette_size) {
|
|
val = (CNVT_TOHW(red, 4) << 8) |
|
|
(CNVT_TOHW(green,4) << 4) |
|
|
CNVT_TOHW(blue, 4);
|
|
|
|
LCDC_PALETTE(regno) = val;
|
|
ret = 0;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
static int
|
|
imxfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
|
|
u_int trans, struct fb_info *info)
|
|
{
|
|
struct imxfb_info *fbi = info->par;
|
|
unsigned int val;
|
|
int ret = 1;
|
|
|
|
/*
|
|
* If inverse mode was selected, invert all the colours
|
|
* rather than the register number. The register number
|
|
* is what you poke into the framebuffer to produce the
|
|
* colour you requested.
|
|
*/
|
|
if (fbi->cmap_inverse) {
|
|
red = 0xffff - red;
|
|
green = 0xffff - green;
|
|
blue = 0xffff - blue;
|
|
}
|
|
|
|
/*
|
|
* If greyscale is true, then we convert the RGB value
|
|
* to greyscale no mater what visual we are using.
|
|
*/
|
|
if (info->var.grayscale)
|
|
red = green = blue = (19595 * red + 38470 * green +
|
|
7471 * blue) >> 16;
|
|
|
|
switch (info->fix.visual) {
|
|
case FB_VISUAL_TRUECOLOR:
|
|
/*
|
|
* 12 or 16-bit True Colour. We encode the RGB value
|
|
* according to the RGB bitfield information.
|
|
*/
|
|
if (regno < 16) {
|
|
u32 *pal = info->pseudo_palette;
|
|
|
|
val = chan_to_field(red, &info->var.red);
|
|
val |= chan_to_field(green, &info->var.green);
|
|
val |= chan_to_field(blue, &info->var.blue);
|
|
|
|
pal[regno] = val;
|
|
ret = 0;
|
|
}
|
|
break;
|
|
|
|
case FB_VISUAL_STATIC_PSEUDOCOLOR:
|
|
case FB_VISUAL_PSEUDOCOLOR:
|
|
ret = imxfb_setpalettereg(regno, red, green, blue, trans, info);
|
|
break;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
/*
|
|
* imxfb_check_var():
|
|
* Round up in the following order: bits_per_pixel, xres,
|
|
* yres, xres_virtual, yres_virtual, xoffset, yoffset, grayscale,
|
|
* bitfields, horizontal timing, vertical timing.
|
|
*/
|
|
static int
|
|
imxfb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
|
|
{
|
|
struct imxfb_info *fbi = info->par;
|
|
int rgbidx;
|
|
|
|
if (var->xres < MIN_XRES)
|
|
var->xres = MIN_XRES;
|
|
if (var->yres < MIN_YRES)
|
|
var->yres = MIN_YRES;
|
|
if (var->xres > fbi->max_xres)
|
|
var->xres = fbi->max_xres;
|
|
if (var->yres > fbi->max_yres)
|
|
var->yres = fbi->max_yres;
|
|
var->xres_virtual = max(var->xres_virtual, var->xres);
|
|
var->yres_virtual = max(var->yres_virtual, var->yres);
|
|
|
|
pr_debug("var->bits_per_pixel=%d\n", var->bits_per_pixel);
|
|
switch (var->bits_per_pixel) {
|
|
case 16:
|
|
rgbidx = RGB_16;
|
|
break;
|
|
case 8:
|
|
rgbidx = RGB_8;
|
|
break;
|
|
default:
|
|
rgbidx = RGB_16;
|
|
}
|
|
|
|
/*
|
|
* Copy the RGB parameters for this display
|
|
* from the machine specific parameters.
|
|
*/
|
|
var->red = fbi->rgb[rgbidx]->red;
|
|
var->green = fbi->rgb[rgbidx]->green;
|
|
var->blue = fbi->rgb[rgbidx]->blue;
|
|
var->transp = fbi->rgb[rgbidx]->transp;
|
|
|
|
pr_debug("RGBT length = %d:%d:%d:%d\n",
|
|
var->red.length, var->green.length, var->blue.length,
|
|
var->transp.length);
|
|
|
|
pr_debug("RGBT offset = %d:%d:%d:%d\n",
|
|
var->red.offset, var->green.offset, var->blue.offset,
|
|
var->transp.offset);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* imxfb_set_par():
|
|
* Set the user defined part of the display for the specified console
|
|
*/
|
|
static int imxfb_set_par(struct fb_info *info)
|
|
{
|
|
struct imxfb_info *fbi = info->par;
|
|
struct fb_var_screeninfo *var = &info->var;
|
|
|
|
pr_debug("set_par\n");
|
|
|
|
if (var->bits_per_pixel == 16)
|
|
info->fix.visual = FB_VISUAL_TRUECOLOR;
|
|
else if (!fbi->cmap_static)
|
|
info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
|
|
else {
|
|
/*
|
|
* Some people have weird ideas about wanting static
|
|
* pseudocolor maps. I suspect their user space
|
|
* applications are broken.
|
|
*/
|
|
info->fix.visual = FB_VISUAL_STATIC_PSEUDOCOLOR;
|
|
}
|
|
|
|
info->fix.line_length = var->xres_virtual *
|
|
var->bits_per_pixel / 8;
|
|
fbi->palette_size = var->bits_per_pixel == 8 ? 256 : 16;
|
|
|
|
imxfb_activate_var(var, info);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void imxfb_enable_controller(struct imxfb_info *fbi)
|
|
{
|
|
pr_debug("Enabling LCD controller\n");
|
|
|
|
/* initialize LCDC */
|
|
LCDC_RMCR &= ~RMCR_LCDC_EN; /* just to be safe... */
|
|
|
|
LCDC_SSA = fbi->screen_dma;
|
|
/* physical screen start address */
|
|
LCDC_VPW = VPW_VPW(fbi->max_xres * fbi->max_bpp / 8 / 4);
|
|
|
|
LCDC_POS = 0x00000000; /* panning offset 0 (0 pixel offset) */
|
|
|
|
/* disable hardware cursor */
|
|
LCDC_CPOS &= ~(CPOS_CC0 | CPOS_CC1);
|
|
|
|
LCDC_RMCR = RMCR_LCDC_EN;
|
|
|
|
if(fbi->backlight_power)
|
|
fbi->backlight_power(1);
|
|
if(fbi->lcd_power)
|
|
fbi->lcd_power(1);
|
|
}
|
|
|
|
static void imxfb_disable_controller(struct imxfb_info *fbi)
|
|
{
|
|
pr_debug("Disabling LCD controller\n");
|
|
|
|
if(fbi->backlight_power)
|
|
fbi->backlight_power(0);
|
|
if(fbi->lcd_power)
|
|
fbi->lcd_power(0);
|
|
|
|
LCDC_RMCR = 0;
|
|
}
|
|
|
|
static int imxfb_blank(int blank, struct fb_info *info)
|
|
{
|
|
struct imxfb_info *fbi = info->par;
|
|
|
|
pr_debug("imxfb_blank: blank=%d\n", blank);
|
|
|
|
switch (blank) {
|
|
case FB_BLANK_POWERDOWN:
|
|
case FB_BLANK_VSYNC_SUSPEND:
|
|
case FB_BLANK_HSYNC_SUSPEND:
|
|
case FB_BLANK_NORMAL:
|
|
imxfb_disable_controller(fbi);
|
|
break;
|
|
|
|
case FB_BLANK_UNBLANK:
|
|
imxfb_enable_controller(fbi);
|
|
break;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static struct fb_ops imxfb_ops = {
|
|
.owner = THIS_MODULE,
|
|
.fb_check_var = imxfb_check_var,
|
|
.fb_set_par = imxfb_set_par,
|
|
.fb_setcolreg = imxfb_setcolreg,
|
|
.fb_fillrect = cfb_fillrect,
|
|
.fb_copyarea = cfb_copyarea,
|
|
.fb_imageblit = cfb_imageblit,
|
|
.fb_blank = imxfb_blank,
|
|
};
|
|
|
|
/*
|
|
* imxfb_activate_var():
|
|
* Configures LCD Controller based on entries in var parameter. Settings are
|
|
* only written to the controller if changes were made.
|
|
*/
|
|
static int imxfb_activate_var(struct fb_var_screeninfo *var, struct fb_info *info)
|
|
{
|
|
struct imxfb_info *fbi = info->par;
|
|
pr_debug("var: xres=%d hslen=%d lm=%d rm=%d\n",
|
|
var->xres, var->hsync_len,
|
|
var->left_margin, var->right_margin);
|
|
pr_debug("var: yres=%d vslen=%d um=%d bm=%d\n",
|
|
var->yres, var->vsync_len,
|
|
var->upper_margin, var->lower_margin);
|
|
|
|
#if DEBUG_VAR
|
|
if (var->xres < 16 || var->xres > 1024)
|
|
printk(KERN_ERR "%s: invalid xres %d\n",
|
|
info->fix.id, var->xres);
|
|
if (var->hsync_len < 1 || var->hsync_len > 64)
|
|
printk(KERN_ERR "%s: invalid hsync_len %d\n",
|
|
info->fix.id, var->hsync_len);
|
|
if (var->left_margin > 255)
|
|
printk(KERN_ERR "%s: invalid left_margin %d\n",
|
|
info->fix.id, var->left_margin);
|
|
if (var->right_margin > 255)
|
|
printk(KERN_ERR "%s: invalid right_margin %d\n",
|
|
info->fix.id, var->right_margin);
|
|
if (var->yres < 1 || var->yres > 511)
|
|
printk(KERN_ERR "%s: invalid yres %d\n",
|
|
info->fix.id, var->yres);
|
|
if (var->vsync_len > 100)
|
|
printk(KERN_ERR "%s: invalid vsync_len %d\n",
|
|
info->fix.id, var->vsync_len);
|
|
if (var->upper_margin > 63)
|
|
printk(KERN_ERR "%s: invalid upper_margin %d\n",
|
|
info->fix.id, var->upper_margin);
|
|
if (var->lower_margin > 255)
|
|
printk(KERN_ERR "%s: invalid lower_margin %d\n",
|
|
info->fix.id, var->lower_margin);
|
|
#endif
|
|
|
|
LCDC_HCR = HCR_H_WIDTH(var->hsync_len) |
|
|
HCR_H_WAIT_1(var->left_margin) |
|
|
HCR_H_WAIT_2(var->right_margin);
|
|
|
|
LCDC_VCR = VCR_V_WIDTH(var->vsync_len) |
|
|
VCR_V_WAIT_1(var->upper_margin) |
|
|
VCR_V_WAIT_2(var->lower_margin);
|
|
|
|
LCDC_SIZE = SIZE_XMAX(var->xres) | SIZE_YMAX(var->yres);
|
|
LCDC_PCR = fbi->pcr;
|
|
LCDC_PWMR = fbi->pwmr;
|
|
LCDC_LSCR1 = fbi->lscr1;
|
|
LCDC_DMACR = fbi->dmacr;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void imxfb_setup_gpio(struct imxfb_info *fbi)
|
|
{
|
|
int width;
|
|
|
|
LCDC_RMCR &= ~(RMCR_LCDC_EN | RMCR_SELF_REF);
|
|
|
|
if( fbi->pcr & PCR_TFT )
|
|
width = 16;
|
|
else
|
|
width = 1 << ((fbi->pcr >> 28) & 0x3);
|
|
|
|
switch(width) {
|
|
case 16:
|
|
imx_gpio_mode(PD30_PF_LD15);
|
|
imx_gpio_mode(PD29_PF_LD14);
|
|
imx_gpio_mode(PD28_PF_LD13);
|
|
imx_gpio_mode(PD27_PF_LD12);
|
|
imx_gpio_mode(PD26_PF_LD11);
|
|
imx_gpio_mode(PD25_PF_LD10);
|
|
imx_gpio_mode(PD24_PF_LD9);
|
|
imx_gpio_mode(PD23_PF_LD8);
|
|
case 8:
|
|
imx_gpio_mode(PD22_PF_LD7);
|
|
imx_gpio_mode(PD21_PF_LD6);
|
|
imx_gpio_mode(PD20_PF_LD5);
|
|
imx_gpio_mode(PD19_PF_LD4);
|
|
case 4:
|
|
imx_gpio_mode(PD18_PF_LD3);
|
|
imx_gpio_mode(PD17_PF_LD2);
|
|
case 2:
|
|
imx_gpio_mode(PD16_PF_LD1);
|
|
case 1:
|
|
imx_gpio_mode(PD15_PF_LD0);
|
|
}
|
|
|
|
/* initialize GPIOs */
|
|
imx_gpio_mode(PD6_PF_LSCLK);
|
|
imx_gpio_mode(PD10_PF_SPL_SPR);
|
|
imx_gpio_mode(PD11_PF_CONTRAST);
|
|
imx_gpio_mode(PD14_PF_FLM_VSYNC);
|
|
imx_gpio_mode(PD13_PF_LP_HSYNC);
|
|
imx_gpio_mode(PD7_PF_REV);
|
|
imx_gpio_mode(PD8_PF_CLS);
|
|
|
|
#ifndef CONFIG_MACH_PIMX1
|
|
/* on PiMX1 used as buffers enable signal
|
|
*/
|
|
imx_gpio_mode(PD9_PF_PS);
|
|
#endif
|
|
|
|
#ifndef CONFIG_MACH_MX1FS2
|
|
/* on mx1fs2 this pin is used to (de)activate the display, so we need
|
|
* it as a normal gpio
|
|
*/
|
|
imx_gpio_mode(PD12_PF_ACD_OE);
|
|
#endif
|
|
|
|
}
|
|
|
|
#ifdef CONFIG_PM
|
|
/*
|
|
* Power management hooks. Note that we won't be called from IRQ context,
|
|
* unlike the blank functions above, so we may sleep.
|
|
*/
|
|
static int imxfb_suspend(struct platform_device *dev, pm_message_t state)
|
|
{
|
|
struct imxfb_info *fbi = platform_get_drvdata(dev);
|
|
pr_debug("%s\n",__FUNCTION__);
|
|
|
|
imxfb_disable_controller(fbi);
|
|
return 0;
|
|
}
|
|
|
|
static int imxfb_resume(struct platform_device *dev)
|
|
{
|
|
struct imxfb_info *fbi = platform_get_drvdata(dev);
|
|
pr_debug("%s\n",__FUNCTION__);
|
|
|
|
imxfb_enable_controller(fbi);
|
|
return 0;
|
|
}
|
|
#else
|
|
#define imxfb_suspend NULL
|
|
#define imxfb_resume NULL
|
|
#endif
|
|
|
|
static int __init imxfb_init_fbinfo(struct device *dev)
|
|
{
|
|
struct imxfb_mach_info *inf = dev->platform_data;
|
|
struct fb_info *info = dev_get_drvdata(dev);
|
|
struct imxfb_info *fbi = info->par;
|
|
|
|
pr_debug("%s\n",__FUNCTION__);
|
|
|
|
info->pseudo_palette = kmalloc( sizeof(u32) * 16, GFP_KERNEL);
|
|
if (!info->pseudo_palette)
|
|
return -ENOMEM;
|
|
|
|
memset(fbi, 0, sizeof(struct imxfb_info));
|
|
fbi->dev = dev;
|
|
|
|
strlcpy(info->fix.id, IMX_NAME, sizeof(info->fix.id));
|
|
|
|
info->fix.type = FB_TYPE_PACKED_PIXELS;
|
|
info->fix.type_aux = 0;
|
|
info->fix.xpanstep = 0;
|
|
info->fix.ypanstep = 0;
|
|
info->fix.ywrapstep = 0;
|
|
info->fix.accel = FB_ACCEL_NONE;
|
|
|
|
info->var.nonstd = 0;
|
|
info->var.activate = FB_ACTIVATE_NOW;
|
|
info->var.height = -1;
|
|
info->var.width = -1;
|
|
info->var.accel_flags = 0;
|
|
info->var.vmode = FB_VMODE_NONINTERLACED;
|
|
|
|
info->fbops = &imxfb_ops;
|
|
info->flags = FBINFO_FLAG_DEFAULT;
|
|
info->pseudo_palette = (fbi + 1);
|
|
|
|
fbi->rgb[RGB_16] = &def_rgb_16;
|
|
fbi->rgb[RGB_8] = &def_rgb_8;
|
|
|
|
fbi->max_xres = inf->xres;
|
|
info->var.xres = inf->xres;
|
|
info->var.xres_virtual = inf->xres;
|
|
fbi->max_yres = inf->yres;
|
|
info->var.yres = inf->yres;
|
|
info->var.yres_virtual = inf->yres;
|
|
fbi->max_bpp = inf->bpp;
|
|
info->var.bits_per_pixel = inf->bpp;
|
|
info->var.pixclock = inf->pixclock;
|
|
info->var.hsync_len = inf->hsync_len;
|
|
info->var.left_margin = inf->left_margin;
|
|
info->var.right_margin = inf->right_margin;
|
|
info->var.vsync_len = inf->vsync_len;
|
|
info->var.upper_margin = inf->upper_margin;
|
|
info->var.lower_margin = inf->lower_margin;
|
|
info->var.sync = inf->sync;
|
|
info->var.grayscale = inf->cmap_greyscale;
|
|
fbi->cmap_inverse = inf->cmap_inverse;
|
|
fbi->pcr = inf->pcr;
|
|
fbi->lscr1 = inf->lscr1;
|
|
fbi->dmacr = inf->dmacr;
|
|
fbi->pwmr = inf->pwmr;
|
|
fbi->lcd_power = inf->lcd_power;
|
|
fbi->backlight_power = inf->backlight_power;
|
|
info->fix.smem_len = fbi->max_xres * fbi->max_yres *
|
|
fbi->max_bpp / 8;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* Allocates the DRAM memory for the frame buffer. This buffer is
|
|
* remapped into a non-cached, non-buffered, memory region to
|
|
* allow pixel writes to occur without flushing the cache.
|
|
* Once this area is remapped, all virtual memory access to the
|
|
* video memory should occur at the new region.
|
|
*/
|
|
static int __init imxfb_map_video_memory(struct fb_info *info)
|
|
{
|
|
struct imxfb_info *fbi = info->par;
|
|
|
|
fbi->map_size = PAGE_ALIGN(info->fix.smem_len);
|
|
fbi->map_cpu = dma_alloc_writecombine(fbi->dev, fbi->map_size,
|
|
&fbi->map_dma,GFP_KERNEL);
|
|
|
|
if (fbi->map_cpu) {
|
|
info->screen_base = fbi->map_cpu;
|
|
fbi->screen_cpu = fbi->map_cpu;
|
|
fbi->screen_dma = fbi->map_dma;
|
|
info->fix.smem_start = fbi->screen_dma;
|
|
}
|
|
|
|
return fbi->map_cpu ? 0 : -ENOMEM;
|
|
}
|
|
|
|
static int __init imxfb_probe(struct platform_device *pdev)
|
|
{
|
|
struct imxfb_info *fbi;
|
|
struct fb_info *info;
|
|
struct imxfb_mach_info *inf;
|
|
struct resource *res;
|
|
int ret;
|
|
|
|
printk("i.MX Framebuffer driver\n");
|
|
|
|
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
if(!res)
|
|
return -ENODEV;
|
|
|
|
inf = pdev->dev.platform_data;
|
|
if(!inf) {
|
|
dev_err(&pdev->dev,"No platform_data available\n");
|
|
return -ENOMEM;
|
|
}
|
|
|
|
info = framebuffer_alloc(sizeof(struct imxfb_info), &pdev->dev);
|
|
if(!info)
|
|
return -ENOMEM;
|
|
|
|
fbi = info->par;
|
|
|
|
platform_set_drvdata(pdev, info);
|
|
|
|
ret = imxfb_init_fbinfo(&pdev->dev);
|
|
if( ret < 0 )
|
|
goto failed_init;
|
|
|
|
res = request_mem_region(res->start, res->end - res->start + 1, "IMXFB");
|
|
if (!res) {
|
|
ret = -EBUSY;
|
|
goto failed_regs;
|
|
}
|
|
|
|
if (!inf->fixed_screen_cpu) {
|
|
ret = imxfb_map_video_memory(info);
|
|
if (ret) {
|
|
dev_err(&pdev->dev, "Failed to allocate video RAM: %d\n", ret);
|
|
ret = -ENOMEM;
|
|
goto failed_map;
|
|
}
|
|
} else {
|
|
/* Fixed framebuffer mapping enables location of the screen in eSRAM */
|
|
fbi->map_cpu = inf->fixed_screen_cpu;
|
|
fbi->map_dma = inf->fixed_screen_dma;
|
|
info->screen_base = fbi->map_cpu;
|
|
fbi->screen_cpu = fbi->map_cpu;
|
|
fbi->screen_dma = fbi->map_dma;
|
|
info->fix.smem_start = fbi->screen_dma;
|
|
}
|
|
|
|
/*
|
|
* This makes sure that our colour bitfield
|
|
* descriptors are correctly initialised.
|
|
*/
|
|
imxfb_check_var(&info->var, info);
|
|
|
|
ret = fb_alloc_cmap(&info->cmap, 1<<info->var.bits_per_pixel, 0);
|
|
if (ret < 0)
|
|
goto failed_cmap;
|
|
|
|
imxfb_setup_gpio(fbi);
|
|
|
|
imxfb_set_par(info);
|
|
ret = register_framebuffer(info);
|
|
if (ret < 0) {
|
|
dev_err(&pdev->dev, "failed to register framebuffer\n");
|
|
goto failed_register;
|
|
}
|
|
|
|
imxfb_enable_controller(fbi);
|
|
|
|
return 0;
|
|
|
|
failed_register:
|
|
fb_dealloc_cmap(&info->cmap);
|
|
failed_cmap:
|
|
if (!inf->fixed_screen_cpu)
|
|
dma_free_writecombine(&pdev->dev,fbi->map_size,fbi->map_cpu,
|
|
fbi->map_dma);
|
|
failed_map:
|
|
kfree(info->pseudo_palette);
|
|
failed_regs:
|
|
release_mem_region(res->start, res->end - res->start);
|
|
failed_init:
|
|
platform_set_drvdata(pdev, NULL);
|
|
framebuffer_release(info);
|
|
return ret;
|
|
}
|
|
|
|
static int imxfb_remove(struct platform_device *pdev)
|
|
{
|
|
struct fb_info *info = platform_get_drvdata(pdev);
|
|
struct imxfb_info *fbi = info->par;
|
|
struct resource *res;
|
|
|
|
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
|
|
imxfb_disable_controller(fbi);
|
|
|
|
unregister_framebuffer(info);
|
|
|
|
fb_dealloc_cmap(&info->cmap);
|
|
kfree(info->pseudo_palette);
|
|
framebuffer_release(info);
|
|
|
|
release_mem_region(res->start, res->end - res->start + 1);
|
|
platform_set_drvdata(pdev, NULL);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void imxfb_shutdown(struct platform_device * dev)
|
|
{
|
|
struct fb_info *info = platform_get_drvdata(dev);
|
|
struct imxfb_info *fbi = info->par;
|
|
imxfb_disable_controller(fbi);
|
|
}
|
|
|
|
static struct platform_driver imxfb_driver = {
|
|
.probe = imxfb_probe,
|
|
.suspend = imxfb_suspend,
|
|
.resume = imxfb_resume,
|
|
.remove = imxfb_remove,
|
|
.shutdown = imxfb_shutdown,
|
|
.driver = {
|
|
.name = "imx-fb",
|
|
},
|
|
};
|
|
|
|
int __init imxfb_init(void)
|
|
{
|
|
return platform_driver_register(&imxfb_driver);
|
|
}
|
|
|
|
static void __exit imxfb_cleanup(void)
|
|
{
|
|
platform_driver_unregister(&imxfb_driver);
|
|
}
|
|
|
|
module_init(imxfb_init);
|
|
module_exit(imxfb_cleanup);
|
|
|
|
MODULE_DESCRIPTION("Motorola i.MX framebuffer driver");
|
|
MODULE_AUTHOR("Sascha Hauer, Pengutronix");
|
|
MODULE_LICENSE("GPL");
|