SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/video/vfb.c

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