i386/linux/linux-2.3.21/drivers/video/vfb.c

   1 /*
   2  *  linux/drivers/video/vfb.c -- Virtual frame buffer device
   3  *
   4  *      Copyright (C) 1997 Geert Uytterhoeven
   5  *
   6  *  This file is subject to the terms and conditions of the GNU General Public
   7  *  License. See the file COPYING in the main directory of this archive for
   8  *  more details.
   9  */
  10
  11 #include <linux/module.h>
  12 #include <linux/kernel.h>
  13 #include <linux/errno.h>
  14 #include <linux/string.h>
  15 #include <linux/mm.h>
  16 #include <linux/tty.h>
  17 #include <linux/malloc.h>
  18 #include <linux/vmalloc.h>
  19 #include <linux/delay.h>
  20 #include <linux/interrupt.h>
  21 #include <asm/uaccess.h>
  22 #include <linux/fb.h>
  23 #include <linux/init.h>
  24
  25 #include <video/fbcon.h>
  26 #include <video/fbcon-mfb.h>
  27 #include <video/fbcon-cfb2.h>
  28 #include <video/fbcon-cfb4.h>
  29 #include <video/fbcon-cfb8.h>
  30 #include <video/fbcon-cfb16.h>
  31 #include <video/fbcon-cfb24.h>
  32 #include <video/fbcon-cfb32.h>
  33
  34
  35 #define arraysize(x)    (sizeof(x)/sizeof(*(x)))
  36
  37
  38     /*
  39      *  RAM we reserve for the frame buffer. This defines the maximum screen
  40      *  size
  41      *
  42      *  The default can be overridden if the driver is compiled as a module
  43      */
  44
  45 #define VIDEOMEMSIZE    (1*1024*1024)   /* 1 MB */
  46
  47 static u_long videomemory, videomemorysize = VIDEOMEMSIZE;
  48 MODULE_PARM(videomemorysize, "l");
  49 static int currcon = 0;
  50 static struct display disp;
  51 static struct fb_info fb_info;
  52 static struct { u_char red, green, blue, pad; } palette[256];
  53 static union {
  54 #ifdef FBCON_HAS_CFB16
  55     u16 cfb16[16];
  56 #endif
  57 #ifdef FBCON_HAS_CFB24
  58     u32 cfb24[16];
  59 #endif
  60 #ifdef FBCON_HAS_CFB32
  61     u32 cfb32[16];
  62 #endif
  63 } fbcon_cmap;
  64 static char vfb_name[16] = "Virtual FB";
  65
  66 static struct fb_var_screeninfo vfb_default = {
  67     /* 640x480, 8 bpp */
  68     640, 480, 640, 480, 0, 0, 8, 0,
  69     {0, 8, 0}, {0, 8, 0}, {0, 8, 0}, {0, 0, 0},
  70     0, 0, -1, -1, 0, 20000, 64, 64, 32, 32, 64, 2,
  71     0, FB_VMODE_NONINTERLACED
  72 };
  73
  74 static int vfb_enable = 0;      /* disabled by default */
  75
  76
  77     /*
  78      *  Interface used by the world
  79      */
  80
  81 int vfb_setup(char*);
  82
  83 static int vfb_open(struct fb_info *info, int user);
  84 static int vfb_release(struct fb_info *info, int user);
  85 static int vfb_get_fix(struct fb_fix_screeninfo *fix, int con,
  86                        struct fb_info *info);
  87 static int vfb_get_var(struct fb_var_screeninfo *var, int con,
  88                        struct fb_info *info);
  89 static int vfb_set_var(struct fb_var_screeninfo *var, int con,
  90                        struct fb_info *info);
  91 static int vfb_pan_display(struct fb_var_screeninfo *var, int con,
  92                            struct fb_info *info);
  93 static int vfb_get_cmap(struct fb_cmap *cmap, int kspc, int con,
  94                         struct fb_info *info);
  95 static int vfb_set_cmap(struct fb_cmap *cmap, int kspc, int con,
  96                         struct fb_info *info);
  97 static int vfb_ioctl(struct inode *inode, struct file *file, u_int cmd,
  98                      u_long arg, int con, struct fb_info *info);
  99
 100
 101     /*
 102      *  Interface to the low level console driver
 103      */
 104
 105 int vfb_init(void);
 106 static int vfbcon_switch(int con, struct fb_info *info);
 107 static int vfbcon_updatevar(int con, struct fb_info *info);
 108 static void vfbcon_blank(int blank, struct fb_info *info);
 109
 110
 111     /*
 112      *  Internal routines
 113      */
 114
 115 static u_long get_line_length(int xres_virtual, int bpp);
 116 static void vfb_encode_fix(struct fb_fix_screeninfo *fix,
 117                            struct fb_var_screeninfo *var);
 118 static void set_color_bitfields(struct fb_var_screeninfo *var);
 119 static int vfb_getcolreg(u_int regno, u_int *red, u_int *green, u_int *blue,
 120                          u_int *transp, struct fb_info *info);
 121 static int vfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
 122                          u_int transp, struct fb_info *info);
 123 static void do_install_cmap(int con, struct fb_info *info);
 124
 125
 126 static struct fb_ops vfb_ops = {
 127     vfb_open, vfb_release, vfb_get_fix, vfb_get_var, vfb_set_var, vfb_get_cmap,
 128     vfb_set_cmap, vfb_pan_display, vfb_ioctl
 129 };
 130
 131
 132     /*
 133      *  Open/Release the frame buffer device
 134      */
 135
 136 static int vfb_open(struct fb_info *info, int user)
 137 {
 138     /*
 139      *  Nothing, only a usage count for the moment
 140      */
 141
 142     MOD_INC_USE_COUNT;
 143     return(0);
 144 }
 145
 146 static int vfb_release(struct fb_info *info, int user)
 147 {
 148     MOD_DEC_USE_COUNT;
 149     return(0);
 150 }
 151
 152
 153     /*
 154      *  Get the Fixed Part of the Display
 155      */
 156
 157 static int vfb_get_fix(struct fb_fix_screeninfo *fix, int con,
 158                        struct fb_info *info)
 159 {
 160     struct fb_var_screeninfo *var;
 161
 162     if (con == -1)
 163         var = &vfb_default;
 164     else
 165         var = &fb_display[con].var;
 166     vfb_encode_fix(fix, var);
 167     return 0;
 168 }
 169
 170
 171     /*
 172      *  Get the User Defined Part of the Display
 173      */
 174
 175 static int vfb_get_var(struct fb_var_screeninfo *var, int con,
 176                        struct fb_info *info)
 177 {
 178     if (con == -1)
 179         *var = vfb_default;
 180     else
 181         *var = fb_display[con].var;
 182     set_color_bitfields(var);
 183     return 0;
 184 }
 185
 186
 187     /*
 188      *  Set the User Defined Part of the Display
 189      */
 190
 191 static int vfb_set_var(struct fb_var_screeninfo *var, int con,
 192                        struct fb_info *info)
 193 {
 194     int err, activate = var->activate;
 195     int oldxres, oldyres, oldvxres, oldvyres, oldbpp;
 196     u_long line_length;
 197
 198     struct display *display;
 199     if (con >= 0)
 200         display = &fb_display[con];
 201     else
 202         display = &disp;        /* used during initialization */
 203
 204     /*
 205      *  FB_VMODE_CONUPDATE and FB_VMODE_SMOOTH_XPAN are equal!
 206      *  as FB_VMODE_SMOOTH_XPAN is only used internally
 207      */
 208
 209     if (var->vmode & FB_VMODE_CONUPDATE) {
 210         var->vmode |= FB_VMODE_YWRAP;
 211         var->xoffset = display->var.xoffset;
 212         var->yoffset = display->var.yoffset;
 213     }
 214
 215     /*
 216      *  Some very basic checks
 217      */
 218     if (!var->xres)
 219         var->xres = 1;
 220     if (!var->yres)
 221         var->yres = 1;
 222     if (var->xres > var->xres_virtual)
 223         var->xres_virtual = var->xres;
 224     if (var->yres > var->yres_virtual)
 225         var->yres_virtual = var->yres;
 226     if (var->bits_per_pixel <= 1)
 227         var->bits_per_pixel = 1;
 228     else if (var->bits_per_pixel <= 8)
 229         var->bits_per_pixel = 8;
 230     else if (var->bits_per_pixel <= 16)
 231         var->bits_per_pixel = 16;
 232 #if 0
 233     /* fbcon doesn't support this (yet) */
 234     else if (var->bits_per_pixel <= 24)
 235         var->bits_per_pixel = 24;
 236     else if (var->bits_per_pixel <= 32)
 237         var->bits_per_pixel = 32;
 238 #endif
 239     else
 240         return -EINVAL;
 241
 242     /*
 243      *  Memory limit
 244      */
 245     line_length = get_line_length(var->xres_virtual, var->bits_per_pixel);
 246     if (line_length*var->yres_virtual > videomemorysize)
 247         return -ENOMEM;
 248
 249     set_color_bitfields(var);
 250
 251     if ((activate & FB_ACTIVATE_MASK) == FB_ACTIVATE_NOW) {
 252         oldxres = display->var.xres;
 253         oldyres = display->var.yres;
 254         oldvxres = display->var.xres_virtual;
 255         oldvyres = display->var.yres_virtual;
 256         oldbpp = display->var.bits_per_pixel;
 257         display->var = *var;
 258         if (oldxres != var->xres || oldyres != var->yres ||
 259             oldvxres != var->xres_virtual || oldvyres != var->yres_virtual ||
 260             oldbpp != var->bits_per_pixel) {
 261             struct fb_fix_screeninfo fix;
 262
 263             vfb_encode_fix(&fix, var);
 264             display->screen_base = (char *)videomemory;
 265             display->visual = fix.visual;
 266             display->type = fix.type;
 267             display->type_aux = fix.type_aux;
 268             display->ypanstep = fix.ypanstep;
 269             display->ywrapstep = fix.ywrapstep;
 270             display->line_length = fix.line_length;
 271             display->can_soft_blank = 1;
 272             display->inverse = 0;
 273             switch (var->bits_per_pixel) {
 274 #ifdef FBCON_HAS_MFB
 275                 case 1:
 276                     display->dispsw = &fbcon_mfb;
 277                     break;
 278 #endif
 279 #ifdef FBCON_HAS_CFB2
 280                 case 2:
 281                     display->dispsw = &fbcon_cfb2;
 282                     break;
 283 #endif
 284 #ifdef FBCON_HAS_CFB4
 285                 case 4:
 286                     display->dispsw = &fbcon_cfb4;
 287                     break;
 288 #endif
 289 #ifdef FBCON_HAS_CFB8
 290                 case 8:
 291                     display->dispsw = &fbcon_cfb8;
 292                     break;
 293 #endif
 294 #ifdef FBCON_HAS_CFB16
 295                 case 16:
 296                     display->dispsw = &fbcon_cfb16;
 297                     display->dispsw_data = fbcon_cmap.cfb16;
 298                     break;
 299 #endif
 300 #ifdef FBCON_HAS_CFB24
 301                 case 24:
 302                     display->dispsw = &fbcon_cfb24;
 303                     display->dispsw_data = fbcon_cmap.cfb24;
 304                     break;
 305 #endif
 306 #ifdef FBCON_HAS_CFB32
 307                 case 32:
 308                     display->dispsw = &fbcon_cfb32;
 309                     display->dispsw_data = fbcon_cmap.cfb32;
 310                     break;
 311 #endif
 312                 default:
 313                     display->dispsw = &fbcon_dummy;
 314                     break;
 315             }
 316             if (fb_info.changevar)
 317                 (*fb_info.changevar)(con);
 318         }
 319         if (oldbpp != var->bits_per_pixel) {
 320             if ((err = fb_alloc_cmap(&display->cmap, 0, 0)))
 321                 return err;
 322             do_install_cmap(con, info);
 323         }
 324     }
 325     return 0;
 326 }
 327
 328
 329     /*
 330      *  Pan or Wrap the Display
 331      *
 332      *  This call looks only at xoffset, yoffset and the FB_VMODE_YWRAP flag
 333      */
 334
 335 static int vfb_pan_display(struct fb_var_screeninfo *var, int con,
 336                            struct fb_info *info)
 337 {
 338     if (var->vmode & FB_VMODE_YWRAP) {
 339         if (var->yoffset < 0 ||
 340             var->yoffset >= fb_display[con].var.yres_virtual ||
 341             var->xoffset)
 342             return -EINVAL;
 343     } else {
 344         if (var->xoffset+fb_display[con].var.xres >
 345             fb_display[con].var.xres_virtual ||
 346             var->yoffset+fb_display[con].var.yres >
 347             fb_display[con].var.yres_virtual)
 348             return -EINVAL;
 349     }
 350     fb_display[con].var.xoffset = var->xoffset;
 351     fb_display[con].var.yoffset = var->yoffset;
 352     if (var->vmode & FB_VMODE_YWRAP)
 353         fb_display[con].var.vmode |= FB_VMODE_YWRAP;
 354     else
 355         fb_display[con].var.vmode &= ~FB_VMODE_YWRAP;
 356     return 0;
 357 }
 358
 359     /*
 360      *  Get the Colormap
 361      */
 362
 363 static int vfb_get_cmap(struct fb_cmap *cmap, int kspc, int con,
 364                         struct fb_info *info)
 365 {
 366     if (con == currcon) /* current console? */
 367         return fb_get_cmap(cmap, kspc, vfb_getcolreg, info);
 368     else if (fb_display[con].cmap.len) /* non default colormap? */
 369         fb_copy_cmap(&fb_display[con].cmap, cmap, kspc ? 0 : 2);
 370     else
 371         fb_copy_cmap(fb_default_cmap(1<<fb_display[con].var.bits_per_pixel),
 372                      cmap, kspc ? 0 : 2);
 373     return 0;
 374 }
 375
 376     /*
 377      *  Set the Colormap
 378      */
 379
 380 static int vfb_set_cmap(struct fb_cmap *cmap, int kspc, int con,
 381                         struct fb_info *info)
 382 {
 383     int err;
 384
 385     if (!fb_display[con].cmap.len) {    /* no colormap allocated? */
 386         if ((err = fb_alloc_cmap(&fb_display[con].cmap,
 387                               1<<fb_display[con].var.bits_per_pixel, 0)))
 388             return err;
 389     }
 390     if (con == currcon)                 /* current console? */
 391         return fb_set_cmap(cmap, kspc, vfb_setcolreg, info);
 392     else
 393         fb_copy_cmap(cmap, &fb_display[con].cmap, kspc ? 0 : 1);
 394     return 0;
 395 }
 396
 397
 398     /*
 399      *  Virtual Frame Buffer Specific ioctls
 400      */
 401
 402 static int vfb_ioctl(struct inode *inode, struct file *file, u_int cmd,
 403                      u_long arg, int con, struct fb_info *info)
 404 {
 405     return -EINVAL;
 406 }
 407
 408
 409 int __init vfb_setup(char *options)
 410 {
 411     char *this_opt;
 412
 413     fb_info.fontname[0] = '\0';
 414
 415     vfb_enable = 1;
 416
 417     if (!options || !*options)
 418         return 0;
 419
 420     for (this_opt = strtok(options, ","); this_opt;
 421          this_opt = strtok(NULL, ",")) {
 422         if (!strncmp(this_opt, "font:", 5))
 423             strcpy(fb_info.fontname, this_opt+5);
 424     }
 425     return 0;
 426 }
 427
 428
 429     /*
 430      *  Initialisation
 431      */
 432
 433 int __init vfb_init(void)
 434 {
 435     if (!vfb_enable)
 436         return -ENXIO;
 437
 438     if (!(videomemory = (u_long)vmalloc(videomemorysize)))
 439         return -ENOMEM;
 440
 441     strcpy(fb_info.modename, vfb_name);
 442     fb_info.changevar = NULL;
 443     fb_info.node = -1;
 444     fb_info.fbops = &vfb_ops;
 445     fb_info.disp = &disp;
 446     fb_info.switch_con = &vfbcon_switch;
 447     fb_info.updatevar = &vfbcon_updatevar;
 448     fb_info.blank = &vfbcon_blank;
 449     fb_info.flags = FBINFO_FLAG_DEFAULT;
 450
 451     vfb_set_var(&vfb_default, -1, &fb_info);
 452
 453     if (register_framebuffer(&fb_info) < 0) {
 454         vfree((void *)videomemory);
 455         return -EINVAL;
 456     }
 457
 458     printk(KERN_INFO "fb%d: Virtual frame buffer device, using %ldK of video memory\n",
 459            GET_FB_IDX(fb_info.node), videomemorysize>>10);
 460     return 0;
 461 }
 462
 463
 464 static int vfbcon_switch(int con, struct fb_info *info)
 465 {
 466     /* Do we have to save the colormap? */
 467     if (fb_display[currcon].cmap.len)
 468         fb_get_cmap(&fb_display[currcon].cmap, 1, vfb_getcolreg, info);
 469
 470     currcon = con;
 471     /* Install new colormap */
 472     do_install_cmap(con, info);
 473     return 0;
 474 }
 475
 476     /*
 477      *  Update the `var' structure (called by fbcon.c)
 478      */
 479
 480 static int vfbcon_updatevar(int con, struct fb_info *info)
 481 {
 482     /* Nothing */
 483     return 0;
 484 }
 485
 486     /*
 487      *  Blank the display.
 488      */
 489
 490 static void vfbcon_blank(int blank, struct fb_info *info)
 491 {
 492     /* Nothing */
 493 }
 494
 495 static u_long get_line_length(int xres_virtual, int bpp)
 496 {
 497     u_long length;
 498
 499     length = (xres_virtual+bpp-1)/bpp;
 500     length = (length+31)&-32;
 501     length >>= 3;
 502     return(length);
 503 }
 504
 505 static void vfb_encode_fix(struct fb_fix_screeninfo *fix,
 506                            struct fb_var_screeninfo *var)
 507 {
 508     memset(fix, 0, sizeof(struct fb_fix_screeninfo));
 509     strcpy(fix->id, vfb_name);
 510     fix->smem_start = videomemory;
 511     fix->smem_len = videomemorysize;
 512     fix->type = FB_TYPE_PACKED_PIXELS;
 513     fix->type_aux = 0;
 514     switch (var->bits_per_pixel) {
 515         case 1:
 516             fix->visual = FB_VISUAL_MONO01;
 517             break;
 518         case 2:
 519         case 4:
 520         case 8:
 521             fix->visual = FB_VISUAL_PSEUDOCOLOR;
 522             break;
 523         case 16:
 524         case 24:
 525         case 32:
 526             fix->visual = FB_VISUAL_TRUECOLOR;
 527             break;
 528     }
 529     fix->ywrapstep = 1;
 530     fix->xpanstep = 1;
 531     fix->ypanstep = 1;
 532     fix->line_length = get_line_length(var->xres_virtual, var->bits_per_pixel);
 533 }
 534
 535 static void set_color_bitfields(struct fb_var_screeninfo *var)
 536 {
 537     switch (var->bits_per_pixel) {
 538         case 1:
 539         case 8:
 540             var->red.offset = 0;
 541             var->red.length = 8;
 542             var->green.offset = 0;
 543             var->green.length = 8;
 544             var->blue.offset = 0;
 545             var->blue.length = 8;
 546             var->transp.offset = 0;
 547             var->transp.length = 0;
 548             break;
 549         case 16:        /* RGB 565 */
 550             var->red.offset = 0;
 551             var->red.length = 5;
 552             var->green.offset = 5;
 553             var->green.length = 6;
 554             var->blue.offset = 11;
 555             var->blue.length = 5;
 556             var->transp.offset = 0;
 557             var->transp.length = 0;
 558             break;
 559         case 24:        /* RGB 888 */
 560             var->red.offset = 0;
 561             var->red.length = 8;
 562             var->green.offset = 8;
 563             var->green.length = 8;
 564             var->blue.offset = 16;
 565             var->blue.length = 8;
 566             var->transp.offset = 0;
 567             var->transp.length = 0;
 568             break;
 569         case 32:        /* RGBA 8888 */
 570             var->red.offset = 0;
 571             var->red.length = 8;
 572             var->green.offset = 8;
 573             var->green.length = 8;
 574             var->blue.offset = 16;
 575             var->blue.length = 8;
 576             var->transp.offset = 24;
 577             var->transp.length = 8;
 578             break;
 579     }
 580     var->red.msb_right = 0;
 581     var->green.msb_right = 0;
 582     var->blue.msb_right = 0;
 583     var->transp.msb_right = 0;
 584 }
 585
 586
 587     /*
 588      *  Read a single color register and split it into
 589      *  colors/transparent. Return != 0 for invalid regno.
 590      */
 591
 592 static int vfb_getcolreg(u_int regno, u_int *red, u_int *green, u_int *blue,
 593                          u_int *transp, struct fb_info *info)
 594 {
 595     if (regno > 255)
 596         return 1;
 597     *red = (palette[regno].red<<8) | palette[regno].red;
 598     *green = (palette[regno].green<<8) | palette[regno].green;
 599     *blue = (palette[regno].blue<<8) | palette[regno].blue;
 600     *transp = 0;
 601     return 0;
 602 }
 603
 604
 605     /*
 606      *  Set a single color register. The values supplied are already
 607      *  rounded down to the hardware's capabilities (according to the
 608      *  entries in the var structure). Return != 0 for invalid regno.
 609      */
 610
 611 static int vfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
 612                          u_int transp, struct fb_info *info)
 613 {
 614     if (regno > 255)
 615         return 1;
 616     red >>= 8;
 617     green >>= 8;
 618     blue >>= 8;
 619     palette[regno].red = red;
 620     palette[regno].green = green;
 621     palette[regno].blue = blue;
 622     return 0;
 623 }
 624
 625
 626 static void do_install_cmap(int con, struct fb_info *info)
 627 {
 628     if (con != currcon)
 629         return;
 630     if (fb_display[con].cmap.len)
 631         fb_set_cmap(&fb_display[con].cmap, 1, vfb_setcolreg, info);
 632     else
 633         fb_set_cmap(fb_default_cmap(1<<fb_display[con].var.bits_per_pixel), 1,
 634                     vfb_setcolreg, info);
 635 }
 636
 637
 638 #ifdef MODULE
 639 int init_module(void)
 640 {
 641     return vfb_init();
 642 }
 643
 644 void cleanup_module(void)
 645 {
 646     unregister_framebuffer(&fb_info);
 647     vfree((void *)videomemory);
 648 }
 649
 650 #endif /* MODULE */