summaryrefslogtreecommitdiffstats
path: root/sys/dev/syscons/scvgarndr.c
diff options
context:
space:
mode:
Diffstat (limited to 'sys/dev/syscons/scvgarndr.c')
-rw-r--r--sys/dev/syscons/scvgarndr.c829
1 files changed, 829 insertions, 0 deletions
diff --git a/sys/dev/syscons/scvgarndr.c b/sys/dev/syscons/scvgarndr.c
new file mode 100644
index 0000000..16c40e2
--- /dev/null
+++ b/sys/dev/syscons/scvgarndr.c
@@ -0,0 +1,829 @@
+/*-
+ * Copyright (c) 1999 Kazutaka YOKOTA <yokota@zodiac.mech.utsunomiya-u.ac.jp>
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ * notice, this list of conditions and the following disclaimer as
+ * the first lines of this file unmodified.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ * notice, this list of conditions and the following disclaimer in the
+ * documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
+ * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
+ * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
+ * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
+ * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
+ * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
+ * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
+ * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ *
+ * $Id:$
+ */
+
+#include "sc.h"
+#include "vga.h"
+#include "opt_syscons.h"
+#include "opt_vga.h"
+
+#if NSC > 0 && NVGA > 0
+
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/kernel.h>
+
+#include <machine/console.h>
+#include <machine/md_var.h>
+
+#include <dev/fb/fbreg.h>
+#include <dev/fb/vgareg.h>
+#include <dev/syscons/syscons.h>
+
+#include <isa/isareg.h>
+
+#ifndef SC_MOUSE_CHAR
+#define SC_MOUSE_CHAR (0xd0)
+#endif
+
+#ifndef SC_RENDER_DEBUG
+#define SC_RENDER_DEBUG 0
+#endif
+
+static vr_clear_t vga_txtclear;
+static vr_draw_border_t vga_txtborder;
+static vr_draw_t vga_txtdraw;
+static vr_set_cursor_t vga_txtcursor_shape;
+static vr_draw_cursor_t vga_txtcursor;
+static vr_blink_cursor_t vga_txtblink;
+#ifndef SC_NO_CUTPASTE
+static vr_draw_mouse_t vga_txtmouse;
+#else
+#define vga_txtmouse (vr_draw_mouse_t *)vga_nop
+#endif
+
+#ifdef SC_PIXEL_MODE
+static vr_clear_t vga_pxlclear;
+static vr_draw_border_t vga_pxlborder;
+static vr_draw_t vga_egadraw;
+static vr_draw_t vga_vgadraw;
+static vr_set_cursor_t vga_pxlcursor_shape;
+static vr_draw_cursor_t vga_pxlcursor;
+static vr_blink_cursor_t vga_pxlblink;
+#ifndef SC_NO_CUTPASTE
+static vr_draw_mouse_t vga_pxlmouse;
+#else
+#define vga_pxlmouse (vr_draw_mouse_t *)vga_nop
+#endif
+#endif /* SC_PIXEL_MODE */
+
+#ifndef SC_NO_MODE_CHANGE
+static vr_draw_border_t vga_grborder;
+#endif
+
+static void vga_nop(scr_stat *scp, ...);
+
+static sc_rndr_sw_t txtrndrsw = {
+ vga_txtclear,
+ vga_txtborder,
+ vga_txtdraw,
+ vga_txtcursor_shape,
+ vga_txtcursor,
+ vga_txtblink,
+ (vr_set_mouse_t *)vga_nop,
+ vga_txtmouse,
+};
+RENDERER(mda, 0, txtrndrsw);
+RENDERER(cga, 0, txtrndrsw);
+RENDERER(ega, 0, txtrndrsw);
+RENDERER(vga, 0, txtrndrsw);
+
+#ifdef SC_PIXEL_MODE
+static sc_rndr_sw_t egarndrsw = {
+ vga_pxlclear,
+ vga_pxlborder,
+ vga_egadraw,
+ vga_pxlcursor_shape,
+ vga_pxlcursor,
+ vga_pxlblink,
+ (vr_set_mouse_t *)vga_nop,
+ vga_pxlmouse,
+};
+RENDERER(ega, PIXEL_MODE, egarndrsw);
+
+static sc_rndr_sw_t vgarndrsw = {
+ vga_pxlclear,
+ vga_pxlborder,
+ vga_vgadraw,
+ vga_pxlcursor_shape,
+ vga_pxlcursor,
+ vga_pxlblink,
+ (vr_set_mouse_t *)vga_nop,
+ vga_pxlmouse,
+};
+RENDERER(vga, PIXEL_MODE, vgarndrsw);
+#endif /* SC_PIXEL_MODE */
+
+#ifndef SC_NO_MODE_CHANGE
+static sc_rndr_sw_t grrndrsw = {
+ (vr_clear_t *)vga_nop,
+ vga_grborder,
+ (vr_draw_t *)vga_nop,
+ (vr_set_cursor_t *)vga_nop,
+ (vr_draw_cursor_t *)vga_nop,
+ (vr_blink_cursor_t *)vga_nop,
+ (vr_set_mouse_t *)vga_nop,
+ (vr_draw_mouse_t *)vga_nop,
+};
+RENDERER(cga, GRAPHICS_MODE, grrndrsw);
+RENDERER(ega, GRAPHICS_MODE, grrndrsw);
+RENDERER(vga, GRAPHICS_MODE, grrndrsw);
+#endif /* SC_NO_MODE_CHANGE */
+
+#ifndef SC_NO_CUTPASTE
+static u_short mouse_and_mask[16] = {
+ 0xc000, 0xe000, 0xf000, 0xf800, 0xfc00, 0xfe00, 0xff00, 0xff80,
+ 0xfe00, 0x1e00, 0x1f00, 0x0f00, 0x0f00, 0x0000, 0x0000, 0x0000
+};
+static u_short mouse_or_mask[16] = {
+ 0x0000, 0x4000, 0x6000, 0x7000, 0x7800, 0x7c00, 0x7e00, 0x6800,
+ 0x0c00, 0x0c00, 0x0600, 0x0600, 0x0000, 0x0000, 0x0000, 0x0000
+};
+#endif
+
+static void
+vga_nop(scr_stat *scp, ...)
+{
+}
+
+/* text mode renderer */
+
+static void
+vga_txtclear(scr_stat *scp, int c, int attr)
+{
+ sc_vtb_clear(&scp->scr, c, attr);
+}
+
+static void
+vga_txtborder(scr_stat *scp, int color)
+{
+ (*vidsw[scp->sc->adapter]->set_border)(scp->sc->adp, color);
+}
+
+static void
+vga_txtdraw(scr_stat *scp, int from, int count, int flip)
+{
+ vm_offset_t p;
+ int c;
+ int a;
+
+ if (from + count > scp->xsize*scp->ysize)
+ count = scp->xsize*scp->ysize - from;
+
+ if (flip) {
+ for (p = sc_vtb_pointer(&scp->scr, from); count-- > 0; ++from) {
+ c = sc_vtb_getc(&scp->vtb, from);
+ a = sc_vtb_geta(&scp->vtb, from);
+ a = (a & 0x8800) | ((a & 0x7000) >> 4)
+ | ((a & 0x0700) << 4);
+ p = sc_vtb_putchar(&scp->scr, p, c, a);
+ }
+ } else {
+ sc_vtb_copy(&scp->vtb, from, &scp->scr, from, count);
+ }
+}
+
+static void
+vga_txtcursor_shape(scr_stat *scp, int base, int height, int blink)
+{
+ if (base < 0 || base >= scp->font_size)
+ return;
+ /* the caller may set height <= 0 in order to disable the cursor */
+#if 0
+ scp->cursor_base = base;
+ scp->cursor_height = height;
+#endif
+ (*vidsw[scp->sc->adapter]->set_hw_cursor_shape)(scp->sc->adp,
+ base, height,
+ scp->font_size, blink);
+}
+
+static void
+vga_txtcursor(scr_stat *scp, int at, int blink, int on, int flip)
+{
+ video_adapter_t *adp;
+ int cursor_attr;
+
+ if (scp->cursor_height <= 0) /* the text cursor is disabled */
+ return;
+
+ adp = scp->sc->adp;
+ if (blink) {
+ scp->status |= VR_CURSOR_BLINK;
+ if (on) {
+ scp->status |= VR_CURSOR_ON;
+ (*vidsw[adp->va_index]->set_hw_cursor)(adp,
+ at%scp->xsize,
+ at/scp->xsize);
+ } else {
+ if (scp->status & VR_CURSOR_ON)
+ (*vidsw[adp->va_index]->set_hw_cursor)(adp,
+ -1, -1);
+ scp->status &= ~VR_CURSOR_ON;
+ }
+ } else {
+ scp->status &= ~VR_CURSOR_BLINK;
+ if (on) {
+ scp->status |= VR_CURSOR_ON;
+ cursor_attr = sc_vtb_geta(&scp->vtb, at);
+ scp->cursor_saveunder_char = sc_vtb_getc(&scp->scr, at);
+ scp->cursor_saveunder_attr = cursor_attr;
+ if ((cursor_attr & 0x7000) == 0x7000) {
+ cursor_attr &= 0x8f00;
+ if ((cursor_attr & 0x0700) == 0)
+ cursor_attr |= 0x0700;
+ } else {
+ cursor_attr |= 0x7000;
+ if ((cursor_attr & 0x0700) == 0x0700)
+ cursor_attr &= 0xf000;
+ }
+ if (flip)
+ cursor_attr = (cursor_attr & 0x8800)
+ | ((cursor_attr & 0x7000) >> 4)
+ | ((cursor_attr & 0x0700) << 4);
+ sc_vtb_putc(&scp->scr, at,
+ sc_vtb_getc(&scp->scr, at),
+ cursor_attr);
+ } else {
+ cursor_attr = scp->cursor_saveunder_attr;
+ if (flip)
+ cursor_attr = (cursor_attr & 0x8800)
+ | ((cursor_attr & 0x7000) >> 4)
+ | ((cursor_attr & 0x0700) << 4);
+ if (scp->status & VR_CURSOR_ON)
+ sc_vtb_putc(&scp->scr, at,
+ scp->cursor_saveunder_char,
+ cursor_attr);
+ scp->status &= ~VR_CURSOR_ON;
+ }
+ }
+}
+
+static void
+vga_txtblink(scr_stat *scp, int at, int flip)
+{
+}
+
+#ifndef SC_NO_CUTPASTE
+
+static void
+draw_txtmouse(scr_stat *scp, int x, int y)
+{
+#ifndef SC_ALT_MOUSE_IMAGE
+ u_char font_buf[128];
+ u_short cursor[32];
+ int pos;
+ int xoffset, yoffset;
+ int crtc_addr;
+ int i;
+
+ /* prepare mousepointer char's bitmaps */
+ pos = (y/scp->font_size - scp->yoff)*scp->xsize + x/8 - scp->xoff;
+ bcopy(scp->font + sc_vtb_getc(&scp->vtb, pos)*scp->font_size,
+ &font_buf[0], scp->font_size);
+ bcopy(scp->font + sc_vtb_getc(&scp->vtb, pos + 1)*scp->font_size,
+ &font_buf[32], scp->font_size);
+ bcopy(scp->font
+ + sc_vtb_getc(&scp->vtb, pos + scp->xsize)*scp->font_size,
+ &font_buf[64], scp->font_size);
+ bcopy(scp->font
+ + sc_vtb_getc(&scp->vtb, pos + scp->xsize + 1)*scp->font_size,
+ &font_buf[96], scp->font_size);
+ for (i = 0; i < scp->font_size; ++i) {
+ cursor[i] = font_buf[i]<<8 | font_buf[i+32];
+ cursor[i + scp->font_size] = font_buf[i+64]<<8 | font_buf[i+96];
+ }
+
+ /* now and-or in the mousepointer image */
+ xoffset = x%8;
+ yoffset = y%scp->font_size;
+ for (i = 0; i < 16; ++i) {
+ cursor[i + yoffset] =
+ (cursor[i + yoffset] & ~(mouse_and_mask[i] >> xoffset))
+ | (mouse_or_mask[i] >> xoffset);
+ }
+ for (i = 0; i < scp->font_size; ++i) {
+ font_buf[i] = (cursor[i] & 0xff00) >> 8;
+ font_buf[i + 32] = cursor[i] & 0xff;
+ font_buf[i + 64] = (cursor[i + scp->font_size] & 0xff00) >> 8;
+ font_buf[i + 96] = cursor[i + scp->font_size] & 0xff;
+ }
+
+#if 1
+ /* wait for vertical retrace to avoid jitter on some videocards */
+ crtc_addr = scp->sc->adp->va_crtc_addr;
+ while (!(inb(crtc_addr + 6) & 0x08)) /* idle */ ;
+#endif
+ (*vidsw[scp->sc->adapter]->load_font)(scp->sc->adp, 0, 32, font_buf,
+ SC_MOUSE_CHAR, 4);
+
+ sc_vtb_putc(&scp->scr, pos, SC_MOUSE_CHAR, sc_vtb_geta(&scp->scr, pos));
+ /* FIXME: may be out of range! */
+ sc_vtb_putc(&scp->scr, pos + scp->xsize, SC_MOUSE_CHAR + 2,
+ sc_vtb_geta(&scp->scr, pos + scp->xsize));
+ if (x < (scp->xsize - 1)*8) {
+ sc_vtb_putc(&scp->scr, pos + 1, SC_MOUSE_CHAR + 1,
+ sc_vtb_geta(&scp->scr, pos + 1));
+ sc_vtb_putc(&scp->scr, pos + scp->xsize + 1, SC_MOUSE_CHAR + 3,
+ sc_vtb_geta(&scp->scr, pos + scp->xsize + 1));
+ }
+#else /* SC_ALT_MOUSE_IMAGE */
+ /* Red, magenta and brown are mapped to green to to keep it readable */
+ static const int col_conv[16] = {
+ 6, 6, 6, 6, 2, 2, 2, 6, 14, 14, 14, 14, 10, 10, 10, 14
+ };
+ int pos;
+ int color;
+ int a;
+
+ pos = (y/scp->font_size - scp->yoff)*scp->xsize + x/8 - scp->xoff;
+ a = sc_vtb_geta(&scp->scr, pos);
+ if (scp->sc->adp->va_flags & V_ADP_COLOR)
+ color = (col_conv[(a & 0xf000) >> 12] << 12)
+ | ((a & 0x0f00) | 0x0800);
+ else
+ color = ((a & 0xf000) >> 4) | ((a & 0x0f00) << 4);
+ sc_vtb_putc(&scp->scr, pos, sc_vtb_getc(&scp->scr, pos), color);
+#endif /* SC_ALT_MOUSE_IMAGE */
+}
+
+static void
+remove_txtmouse(scr_stat *scp, int x, int y)
+{
+}
+
+static void
+vga_txtmouse(scr_stat *scp, int x, int y, int on)
+{
+ if (on)
+ draw_txtmouse(scp, x, y);
+ else
+ remove_txtmouse(scp, x, y);
+}
+
+#endif /* SC_NO_CUTPASTE */
+
+#ifdef SC_PIXEL_MODE
+
+/* pixel (raster text) mode renderer */
+
+static void
+vga_pxlclear(scr_stat *scp, int c, int attr)
+{
+ vm_offset_t p;
+ int line_width;
+ int lines;
+ int i;
+
+ /* XXX: we are just filling the screen with the background color... */
+ outw(GDCIDX, 0x0005); /* read mode 0, write mode 0 */
+ outw(GDCIDX, 0x0003); /* data rotate/function select */
+ outw(GDCIDX, 0x0f01); /* set/reset enable */
+ outw(GDCIDX, 0xff08); /* bit mask */
+ outw(GDCIDX, ((attr & 0xf000) >> 4) | 0x00); /* set/reset */
+ line_width = scp->sc->adp->va_line_width;
+ lines = scp->ysize*scp->font_size;
+ p = scp->sc->adp->va_window + line_width*scp->yoff*scp->font_size
+ + scp->xoff;
+ for (i = 0; i < lines; ++i) {
+ bzero_io((void *)p, scp->xsize);
+ p += line_width;
+ }
+ outw(GDCIDX, 0x0000); /* set/reset */
+ outw(GDCIDX, 0x0001); /* set/reset enable */
+}
+
+static void
+vga_pxlborder(scr_stat *scp, int color)
+{
+ vm_offset_t p;
+ int line_width;
+ int i;
+
+ (*vidsw[scp->sc->adapter]->set_border)(scp->sc->adp, color);
+
+ outw(GDCIDX, 0x0005); /* read mode 0, write mode 0 */
+ outw(GDCIDX, 0x0003); /* data rotate/function select */
+ outw(GDCIDX, 0x0f01); /* set/reset enable */
+ outw(GDCIDX, 0xff08); /* bit mask */
+ outw(GDCIDX, (color << 8) | 0x00); /* set/reset */
+ line_width = scp->sc->adp->va_line_width;
+ p = scp->sc->adp->va_window;
+ if (scp->yoff > 0) {
+ bzero_io((void *)p, line_width*scp->yoff*scp->font_size);
+ bzero_io((void *)(p + line_width*(scp->yoff + scp->ysize)
+ *scp->font_size),
+ line_width*(scp->ypixel
+ - (scp->yoff + scp->ysize)*scp->font_size));
+ }
+ if (scp->xoff > 0) {
+ for (i = 0; i < scp->ysize*scp->font_size; ++i) {
+ bzero_io((void *)(p + line_width
+ *(scp->yoff*scp->font_size + i)),
+ scp->xoff);
+ bzero_io((void *)(p + line_width
+ *(scp->yoff*scp->font_size + i)
+ + scp->xoff + scp->xsize),
+ scp->xpixel/8 - scp->xoff - scp->xsize);
+ }
+ }
+ outw(GDCIDX, 0x0000); /* set/reset */
+ outw(GDCIDX, 0x0001); /* set/reset enable */
+}
+
+static void
+vga_egadraw(scr_stat *scp, int from, int count, int flip)
+{
+ vm_offset_t d;
+ vm_offset_t e;
+ u_char *f;
+ u_short bg;
+ u_short col1, col2;
+ int line_width;
+ int i, j;
+ int a;
+ u_char c;
+
+ line_width = scp->sc->adp->va_line_width;
+ d = scp->sc->adp->va_window
+ + scp->xoff
+ + scp->yoff*scp->font_size*line_width
+ + (from%scp->xsize)
+ + scp->font_size*line_width*(from/scp->xsize);
+
+ outw(GDCIDX, 0x0005); /* read mode 0, write mode 0 */
+ outw(GDCIDX, 0x0003); /* data rotate/function select */
+ outw(GDCIDX, 0x0f01); /* set/reset enable */
+ bg = -1;
+ if (from + count > scp->xsize*scp->ysize)
+ count = scp->xsize*scp->ysize - from;
+ for (i = from; count-- > 0; ++i) {
+ a = sc_vtb_geta(&scp->vtb, i);
+ if (flip) {
+ col1 = ((a & 0x7000) >> 4) | (a & 0x0800);
+ col2 = ((a & 0x8000) >> 4) | (a & 0x0700);
+ } else {
+ col1 = (a & 0x0f00);
+ col2 = (a & 0xf000) >> 4;
+ }
+ /* set background color in EGA/VGA latch */
+ if (bg != col2) {
+ bg = col2;
+ outw(GDCIDX, bg | 0x00); /* set/reset */
+ outw(GDCIDX, 0xff08); /* bit mask */
+ writeb(d, 0);
+ c = readb(d); /* set bg color in the latch */
+ }
+ /* foreground color */
+ outw(GDCIDX, col1 | 0x00); /* set/reset */
+ e = d;
+ f = &(scp->font[sc_vtb_getc(&scp->vtb, i)*scp->font_size]);
+ for (j = 0; j < scp->font_size; ++j, ++f) {
+ outw(GDCIDX, (*f << 8) | 0x08); /* bit mask */
+ writeb(e, 0);
+ e += line_width;
+ }
+ ++d;
+ if ((i % scp->xsize) == scp->xsize - 1)
+ d += scp->xoff*2
+ + (scp->font_size - 1)*line_width;
+ }
+ outw(GDCIDX, 0x0000); /* set/reset */
+ outw(GDCIDX, 0x0001); /* set/reset enable */
+ outw(GDCIDX, 0xff08); /* bit mask */
+}
+
+static void
+vga_vgadraw(scr_stat *scp, int from, int count, int flip)
+{
+ vm_offset_t d;
+ vm_offset_t e;
+ u_char *f;
+ u_short bg;
+ u_short col1, col2;
+ int line_width;
+ int i, j;
+ int a;
+ u_char c;
+
+ line_width = scp->sc->adp->va_line_width;
+ d = scp->sc->adp->va_window
+ + scp->xoff
+ + scp->yoff*scp->font_size*line_width
+ + (from%scp->xsize)
+ + scp->font_size*line_width*(from/scp->xsize);
+
+ outw(GDCIDX, 0x0305); /* read mode 0, write mode 3 */
+ outw(GDCIDX, 0x0003); /* data rotate/function select */
+ outw(GDCIDX, 0x0f01); /* set/reset enable */
+ outw(GDCIDX, 0xff08); /* bit mask */
+ bg = -1;
+ if (from + count > scp->xsize*scp->ysize)
+ count = scp->xsize*scp->ysize - from;
+ for (i = from; count-- > 0; ++i) {
+ a = sc_vtb_geta(&scp->vtb, i);
+ if (flip) {
+ col1 = ((a & 0x7000) >> 4) | (a & 0x0800);
+ col2 = ((a & 0x8000) >> 4) | (a & 0x0700);
+ } else {
+ col1 = (a & 0x0f00);
+ col2 = (a & 0xf000) >> 4;
+ }
+ /* set background color in EGA/VGA latch */
+ if (bg != col2) {
+ bg = col2;
+ outw(GDCIDX, 0x0005); /* read mode 0, write mode 0 */
+ outw(GDCIDX, bg | 0x00); /* set/reset */
+ writeb(d, 0);
+ c = readb(d); /* set bg color in the latch */
+ outw(GDCIDX, 0x0305); /* read mode 0, write mode 3 */
+ }
+ /* foreground color */
+ outw(GDCIDX, col1 | 0x00); /* set/reset */
+ e = d;
+ f = &(scp->font[sc_vtb_getc(&scp->vtb, i)*scp->font_size]);
+ for (j = 0; j < scp->font_size; ++j, ++f) {
+ writeb(e, *f);
+ e += line_width;
+ }
+ ++d;
+ if ((i % scp->xsize) == scp->xsize - 1)
+ d += scp->xoff*2
+ + (scp->font_size - 1)*line_width;
+ }
+ outw(GDCIDX, 0x0005); /* read mode 0, write mode 0 */
+ outw(GDCIDX, 0x0000); /* set/reset */
+ outw(GDCIDX, 0x0001); /* set/reset enable */
+}
+
+static void
+vga_pxlcursor_shape(scr_stat *scp, int base, int height, int blink)
+{
+ if (base < 0 || base >= scp->font_size)
+ return;
+ /* the caller may set height <= 0 in order to disable the cursor */
+#if 0
+ scp->cursor_base = base;
+ scp->cursor_height = height;
+#endif
+}
+
+static void
+draw_pxlcursor(scr_stat *scp, int at, int on, int flip)
+{
+ vm_offset_t d;
+ u_char *f;
+ int line_width;
+ int height;
+ int col;
+ int a;
+ int i;
+ u_char c;
+
+ line_width = scp->sc->adp->va_line_width;
+ d = scp->sc->adp->va_window
+ + scp->xoff
+ + scp->yoff*scp->font_size*line_width
+ + (at%scp->xsize)
+ + scp->font_size*line_width*(at/scp->xsize)
+ + (scp->font_size - scp->cursor_base - 1)*line_width;
+
+ outw(GDCIDX, 0x0005); /* read mode 0, write mode 0 */
+ outw(GDCIDX, 0x0003); /* data rotate/function select */
+ outw(GDCIDX, 0x0f01); /* set/reset enable */
+ /* set background color in EGA/VGA latch */
+ a = sc_vtb_geta(&scp->vtb, at);
+ if (flip)
+ col = (on) ? ((a & 0xf000) >> 4) : (a & 0x0f00);
+ else
+ col = (on) ? (a & 0x0f00) : ((a & 0xf000) >> 4);
+ outw(GDCIDX, col | 0x00); /* set/reset */
+ outw(GDCIDX, 0xff08); /* bit mask */
+ writeb(d, 0);
+ c = readb(d); /* set bg color in the latch */
+ /* foreground color */
+ if (flip)
+ col = (on) ? (a & 0x0f00) : ((a & 0xf000) >> 4);
+ else
+ col = (on) ? ((a & 0xf000) >> 4) : (a & 0x0f00);
+ outw(GDCIDX, col | 0x00); /* set/reset */
+ f = &(scp->font[sc_vtb_getc(&scp->vtb, at)*scp->font_size
+ + scp->font_size - scp->cursor_base - 1]);
+ height = imin(scp->cursor_height, scp->font_size);
+ for (i = 0; i < height; ++i, --f) {
+ outw(GDCIDX, (*f << 8) | 0x08); /* bit mask */
+ writeb(d, 0);
+ d -= line_width;
+ }
+ outw(GDCIDX, 0x0000); /* set/reset */
+ outw(GDCIDX, 0x0001); /* set/reset enable */
+ outw(GDCIDX, 0xff08); /* bit mask */
+}
+
+static void
+vga_pxlcursor(scr_stat *scp, int at, int blink, int on, int flip)
+{
+ if (scp->cursor_height <= 0) /* the text cursor is disabled */
+ return;
+
+ if (on) {
+ scp->status |= VR_CURSOR_ON;
+ draw_pxlcursor(scp, at, on, flip);
+ } else {
+ if (scp->status & VR_CURSOR_ON)
+ draw_pxlcursor(scp, at, on, flip);
+ scp->status &= ~VR_CURSOR_ON;
+ }
+ if (blink)
+ scp->status |= VR_CURSOR_BLINK;
+ else
+ scp->status &= ~VR_CURSOR_BLINK;
+}
+
+static void
+vga_pxlblink(scr_stat *scp, int at, int flip)
+{
+ static int blinkrate = 0;
+
+ if (!(scp->status & VR_CURSOR_BLINK))
+ return;
+ if (!(++blinkrate & 4))
+ return;
+ blinkrate = 0;
+ scp->status ^= VR_CURSOR_ON;
+ draw_pxlcursor(scp, at, scp->status & VR_CURSOR_ON, flip);
+}
+
+#ifndef SC_NO_CUTPASTE
+
+static void
+draw_pxlmouse(scr_stat *scp, int x, int y)
+{
+ vm_offset_t p;
+ int line_width;
+ int xoff, yoff;
+ int ymax;
+ u_short m;
+ int i, j;
+
+ line_width = scp->sc->adp->va_line_width;
+ xoff = (x - scp->xoff*8)%8;
+ yoff = y - (y/line_width)*line_width;
+ ymax = imin(y + 16, scp->ypixel);
+
+ outw(GDCIDX, 0x0805); /* read mode 1, write mode 0 */
+ outw(GDCIDX, 0x0001); /* set/reset enable */
+ outw(GDCIDX, 0x0002); /* color compare */
+ outw(GDCIDX, 0x0007); /* color don't care */
+ outw(GDCIDX, 0xff08); /* bit mask */
+ outw(GDCIDX, 0x0803); /* data rotate/function select (and) */
+ p = scp->sc->adp->va_window + line_width*y + x/8;
+ if (x < scp->xpixel - 16) {
+ for (i = y, j = 0; i < ymax; ++i, ++j) {
+ m = ~(mouse_and_mask[j] >> xoff);
+#ifdef __i386__
+ *(u_char *)p &= m >> 8;
+ *(u_char *)(p + 1) &= m;
+#elif defined(__alpha__)
+ writeb(p, readb(p) & (m >> 8));
+ writeb(p + 1, readb(p + 1) & (m >> 8));
+#endif
+ p += line_width;
+ }
+ } else {
+ xoff += 8;
+ for (i = y, j = 0; i < ymax; ++i, ++j) {
+ m = ~(mouse_and_mask[j] >> xoff);
+#ifdef __i386__
+ *(u_char *)p &= m;
+#elif defined(__alpha__)
+ writeb(p, readb(p) & (m >> 8));
+#endif
+ p += line_width;
+ }
+ }
+ outw(GDCIDX, 0x1003); /* data rotate/function select (or) */
+ p = scp->sc->adp->va_window + line_width*y + x/8;
+ if (x < scp->xpixel - 16) {
+ for (i = y, j = 0; i < ymax; ++i, ++j) {
+ m = mouse_or_mask[j] >> xoff;
+#ifdef __i386__
+ *(u_char *)p &= m >> 8;
+ *(u_char *)(p + 1) &= m;
+#elif defined(__alpha__)
+ writeb(p, readb(p) & (m >> 8));
+ writeb(p + 1, readb(p + 1) & (m >> 8));
+#endif
+ p += line_width;
+ }
+ } else {
+ for (i = y, j = 0; i < ymax; ++i, ++j) {
+ m = mouse_or_mask[j] >> xoff;
+#ifdef __i386__
+ *(u_char *)p &= m;
+#elif defined(__alpha__)
+ writeb(p, readb(p) & (m >> 8));
+#endif
+ p += line_width;
+ }
+ }
+ outw(GDCIDX, 0x0005); /* read mode 0, write mode 0 */
+ outw(GDCIDX, 0x0003); /* data rotate/function select */
+}
+
+static void
+remove_pxlmouse(scr_stat *scp, int x, int y)
+{
+ vm_offset_t p;
+ int col, row;
+ int pos;
+ int line_width;
+ int ymax;
+ int i;
+
+ /* erase the mouse cursor image */
+ col = x/8 - scp->xoff;
+ row = y/scp->font_size - scp->yoff;
+ pos = row*scp->xsize + col;
+ i = (col < scp->xsize - 1) ? 2 : 1;
+ (*scp->rndr->draw)(scp, pos, i, FALSE);
+ if (row < scp->ysize - 1)
+ (*scp->rndr->draw)(scp, pos + scp->xsize, i, FALSE);
+
+ /* paint border if necessary */
+ line_width = scp->sc->adp->va_line_width;
+ outw(GDCIDX, 0x0005); /* read mode 0, write mode 0 */
+ outw(GDCIDX, 0x0003); /* data rotate/function select */
+ outw(GDCIDX, 0x0f01); /* set/reset enable */
+ outw(GDCIDX, 0xff08); /* bit mask */
+ outw(GDCIDX, (scp->border << 8) | 0x00); /* set/reset */
+ if (row == scp->ysize - 1) {
+ i = (scp->ysize + scp->yoff)*scp->font_size;
+ ymax = imin(i + scp->font_size, scp->ypixel);
+ p = scp->sc->adp->va_window + i*line_width + scp->xoff + col;
+ if (col < scp->xsize - 1) {
+ for (; i < ymax; ++i) {
+ writeb(p, 0);
+ writeb(p + 1, 0);
+ p += line_width;
+ }
+ } else {
+ for (; i < ymax; ++i) {
+ writeb(p, 0);
+ p += line_width;
+ }
+ }
+ }
+ if ((col == scp->xsize - 1) && (scp->xoff > 0)) {
+ i = (row + scp->yoff)*scp->font_size;
+ ymax = imin(i + scp->font_size*2, scp->ypixel);
+ p = scp->sc->adp->va_window + i*line_width
+ + scp->xoff + scp->xsize;
+ for (; i < ymax; ++i) {
+ writeb(p, 0);
+ p += line_width;
+ }
+ }
+ outw(GDCIDX, 0x0000); /* set/reset */
+ outw(GDCIDX, 0x0001); /* set/reset enable */
+}
+
+static void
+vga_pxlmouse(scr_stat *scp, int x, int y, int on)
+{
+ if (on)
+ draw_pxlmouse(scp, x, y);
+ else
+ remove_pxlmouse(scp, x, y);
+}
+
+#endif /* SC_NO_CUTPASTE */
+#endif /* SC_PIXEL_MODE */
+
+#ifndef SC_NO_MODE_CHANGE
+
+/* graphics mode renderer */
+
+static void
+vga_grborder(scr_stat *scp, int color)
+{
+ (*vidsw[scp->sc->adapter]->set_border)(scp->sc->adp, color);
+}
+
+#endif
+
+#endif /* NSC > 0 && NVGA > 0 */
OpenPOWER on IntegriCloud