i386/linux-2.3.21/drivers/video/fbcon-cfb8.c

   1 /*
   2  *  linux/drivers/video/cfb8.c -- Low level frame buffer operations for 8 bpp
   3  *                                packed pixels
   4  *
   5  *      Created 5 Apr 1997 by Geert Uytterhoeven
   6  *
   7  *  This file is subject to the terms and conditions of the GNU General Public
   8  *  License.  See the file COPYING in the main directory of this archive for
   9  *  more details.
  10  */
  11
  12 #include <linux/module.h>
  13 #include <linux/tty.h>
  14 #include <linux/console.h>
  15 #include <linux/string.h>
  16 #include <linux/fb.h>
  17
  18 #include <video/fbcon.h>
  19 #include <video/fbcon-cfb8.h>
  20
  21
  22     /*
  23      *  8 bpp packed pixels
  24      */
  25
  26 static u32 nibbletab_cfb8[] = {
  27 #if defined(__BIG_ENDIAN)
  28     0x00000000,0x000000ff,0x0000ff00,0x0000ffff,
  29     0x00ff0000,0x00ff00ff,0x00ffff00,0x00ffffff,
  30     0xff000000,0xff0000ff,0xff00ff00,0xff00ffff,
  31     0xffff0000,0xffff00ff,0xffffff00,0xffffffff
  32 #elif defined(__LITTLE_ENDIAN)
  33     0x00000000,0xff000000,0x00ff0000,0xffff0000,
  34     0x0000ff00,0xff00ff00,0x00ffff00,0xffffff00,
  35     0x000000ff,0xff0000ff,0x00ff00ff,0xffff00ff,
  36     0x0000ffff,0xff00ffff,0x00ffffff,0xffffffff
  37 #else
  38 #error FIXME: No endianness??
  39 #endif
  40 };
  41
  42 void fbcon_cfb8_setup(struct display *p)
  43 {
  44     p->next_line = p->line_length ? p->line_length : p->var.xres_virtual;
  45     p->next_plane = 0;
  46 }
  47
  48 void fbcon_cfb8_bmove(struct display *p, int sy, int sx, int dy, int dx,
  49                       int height, int width)
  50 {
  51     int bytes = p->next_line, linesize = bytes * fontheight(p), rows;
  52     u8 *src,*dst;
  53
  54     if (sx == 0 && dx == 0 && width * fontwidth(p) == bytes) {
  55         fb_memmove(p->screen_base + dy * linesize,
  56                   p->screen_base + sy * linesize,
  57                   height * linesize);
  58         return;
  59     }
  60     if (fontwidthlog(p)) {
  61         sx <<= fontwidthlog(p); dx <<= fontwidthlog(p); width <<= fontwidthlog(p);
  62     } else {
  63         sx *= fontwidth(p); dx *= fontwidth(p); width *= fontwidth(p);
  64     }
  65     if (dy < sy || (dy == sy && dx < sx)) {
  66         src = p->screen_base + sy * linesize + sx;
  67         dst = p->screen_base + dy * linesize + dx;
  68         for (rows = height * fontheight(p) ; rows-- ;) {
  69             fb_memmove(dst, src, width);
  70             src += bytes;
  71             dst += bytes;
  72         }
  73     } else {
  74         src = p->screen_base + (sy+height) * linesize + sx - bytes;
  75         dst = p->screen_base + (dy+height) * linesize + dx - bytes;
  76         for (rows = height * fontheight(p) ; rows-- ;) {
  77             fb_memmove(dst, src, width);
  78             src -= bytes;
  79             dst -= bytes;
  80         }
  81     }
  82 }
  83
  84 static inline void rectfill(u8 *dest, int width, int height, u8 data,
  85                             int linesize)
  86 {
  87     while (height-- > 0) {
  88         fb_memset(dest, data, width);
  89         dest += linesize;
  90     }
  91 }
  92
  93 void fbcon_cfb8_clear(struct vc_data *conp, struct display *p, int sy, int sx,
  94                       int height, int width)
  95 {
  96     u8 *dest;
  97     int bytes=p->next_line,lines=height * fontheight(p);
  98     u8 bgx;
  99
 100     dest = p->screen_base + sy * fontheight(p) * bytes + sx * fontwidth(p);
 101
 102     bgx=attr_bgcol_ec(p,conp);
 103
 104     width *= fontwidth(p);
 105     if (width == bytes)
 106         rectfill(dest, lines * width, 1, bgx, bytes);
 107     else
 108         rectfill(dest, width, lines, bgx, bytes);
 109 }
 110
 111 void fbcon_cfb8_putc(struct vc_data *conp, struct display *p, int c, int yy,
 112                      int xx)
 113 {
 114     u8 *dest,*cdat;
 115     int bytes=p->next_line,rows;
 116     u32 eorx,fgx,bgx;
 117
 118     dest = p->screen_base + yy * fontheight(p) * bytes + xx * fontwidth(p);
 119     if (fontwidth(p) <= 8)
 120         cdat = p->fontdata + (c & p->charmask) * fontheight(p);
 121     else
 122         cdat = p->fontdata + ((c & p->charmask) * fontheight(p) << 1);
 123
 124     fgx=attr_fgcol(p,c);
 125     bgx=attr_bgcol(p,c);
 126     fgx |= (fgx << 8);
 127     fgx |= (fgx << 16);
 128     bgx |= (bgx << 8);
 129     bgx |= (bgx << 16);
 130     eorx = fgx ^ bgx;
 131
 132     switch (fontwidth(p)) {
 133     case 4:
 134         for (rows = fontheight(p) ; rows-- ; dest += bytes)
 135             fb_writel((nibbletab_cfb8[*cdat++ >> 4] & eorx) ^ bgx, dest);
 136         break;
 137     case 8:
 138         for (rows = fontheight(p) ; rows-- ; dest += bytes) {
 139             fb_writel((nibbletab_cfb8[*cdat >> 4] & eorx) ^ bgx, dest);
 140             fb_writel((nibbletab_cfb8[*cdat++ & 0xf] & eorx) ^ bgx, dest+4);
 141         }
 142         break;
 143     case 12:
 144     case 16:
 145         for (rows = fontheight(p) ; rows-- ; dest += bytes) {
 146             fb_writel((nibbletab_cfb8[*cdat >> 4] & eorx) ^ bgx, dest);
 147             fb_writel((nibbletab_cfb8[*cdat++ & 0xf] & eorx) ^ bgx, dest+4);
 148             fb_writel((nibbletab_cfb8[(*cdat >> 4) & 0xf] & eorx) ^ bgx, dest+8);
 149             if (fontwidth(p) == 16)
 150                 fb_writel((nibbletab_cfb8[*cdat & 0xf] & eorx) ^ bgx, dest+12);
 151             cdat++;
 152         }
 153         break;
 154     }
 155 }
 156
 157 void fbcon_cfb8_putcs(struct vc_data *conp, struct display *p,
 158                       const unsigned short *s, int count, int yy, int xx)
 159 {
 160     u8 *cdat, *dest, *dest0;
 161     u16 c;
 162     int rows,bytes=p->next_line;
 163     u32 eorx, fgx, bgx;
 164
 165     dest0 = p->screen_base + yy * fontheight(p) * bytes + xx * fontwidth(p);
 166     fgx=attr_fgcol(p,scr_readw(s));
 167     bgx=attr_bgcol(p,scr_readw(s));
 168     fgx |= (fgx << 8);
 169     fgx |= (fgx << 16);
 170     bgx |= (bgx << 8);
 171     bgx |= (bgx << 16);
 172     eorx = fgx ^ bgx;
 173     switch (fontwidth(p)) {
 174     case 4:
 175         while (count--) {
 176             c = scr_readw(s++) & p->charmask;
 177             cdat = p->fontdata + c * fontheight(p);
 178
 179             for (rows = fontheight(p), dest = dest0; rows-- ; dest += bytes)
 180                 fb_writel((nibbletab_cfb8[*cdat++ >> 4] & eorx) ^ bgx, dest);
 181             dest0+=4;
 182         }
 183         break;
 184     case 8:
 185         while (count--) {
 186             c = scr_readw(s++) & p->charmask;
 187             cdat = p->fontdata + c * fontheight(p);
 188
 189             for (rows = fontheight(p), dest = dest0; rows-- ; dest += bytes) {
 190                 fb_writel((nibbletab_cfb8[*cdat >> 4] & eorx) ^ bgx, dest);
 191                 fb_writel((nibbletab_cfb8[*cdat++ & 0xf] & eorx) ^ bgx, dest+4);
 192             }
 193             dest0+=8;
 194         }
 195         break;
 196     case 12:
 197     case 16:
 198         while (count--) {
 199             c = scr_readw(s++) & p->charmask;
 200             cdat = p->fontdata + (c * fontheight(p) << 1);
 201
 202             for (rows = fontheight(p), dest = dest0; rows-- ; dest += bytes) {
 203                 fb_writel((nibbletab_cfb8[*cdat >> 4] & eorx) ^ bgx, dest);
 204                 fb_writel((nibbletab_cfb8[*cdat++ & 0xf] & eorx) ^ bgx, dest+4);
 205                 fb_writel((nibbletab_cfb8[(*cdat >> 4) & 0xf] & eorx) ^ bgx, dest+8);
 206                 if (fontwidth(p) == 16)
 207                    fb_writel((nibbletab_cfb8[*cdat & 0xf] & eorx) ^ bgx, dest+12);
 208                 cdat++;
 209             }
 210             dest0+=fontwidth(p);
 211         }
 212         break;
 213     }
 214 }
 215
 216 void fbcon_cfb8_revc(struct display *p, int xx, int yy)
 217 {
 218     u8 *dest;
 219     int bytes=p->next_line, rows;
 220
 221     dest = p->screen_base + yy * fontheight(p) * bytes + xx * fontwidth(p);
 222     for (rows = fontheight(p) ; rows-- ; dest += bytes) {
 223         switch (fontwidth(p)) {
 224         case 16: fb_writel(fb_readl(dest+12) ^ 0x0f0f0f0f, dest+12); /* fall thru */
 225         case 12: fb_writel(fb_readl(dest+8) ^ 0x0f0f0f0f, dest+8); /* fall thru */
 226         case 8: fb_writel(fb_readl(dest+4) ^ 0x0f0f0f0f, dest+4); /* fall thru */
 227         case 4: fb_writel(fb_readl(dest) ^ 0x0f0f0f0f, dest); /* fall thru */
 228         default: break;
 229         }
 230     }
 231 }
 232
 233 void fbcon_cfb8_clear_margins(struct vc_data *conp, struct display *p,
 234                               int bottom_only)
 235 {
 236     int bytes=p->next_line;
 237     u8 bgx;
 238
 239     unsigned int right_start = conp->vc_cols*fontwidth(p);
 240     unsigned int bottom_start = conp->vc_rows*fontheight(p);
 241     unsigned int right_width, bottom_width;
 242
 243     bgx=attr_bgcol_ec(p,conp);
 244
 245     if (!bottom_only && (right_width = p->var.xres-right_start))
 246         rectfill(p->screen_base+right_start, right_width, p->var.yres_virtual,
 247                  bgx, bytes);
 248     if ((bottom_width = p->var.yres-bottom_start))
 249         rectfill(p->screen_base+(p->var.yoffset+bottom_start)*bytes,
 250                  right_start, bottom_width, bgx, bytes);
 251 }
 252
 253
 254     /*
 255      *  `switch' for the low level operations
 256      */
 257
 258 struct display_switch fbcon_cfb8 = {
 259     fbcon_cfb8_setup, fbcon_cfb8_bmove, fbcon_cfb8_clear, fbcon_cfb8_putc,
 260     fbcon_cfb8_putcs, fbcon_cfb8_revc, NULL, NULL, fbcon_cfb8_clear_margins,
 261     FONTWIDTH(4)|FONTWIDTH(8)|FONTWIDTH(12)|FONTWIDTH(16)
 262 };
 263
 264
 265 #ifdef MODULE
 266 int init_module(void)
 267 {
 268     return 0;
 269 }
 270
 271 void cleanup_module(void)
 272 {}
 273 #endif /* MODULE */
 274
 275
 276     /*
 277      *  Visible symbols for modules
 278      */
 279
 280 EXPORT_SYMBOL(fbcon_cfb8);
 281 EXPORT_SYMBOL(fbcon_cfb8_setup);
 282 EXPORT_SYMBOL(fbcon_cfb8_bmove);
 283 EXPORT_SYMBOL(fbcon_cfb8_clear);
 284 EXPORT_SYMBOL(fbcon_cfb8_putc);
 285 EXPORT_SYMBOL(fbcon_cfb8_putcs);
 286 EXPORT_SYMBOL(fbcon_cfb8_revc);
 287 EXPORT_SYMBOL(fbcon_cfb8_clear_margins);