diff options
Diffstat (limited to 'drivers/video/fbcon-cfb2.c')
| -rw-r--r-- | drivers/video/fbcon-cfb2.c | 205 |
1 files changed, 205 insertions, 0 deletions
diff --git a/drivers/video/fbcon-cfb2.c b/drivers/video/fbcon-cfb2.c new file mode 100644 index 000000000..617c85235 --- /dev/null +++ b/drivers/video/fbcon-cfb2.c @@ -0,0 +1,205 @@ +/* + * linux/drivers/video/cfb2.c -- Low level frame buffer operations for 2 bpp + * packed pixels + * + * Created 26 Dec 1997 by Michael Schmitz + * Based on cfb4.c + * + * This file is subject to the terms and conditions of the GNU General Public + * License. See the file COPYING in the main directory of this archive for + * more details. + */ + +#include <linux/module.h> +#include <linux/tty.h> +#include <linux/console.h> +#include <linux/string.h> +#include <linux/config.h> +#include <linux/fb.h> + +#include "fbcon.h" +#include "fbcon-cfb2.h" + + + /* + * 2 bpp packed pixels + */ + + /* + * IFF the font is even pixel aligned (that is to say each + * character start is a byte start in the pixel pairs). That + * avoids us having to mask bytes and means we won't be here + * all week. On a MacII that matters _lots_ + */ + +static u_char nibbletab_cfb2[]={ + 0x00,0x03,0x0c,0x0f, + 0x30,0x33,0x3c,0x3f, + 0xc0,0xc3,0xcc,0xcf, + 0xf0,0xf3,0xfc,0xff +}; + + +void fbcon_cfb2_setup(struct display *p) +{ + p->next_line = p->var.xres_virtual>>2; + p->next_plane = 0; +} + +void fbcon_cfb2_bmove(struct display *p, int sy, int sx, int dy, int dx, + int height, int width) +{ + int bytes = p->next_line, linesize = bytes * p->fontheight, rows; + u8 *src,*dst; + + if (sx == 0 && dx == 0 && width * 2 == bytes) { + mymemmove(p->screen_base + dy * linesize, + p->screen_base + sy * linesize, + height * linesize); + } + else { + if (dy < sy || (dy == sy && dx < sx)) { + src = p->screen_base + sy * linesize + sx * 2; + dst = p->screen_base + dy * linesize + dx * 2; + for (rows = height * p->fontheight ; rows-- ;) { + mymemmove(dst, src, width * 2); + src += bytes; + dst += bytes; + } + } + else { + src = p->screen_base + (sy+height) * linesize + sx * 2 + - bytes; + dst = p->screen_base + (dy+height) * linesize + dx * 2 + - bytes; + for (rows = height * p->fontheight ; rows-- ;) { + mymemmove(dst, src, width * 2); + src -= bytes; + dst -= bytes; + } + } + } +} + +void fbcon_cfb2_clear(struct vc_data *conp, struct display *p, int sy, int sx, + int height, int width) +{ + u8 *dest0,*dest; + int bytes=p->next_line,lines=height * p->fontheight, rows, i; + u32 bgx; + + dest = p->screen_base + sy * p->fontheight * bytes + sx * 2; + + bgx=attr_bgcol_ec(p,conp); + bgx |= (bgx << 2); /* expand the colour to 16 bits */ + bgx |= (bgx << 4); + bgx |= (bgx << 8); + + if (sx == 0 && width * 2 == bytes) { + for (i = 0 ; i < lines * width ; i++) { + ((u16 *)dest)[0]=bgx; + dest+=2; + } + } else { + dest0=dest; + for (rows = lines; rows-- ; dest0 += bytes) { + dest=dest0; + for (i = 0 ; i < width ; i++) { + /* memset ?? */ + ((u16 *)dest)[0]=bgx; + dest+=2; + } + } + } +} + +void fbcon_cfb2_putc(struct vc_data *conp, struct display *p, int c, int yy, + int xx) +{ + u8 *dest,*cdat; + int bytes=p->next_line,rows; + u32 eorx,fgx,bgx; + + c &= 0xff; + + dest = p->screen_base + yy * p->fontheight * bytes + xx * 2; + cdat = p->fontdata + c * p->fontheight; + + fgx=3;/*attr_fgcol(p,conp)&0x0F;*/ + bgx=attr_bgcol(p,conp)&0x0F; + fgx |= (fgx << 2); /* expand color to 8 bits */ + fgx |= (fgx << 4); + bgx |= (bgx << 2); + bgx |= (bgx << 4); + eorx = fgx ^ bgx; + + for (rows = p->fontheight ; rows-- ; dest += bytes) { + ((u8 *)dest)[0]= + (nibbletab_cfb2[*cdat >> 4] & eorx) ^ bgx; + ((u8 *)dest)[1]= + (nibbletab_cfb2[*cdat++ & 0xf] & eorx) ^ bgx; + } +} + +void fbcon_cfb2_putcs(struct vc_data *conp, struct display *p, const char *s, + int count, int yy, int xx) +{ + u8 *cdat, c, *dest, *dest0; + int rows,bytes=p->next_line; + u32 eorx, fgx, bgx; + + dest0 = p->screen_base + yy * p->fontheight * bytes + xx * 2; + fgx=3/*attr_fgcol(p,conp)*/; + bgx=attr_bgcol(p,conp); + fgx |= (fgx << 2); + fgx |= (fgx << 4); + bgx |= (bgx << 2); + bgx |= (bgx << 4); + eorx = fgx ^ bgx; + while (count--) { + c = *s++; + cdat = p->fontdata + c * p->fontheight; + + for (rows = p->fontheight, dest = dest0; rows-- ; dest += bytes) { + ((u8 *)dest)[0]= + (nibbletab_cfb2[*cdat >> 4] & eorx) ^ bgx; + ((u8 *)dest)[1]= + (nibbletab_cfb2[*cdat++ & 0xf] & eorx) ^ bgx; + } + dest0+=2; + } +} + +void fbcon_cfb2_revc(struct display *p, int xx, int yy) +{ + u8 *dest; + int bytes=p->next_line, rows; + + dest = p->screen_base + yy * p->fontheight * bytes + xx * 2; + for (rows = p->fontheight ; rows-- ; dest += bytes) { + ((u16 *)dest)[0] ^= 0xffff; + } +} + + + /* + * `switch' for the low level operations + */ + +struct display_switch fbcon_cfb2 = { + fbcon_cfb2_setup, fbcon_cfb2_bmove, fbcon_cfb2_clear, fbcon_cfb2_putc, + fbcon_cfb2_putcs, fbcon_cfb2_revc +}; + + + /* + * Visible symbols for modules + */ + +EXPORT_SYMBOL(fbcon_cfb2); +EXPORT_SYMBOL(fbcon_cfb2_setup); +EXPORT_SYMBOL(fbcon_cfb2_bmove); +EXPORT_SYMBOL(fbcon_cfb2_clear); +EXPORT_SYMBOL(fbcon_cfb2_putc); +EXPORT_SYMBOL(fbcon_cfb2_putcs); +EXPORT_SYMBOL(fbcon_cfb2_revc); |