Merge with Linux 2.1.67.

1 files changed, 230 insertions, 0 deletions

diff --git a/drivers/video/fbcon-cyber.c b/drivers/video/fbcon-cyber.c
new file mode 100644
index 000000000..d12be1db6
--- /dev/null
+++ b/drivers/video/fbcon-cyber.c
@@ -0,0 +1,230 @@
+/*
+ *  linux/drivers/video/cyber.c -- Low level frame buffer operations for the
+ *				   CyberVision64 (accelerated)
+ *
+ *	Created 5 Apr 1997 by Geert Uytterhoeven
+ *
+ *  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 "s3blit.h"
+
+
+    /*
+     *  Prototypes
+     */
+
+static int open_cyber(struct display *p);
+static void release_cyber(void);
+static void bmove_cyber(struct display *p, int sy, int sx, int dy, int dx,
+	                int height, int width);
+static void clear_cyber(struct vc_data *conp, struct display *p, int sy, int sx,
+	                int height, int width);
+static void putc_cyber(struct vc_data *conp, struct display *p, int c, int yy,
+	               int xx);
+static void putcs_cyber(struct vc_data *conp, struct display *p, const char *s,
+	                int count, int yy, int xx);
+static void rev_char_cyber(struct display *p, int xx, int yy);
+
+
+    /*
+     *  Acceleration functions in cyberfb.c
+     */
+
+extern void Cyber_WaitQueue(unsigned short fifo);
+extern void Cyber_WaitBlit(void);
+extern void Cyber_BitBLT(unsigned short curx, unsigned short cury,
+			 unsigned short destx, unsigned short desty,
+			 unsigned short width, unsigned short height,
+			 unsigned short mode);
+extern void Cyber_RectFill(unsigned short xx, unsigned short yy,
+			   unsigned short width, unsigned short height,
+			   unsigned short mode, unsigned short fillcolor);
+extern void Cyber_MoveCursor(unsigned short xx, unsigned short yy);
+
+
+    /*
+     *  `switch' for the low level operations
+     */
+
+static struct display_switch dispsw_cyber = {
+   open_cyber, release_cyber, bmove_cyber, clear_cyber, putc_cyber,
+   putcs_cyber, rev_char_cyber
+};
+
+
+    /*
+     *  CyberVision64 (accelerated)
+     */
+
+static int open_cyber(struct display *p)
+{
+    if (p->type != FB_TYPE_PACKED_PIXELS ||
+	p->var.accel != FB_ACCEL_CYBERVISION)
+	return -EINVAL;
+
+    p->next_line = p->var.xres_virtual*p->var.bits_per_pixel>>3;
+    p->next_plane = 0;
+    MOD_INC_USE_COUNT;
+    return 0;
+}
+
+static void release_cyber(void)
+{
+    MOD_DEC_USE_COUNT;
+}
+
+static void bmove_cyber(struct display *p, int sy, int sx, int dy, int dx,
+	                int height, int width)
+{
+    sx *= 8; dx *= 8; width *= 8;
+    Cyber_BitBLT((u_short)sx, (u_short)(sy*p->fontheight), (u_short)dx,
+		 (u_short)(dy*p->fontheight), (u_short)width,
+		 (u_short)(height*p->fontheight), (u_short)S3_NEW);
+}
+
+static void clear_cyber(struct vc_data *conp, struct display *p, int
+			sy, int sx, int height, int width)
+{
+    unsigned char bg;
+
+    sx *= 8; width *= 8;
+    bg = attr_bgcol_ec(p,conp);
+    Cyber_RectFill((u_short)sx,
+		   (u_short)(sy*p->fontheight),
+		   (u_short)width,
+		   (u_short)(height*p->fontheight),
+		   (u_short)S3_NEW,
+		   (u_short)bg);
+}
+
+static void putc_cyber(struct vc_data *conp, struct display *p, int c, int yy,
+	               int xx)
+{
+    u_char *dest, *cdat;
+    u_long tmp;
+    u_int rows, revs, underl;
+    u_char d;
+    u_char fg, bg;
+
+    c &= 0xff;
+
+    dest = p->screen_base+yy*p->fontheight*p->next_line+8*xx;
+    cdat = p->fontdata+(c*p->fontheight);
+    fg = p->fgcol;
+    bg = p->bgcol;
+    revs = conp->vc_reverse;
+    underl = conp->vc_underline;
+
+    Cyber_WaitBlit();
+    for (rows = p->fontheight; rows--; dest += p->next_line) {
+	d = *cdat++;
+
+	if (underl && !rows)
+	    d = 0xff;
+	if (revs)
+	    d = ~d;
+
+	tmp =  ((d & 0x80) ? fg : bg) << 24;
+	tmp |= ((d & 0x40) ? fg : bg) << 16;
+	tmp |= ((d & 0x20) ? fg : bg) << 8;
+	tmp |= ((d & 0x10) ? fg : bg);
+	*((u_long*) dest) = tmp;
+	tmp =  ((d & 0x8) ? fg : bg) << 24;
+	tmp |= ((d & 0x4) ? fg : bg) << 16;
+	tmp |= ((d & 0x2) ? fg : bg) << 8;
+	tmp |= ((d & 0x1) ? fg : bg);
+	*((u_long*) dest + 1) = tmp;
+    }
+}
+
+static void putcs_cyber(struct vc_data *conp, struct display *p, const char *s,
+	                int count, int yy, int xx)
+{
+    u_char *dest, *dest0, *cdat;
+    u_long tmp;
+    u_int rows, underl;
+    u_char c, d;
+    u_char fg, bg;
+
+    dest0 = p->screen_base+yy*p->fontheight*p->next_line+8*xx;
+    fg = p->fgcol;
+    bg = p->bgcol;
+    underl = conp->vc_underline;
+
+    Cyber_WaitBlit();
+    while (count--) {
+	c = *s++;
+	dest = dest0;
+	dest0 += 8;
+	cdat = p->fontdata+(c*p->fontheight);
+	for (rows = p->fontheight; rows--; dest += p->next_line) {
+	    d = *cdat++;
+
+	    if (underl && !rows)
+		d = 0xff;
+
+	    tmp =  ((d & 0x80) ? fg : bg) << 24;
+	    tmp |= ((d & 0x40) ? fg : bg) << 16;
+	    tmp |= ((d & 0x20) ? fg : bg) << 8;
+	    tmp |= ((d & 0x10) ? fg : bg);
+	    *((u_long*) dest) = tmp;
+	    tmp =  ((d & 0x8) ? fg : bg) << 24;
+	    tmp |= ((d & 0x4) ? fg : bg) << 16;
+	    tmp |= ((d & 0x2) ? fg : bg) << 8;
+	    tmp |= ((d & 0x1) ? fg : bg);
+	    *((u_long*) dest + 1) = tmp;
+	}
+    }
+}
+
+
+static void rev_char_cyber(struct display *p, int xx, int yy)
+{
+    unsigned char *dest;
+    unsigned int rows;
+    unsigned char fg, bg;
+
+    fg = p->fgcol;
+    bg = p->bgcol;
+
+    dest = p->screen_base+yy*p->fontheight*p->next_line+8*xx;
+    Cyber_WaitBlit();
+    for (rows = p->fontheight; rows--; dest += p->next_line) {
+	*dest = (*dest == fg) ? bg : fg;
+	*(dest+1) = (*(dest + 1) == fg) ? bg : fg;
+	*(dest+2) = (*(dest + 2) == fg) ? bg : fg;
+	*(dest+3) = (*(dest + 3) == fg) ? bg : fg;
+	*(dest+4) = (*(dest + 4) == fg) ? bg : fg;
+	*(dest+5) = (*(dest + 5) == fg) ? bg : fg;
+	*(dest+6) = (*(dest + 6) == fg) ? bg : fg;
+	*(dest+7) = (*(dest + 7) == fg) ? bg : fg;
+    }
+}
+
+
+#ifdef MODULE
+int init_module(void)
+#else
+int fbcon_init_cyber(void)
+#endif
+{
+    return(fbcon_register_driver(&dispsw_cyber, 1));
+}
+
+#ifdef MODULE
+void cleanup_module(void)
+{
+    fbcon_unregister_driver(&dispsw_cyber);
+}
+#endif /* MODULE */