/* * Framebuffer driver for EFI/UEFI based system * * (c) 2006 Edgar Hucek <gimli@dark-green.com> * Original efi driver written by Gerd Knorr <kraxel@goldbach.in-berlin.de> * */ #include <linux/module.h> #include <linux/kernel.h> #include <linux/errno.h> #include <linux/fb.h> #include <linux/platform_device.h> #include <linux/screen_info.h> #include <video/vga.h> static struct fb_var_screeninfo efifb_defined __initdata = { .activate = FB_ACTIVATE_NOW, .height = -1, .width = -1, .right_margin = 32, .upper_margin = 16, .lower_margin = 4, .vsync_len = 4, .vmode = FB_VMODE_NONINTERLACED, }; static struct fb_fix_screeninfo efifb_fix __initdata = { .id = "EFI VGA", .type = FB_TYPE_PACKED_PIXELS, .accel = FB_ACCEL_NONE, .visual = FB_VISUAL_TRUECOLOR, }; static int efifb_setcolreg(unsigned regno, unsigned red, unsigned green, unsigned blue, unsigned transp, struct fb_info *info) { /* * Set a single color register. The values supplied are * already rounded down to the hardware's capabilities * (according to the entries in the `var' structure). Return * != 0 for invalid regno. */ if (regno >= info->cmap.len) return 1; if (regno < 16) { red >>= 8; green >>= 8; blue >>= 8; ((u32 *)(info->pseudo_palette))[regno] = (red << info->var.red.offset) | (green << info->var.green.offset) | (blue << info->var.blue.offset); } return 0; } static struct fb_ops efifb_ops = { .owner = THIS_MODULE, .fb_setcolreg = efifb_setcolreg, .fb_fillrect = cfb_fillrect, .fb_copyarea = cfb_copyarea, .fb_imageblit = cfb_imageblit, }; static int __init efifb_probe(struct platform_device *dev) { struct fb_info *info; int err; unsigned int size_vmode; unsigned int size_remap; unsigned int size_total; efifb_fix.smem_start = screen_info.lfb_base; efifb_defined.bits_per_pixel = screen_info.lfb_depth; efifb_defined.xres = screen_info.lfb_width; efifb_defined.yres = screen_info.lfb_height; efifb_fix.line_length = screen_info.lfb_linelength; /* size_vmode -- that is the amount of memory needed for the * used video mode, i.e. the minimum amount of * memory we need. */ size_vmode = efifb_defined.yres * efifb_fix.line_length; /* size_total -- all video memory we have. Used for * entries, ressource allocation and bounds * checking. */ size_total = screen_info.lfb_size; if (size_total < size_vmode) size_total = size_vmode; /* size_remap -- the amount of video memory we are going to * use for efifb. With modern cards it is no * option to simply use size_total as that * wastes plenty of kernel address space. */ size_remap = size_vmode * 2; if (size_remap < size_vmode) size_remap = size_vmode; if (size_remap > size_total) size_remap = size_total; efifb_fix.smem_len = size_remap; if (!request_mem_region(efifb_fix.smem_start, size_total, "efifb")) /* We cannot make this fatal. Sometimes this comes from magic spaces our resource handlers simply don't know about */ printk(KERN_WARNING "efifb: cannot reserve video memory at 0x%lx\n", efifb_fix.smem_start); info = framebuffer_alloc(sizeof(u32) * 16, &dev->dev); if (!info) { err = -ENOMEM; goto err_release_mem; } info->pseudo_palette = info->par; info->par = NULL; info->screen_base = ioremap(efifb_fix.smem_start, efifb_fix.smem_len); if (!info->screen_base) { printk(KERN_ERR "efifb: abort, cannot ioremap video memory " "0x%x @ 0x%lx\n", efifb_fix.smem_len, efifb_fix.smem_start); err = -EIO; goto err_unmap; } printk(KERN_INFO "efifb: framebuffer at 0x%lx, mapped to 0x%p, " "using %dk, total %dk\n", efifb_fix.smem_start, info->screen_base, size_remap/1024, size_total/1024); printk(KERN_INFO "efifb: mode is %dx%dx%d, linelength=%d, pages=%d\n", efifb_defined.xres, efifb_defined.yres, efifb_defined.bits_per_pixel, efifb_fix.line_length, screen_info.pages); efifb_defined.xres_virtual = efifb_defined.xres; efifb_defined.yres_virtual = efifb_fix.smem_len / efifb_fix.line_length; printk(KERN_INFO "efifb: scrolling: redraw\n"); efifb_defined.yres_virtual = efifb_defined.yres; /* some dummy values for timing to make fbset happy */ efifb_defined.pixclock = 10000000 / efifb_defined.xres * 1000 / efifb_defined.yres; efifb_defined.left_margin = (efifb_defined.xres / 8) & 0xf8; efifb_defined.hsync_len = (efifb_defined.xres / 8) & 0xf8; efifb_defined.red.offset = screen_info.red_pos; efifb_defined.red.length = screen_info.red_size; efifb_defined.green.offset = screen_info.green_pos; efifb_defined.green.length = screen_info.green_size; efifb_defined.blue.offset = screen_info.blue_pos; efifb_defined.blue.length = screen_info.blue_size; efifb_defined.transp.offset = screen_info.rsvd_pos; efifb_defined.transp.length = screen_info.rsvd_size; printk(KERN_INFO "efifb: %s: " "size=%d:%d:%d:%d, shift=%d:%d:%d:%d\n", "Truecolor", screen_info.rsvd_size, screen_info.red_size, screen_info.green_size, screen_info.blue_size, screen_info.rsvd_pos, screen_info.red_pos, screen_info.green_pos, screen_info.blue_pos); efifb_fix.ypanstep = 0; efifb_fix.ywrapstep = 0; info->fbops = &efifb_ops; info->var = efifb_defined; info->fix = efifb_fix; info->flags = FBINFO_FLAG_DEFAULT; if (fb_alloc_cmap(&info->cmap, 256, 0) < 0) { err = -ENOMEM; goto err_unmap; } if (register_framebuffer(info) < 0) { err = -EINVAL; goto err_fb_dealoc; } printk(KERN_INFO "fb%d: %s frame buffer device\n", info->node, info->fix.id); return 0; err_fb_dealoc: fb_dealloc_cmap(&info->cmap); err_unmap: iounmap(info->screen_base); framebuffer_release(info); err_release_mem: release_mem_region(efifb_fix.smem_start, size_total); return err; } static struct platform_driver efifb_driver = { .probe = efifb_probe, .driver = { .name = "efifb", }, }; static struct platform_device efifb_device = { .name = "efifb", }; static int __init efifb_init(void) { int ret; if (screen_info.orig_video_isVGA != VIDEO_TYPE_EFI) return -ENODEV; ret = platform_driver_register(&efifb_driver); if (!ret) { ret = platform_device_register(&efifb_device); if (ret) platform_driver_unregister(&efifb_driver); } return ret; } module_init(efifb_init); MODULE_LICENSE("GPL");