^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) * linux/drivers/video/vfb.c -- Virtual frame buffer device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * Copyright (C) 2002 James Simmons
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * Copyright (C) 1997 Geert Uytterhoeven
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) * This file is subject to the terms and conditions of the GNU General Public
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) * License. See the file COPYING in the main directory of this archive for
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) * more details.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/string.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/mm.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/vmalloc.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <linux/interrupt.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #include <linux/fb.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) * RAM we reserve for the frame buffer. This defines the maximum screen
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) * size
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) * The default can be overridden if the driver is compiled as a module
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) #define VIDEOMEMSIZE (1*1024*1024) /* 1 MB */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) static void *videomemory;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) static u_long videomemorysize = VIDEOMEMSIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) module_param(videomemorysize, ulong, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) MODULE_PARM_DESC(videomemorysize, "RAM available to frame buffer (in bytes)");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) static char *mode_option = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) module_param(mode_option, charp, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) MODULE_PARM_DESC(mode_option, "Preferred video mode (e.g. 640x480-8@60)");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) static const struct fb_videomode vfb_default = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) .xres = 640,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) .yres = 480,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) .pixclock = 20000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) .left_margin = 64,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) .right_margin = 64,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) .upper_margin = 32,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) .lower_margin = 32,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) .hsync_len = 64,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) .vsync_len = 2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) .vmode = FB_VMODE_NONINTERLACED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) static struct fb_fix_screeninfo vfb_fix = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) .id = "Virtual FB",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) .type = FB_TYPE_PACKED_PIXELS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) .visual = FB_VISUAL_PSEUDOCOLOR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) .xpanstep = 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) .ypanstep = 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) .ywrapstep = 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) .accel = FB_ACCEL_NONE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) static bool vfb_enable __initdata = 0; /* disabled by default */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) module_param(vfb_enable, bool, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) MODULE_PARM_DESC(vfb_enable, "Enable Virtual FB driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) static int vfb_check_var(struct fb_var_screeninfo *var,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) struct fb_info *info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) static int vfb_set_par(struct fb_info *info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) static int vfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) u_int transp, struct fb_info *info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) static int vfb_pan_display(struct fb_var_screeninfo *var,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) struct fb_info *info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) static int vfb_mmap(struct fb_info *info,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) struct vm_area_struct *vma);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) static const struct fb_ops vfb_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) .fb_read = fb_sys_read,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) .fb_write = fb_sys_write,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) .fb_check_var = vfb_check_var,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) .fb_set_par = vfb_set_par,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) .fb_setcolreg = vfb_setcolreg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) .fb_pan_display = vfb_pan_display,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) .fb_fillrect = sys_fillrect,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) .fb_copyarea = sys_copyarea,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) .fb_imageblit = sys_imageblit,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) .fb_mmap = vfb_mmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) * Internal routines
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) static u_long get_line_length(int xres_virtual, int bpp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) u_long length;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) length = xres_virtual * bpp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) length = (length + 31) & ~31;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) length >>= 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) return (length);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) * Setting the video mode has been split into two parts.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) * First part, xxxfb_check_var, must not write anything
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) * to hardware, it should only verify and adjust var.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) * This means it doesn't alter par but it does use hardware
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) * data from it to check this var.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) static int vfb_check_var(struct fb_var_screeninfo *var,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) struct fb_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) u_long line_length;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) * FB_VMODE_CONUPDATE and FB_VMODE_SMOOTH_XPAN are equal!
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) * as FB_VMODE_SMOOTH_XPAN is only used internally
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) if (var->vmode & FB_VMODE_CONUPDATE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) var->vmode |= FB_VMODE_YWRAP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) var->xoffset = info->var.xoffset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) var->yoffset = info->var.yoffset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) * Some very basic checks
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) if (!var->xres)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) var->xres = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) if (!var->yres)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) var->yres = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) if (var->xres > var->xres_virtual)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) var->xres_virtual = var->xres;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) if (var->yres > var->yres_virtual)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) var->yres_virtual = var->yres;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) if (var->bits_per_pixel <= 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) var->bits_per_pixel = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) else if (var->bits_per_pixel <= 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) var->bits_per_pixel = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) else if (var->bits_per_pixel <= 16)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) var->bits_per_pixel = 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) else if (var->bits_per_pixel <= 24)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) var->bits_per_pixel = 24;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) else if (var->bits_per_pixel <= 32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) var->bits_per_pixel = 32;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) if (var->xres_virtual < var->xoffset + var->xres)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) var->xres_virtual = var->xoffset + var->xres;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) if (var->yres_virtual < var->yoffset + var->yres)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) var->yres_virtual = var->yoffset + var->yres;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) * Memory limit
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) line_length =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) get_line_length(var->xres_virtual, var->bits_per_pixel);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) if (line_length * var->yres_virtual > videomemorysize)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) * Now that we checked it we alter var. The reason being is that the video
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) * mode passed in might not work but slight changes to it might make it
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) * work. This way we let the user know what is acceptable.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) switch (var->bits_per_pixel) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) case 1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) case 8:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) var->red.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) var->red.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) var->green.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) var->green.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) var->blue.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) var->blue.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) var->transp.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) var->transp.length = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) case 16: /* RGBA 5551 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) if (var->transp.length) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) var->red.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) var->red.length = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) var->green.offset = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) var->green.length = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) var->blue.offset = 10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) var->blue.length = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) var->transp.offset = 15;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) var->transp.length = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) } else { /* RGB 565 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) var->red.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) var->red.length = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) var->green.offset = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) var->green.length = 6;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) var->blue.offset = 11;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) var->blue.length = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) var->transp.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) var->transp.length = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) case 24: /* RGB 888 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) var->red.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) var->red.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) var->green.offset = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) var->green.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) var->blue.offset = 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) var->blue.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) var->transp.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) var->transp.length = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) case 32: /* RGBA 8888 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) var->red.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) var->red.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) var->green.offset = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) var->green.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) var->blue.offset = 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) var->blue.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) var->transp.offset = 24;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) var->transp.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) var->red.msb_right = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) var->green.msb_right = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) var->blue.msb_right = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) var->transp.msb_right = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) /* This routine actually sets the video mode. It's in here where we
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) * the hardware state info->par and fix which can be affected by the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) * change in par. For this driver it doesn't do much.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) static int vfb_set_par(struct fb_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) switch (info->var.bits_per_pixel) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) case 1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) info->fix.visual = FB_VISUAL_MONO01;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) case 8:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) case 16:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) case 24:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) case 32:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) info->fix.visual = FB_VISUAL_TRUECOLOR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) info->fix.line_length = get_line_length(info->var.xres_virtual,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) info->var.bits_per_pixel);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) * Set a single color register. The values supplied are already
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) * rounded down to the hardware's capabilities (according to the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) * entries in the var structure). Return != 0 for invalid regno.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) static int vfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) u_int transp, struct fb_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) if (regno >= 256) /* no. of hw registers */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) * Program hardware... do anything you want with transp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) /* grayscale works only partially under directcolor */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) if (info->var.grayscale) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) /* grayscale = 0.30*R + 0.59*G + 0.11*B */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) red = green = blue =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) (red * 77 + green * 151 + blue * 28) >> 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) /* Directcolor:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) * var->{color}.offset contains start of bitfield
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) * var->{color}.length contains length of bitfield
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) * {hardwarespecific} contains width of RAMDAC
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) * cmap[X] is programmed to (X << red.offset) | (X << green.offset) | (X << blue.offset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) * RAMDAC[X] is programmed to (red, green, blue)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) * Pseudocolor:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) * var->{color}.offset is 0 unless the palette index takes less than
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) * bits_per_pixel bits and is stored in the upper
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) * bits of the pixel value
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) * var->{color}.length is set so that 1 << length is the number of available
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) * palette entries
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) * cmap is not used
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) * RAMDAC[X] is programmed to (red, green, blue)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) * Truecolor:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) * does not use DAC. Usually 3 are present.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) * var->{color}.offset contains start of bitfield
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) * var->{color}.length contains length of bitfield
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) * cmap is programmed to (red << red.offset) | (green << green.offset) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) * (blue << blue.offset) | (transp << transp.offset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) * RAMDAC does not exist
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) #define CNVT_TOHW(val,width) ((((val)<<(width))+0x7FFF-(val))>>16)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) switch (info->fix.visual) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) case FB_VISUAL_TRUECOLOR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) case FB_VISUAL_PSEUDOCOLOR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) red = CNVT_TOHW(red, info->var.red.length);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) green = CNVT_TOHW(green, info->var.green.length);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) blue = CNVT_TOHW(blue, info->var.blue.length);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) transp = CNVT_TOHW(transp, info->var.transp.length);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) case FB_VISUAL_DIRECTCOLOR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) red = CNVT_TOHW(red, 8); /* expect 8 bit DAC */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) green = CNVT_TOHW(green, 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) blue = CNVT_TOHW(blue, 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) /* hey, there is bug in transp handling... */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) transp = CNVT_TOHW(transp, 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) #undef CNVT_TOHW
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) /* Truecolor has hardware independent palette */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) if (info->fix.visual == FB_VISUAL_TRUECOLOR) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) u32 v;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) if (regno >= 16)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) v = (red << info->var.red.offset) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) (green << info->var.green.offset) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) (blue << info->var.blue.offset) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) (transp << info->var.transp.offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) switch (info->var.bits_per_pixel) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) case 8:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) case 16:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) ((u32 *) (info->pseudo_palette))[regno] = v;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) case 24:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) case 32:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) ((u32 *) (info->pseudo_palette))[regno] = v;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) * Pan or Wrap the Display
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) * This call looks only at xoffset, yoffset and the FB_VMODE_YWRAP flag
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) static int vfb_pan_display(struct fb_var_screeninfo *var,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) struct fb_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) if (var->vmode & FB_VMODE_YWRAP) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) if (var->yoffset >= info->var.yres_virtual ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) var->xoffset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) if (var->xoffset + info->var.xres > info->var.xres_virtual ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) var->yoffset + info->var.yres > info->var.yres_virtual)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) info->var.xoffset = var->xoffset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) info->var.yoffset = var->yoffset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) if (var->vmode & FB_VMODE_YWRAP)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) info->var.vmode |= FB_VMODE_YWRAP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) info->var.vmode &= ~FB_VMODE_YWRAP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) * Most drivers don't need their own mmap function
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) static int vfb_mmap(struct fb_info *info,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) struct vm_area_struct *vma)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) return remap_vmalloc_range(vma, (void *)info->fix.smem_start, vma->vm_pgoff);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) #ifndef MODULE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) * The virtual framebuffer driver is only enabled if explicitly
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) * requested by passing 'video=vfb:' (or any actual options).
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) static int __init vfb_setup(char *options)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) char *this_opt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) vfb_enable = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) if (!options)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) vfb_enable = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) if (!*options)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) while ((this_opt = strsep(&options, ",")) != NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) if (!*this_opt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) /* Test disable for backwards compatibility */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) if (!strcmp(this_opt, "disable"))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) vfb_enable = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) mode_option = this_opt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) #endif /* MODULE */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) * Initialisation
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) static int vfb_probe(struct platform_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) struct fb_info *info;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) unsigned int size = PAGE_ALIGN(videomemorysize);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) int retval = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) * For real video cards we use ioremap.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) if (!(videomemory = vmalloc_32_user(size)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) info = framebuffer_alloc(sizeof(u32) * 256, &dev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) if (!info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) goto err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) info->screen_base = (char __iomem *)videomemory;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) info->fbops = &vfb_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) if (!fb_find_mode(&info->var, info, mode_option,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) NULL, 0, &vfb_default, 8)){
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) fb_err(info, "Unable to find usable video mode.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) retval = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) goto err1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) vfb_fix.smem_start = (unsigned long) videomemory;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) vfb_fix.smem_len = videomemorysize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) info->fix = vfb_fix;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) info->pseudo_palette = info->par;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) info->par = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) info->flags = FBINFO_FLAG_DEFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) retval = fb_alloc_cmap(&info->cmap, 256, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) if (retval < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) goto err1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) retval = register_framebuffer(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) if (retval < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) goto err2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) platform_set_drvdata(dev, info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) vfb_set_par(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) fb_info(info, "Virtual frame buffer device, using %ldK of video memory\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) videomemorysize >> 10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) err2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) fb_dealloc_cmap(&info->cmap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) err1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) framebuffer_release(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) err:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) vfree(videomemory);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) static int vfb_remove(struct platform_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) struct fb_info *info = platform_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) if (info) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) unregister_framebuffer(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) vfree(videomemory);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) fb_dealloc_cmap(&info->cmap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) framebuffer_release(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) static struct platform_driver vfb_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) .probe = vfb_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) .remove = vfb_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) .name = "vfb",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) static struct platform_device *vfb_device;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) static int __init vfb_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) #ifndef MODULE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) char *option = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) if (fb_get_options("vfb", &option))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) vfb_setup(option);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) if (!vfb_enable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) return -ENXIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) ret = platform_driver_register(&vfb_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) if (!ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) vfb_device = platform_device_alloc("vfb", 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) if (vfb_device)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) ret = platform_device_add(vfb_device);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) ret = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) platform_device_put(vfb_device);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) platform_driver_unregister(&vfb_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) module_init(vfb_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) #ifdef MODULE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) static void __exit vfb_exit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) platform_device_unregister(vfb_device);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) platform_driver_unregister(&vfb_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) module_exit(vfb_exit);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) #endif /* MODULE */
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags