sys/dev/misc/syscons/scvgarndr.c

   1 /*-
   2  * Copyright (c) 1999 Kazutaka YOKOTA <yokota@zodiac.mech.utsunomiya-u.ac.jp>
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer as
  10  *    the first lines of this file unmodified.
  11  * 2. Redistributions in binary form must reproduce the above copyright
  12  *    notice, this list of conditions and the following disclaimer in the
  13  *    documentation and/or other materials provided with the distribution.
  14  *
  15  * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
  16  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  17  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  18  * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
  19  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  20  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  21  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  22  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  23  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  24  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  25  *
  26  * $FreeBSD: src/sys/dev/syscons/scvgarndr.c,v 1.5.2.3 2001/07/28 12:51:47 yokota Exp $
  27  * $DragonFly: src/sys/dev/misc/syscons/scvgarndr.c,v 1.4 2003/11/10 06:12:06 dillon Exp $
  28  */
  29
  30 #include "opt_syscons.h"
  31 #include "opt_vga.h"
  32
  33 #include <sys/param.h>
  34 #include <sys/systm.h>
  35 #include <sys/kernel.h>
  36
  37 #include <machine/console.h>
  38
  39 #include <dev/video/fb/fbreg.h>
  40 #include <dev/video/fb/vgareg.h>
  41 #include "syscons.h"
  42
  43 #include <bus/isa/isareg.h>
  44
  45 #ifndef SC_RENDER_DEBUG
  46 #define SC_RENDER_DEBUG         0
  47 #endif
  48
  49 static vr_clear_t               vga_txtclear;
  50 static vr_draw_border_t         vga_txtborder;
  51 static vr_draw_t                vga_txtdraw;
  52 static vr_set_cursor_t          vga_txtcursor_shape;
  53 static vr_draw_cursor_t         vga_txtcursor;
  54 static vr_blink_cursor_t        vga_txtblink;
  55 #ifndef SC_NO_CUTPASTE
  56 static vr_draw_mouse_t          vga_txtmouse;
  57 #else
  58 #define vga_txtmouse            (vr_draw_mouse_t *)vga_nop
  59 #endif
  60
  61 #ifdef SC_PIXEL_MODE
  62 static vr_clear_t               vga_pxlclear;
  63 static vr_draw_border_t         vga_pxlborder;
  64 static vr_draw_t                vga_egadraw;
  65 static vr_draw_t                vga_vgadraw;
  66 static vr_set_cursor_t          vga_pxlcursor_shape;
  67 static vr_draw_cursor_t         vga_pxlcursor;
  68 static vr_blink_cursor_t        vga_pxlblink;
  69 #ifndef SC_NO_CUTPASTE
  70 static vr_draw_mouse_t          vga_pxlmouse;
  71 #else
  72 #define vga_pxlmouse            (vr_draw_mouse_t *)vga_nop
  73 #endif
  74 #endif /* SC_PIXEL_MODE */
  75
  76 #ifndef SC_NO_MODE_CHANGE
  77 static vr_draw_border_t         vga_grborder;
  78 #endif
  79
  80 static void                     vga_nop(scr_stat *scp, ...);
  81
  82 static sc_rndr_sw_t txtrndrsw = {
  83         vga_txtclear,
  84         vga_txtborder,
  85         vga_txtdraw,
  86         vga_txtcursor_shape,
  87         vga_txtcursor,
  88         vga_txtblink,
  89         (vr_set_mouse_t *)vga_nop,
  90         vga_txtmouse,
  91 };
  92 RENDERER(mda, 0, txtrndrsw, vga_set);
  93 RENDERER(cga, 0, txtrndrsw, vga_set);
  94 RENDERER(ega, 0, txtrndrsw, vga_set);
  95 RENDERER(vga, 0, txtrndrsw, vga_set);
  96
  97 #ifdef SC_PIXEL_MODE
  98 static sc_rndr_sw_t egarndrsw = {
  99         vga_pxlclear,
 100         vga_pxlborder,
 101         vga_egadraw,
 102         vga_pxlcursor_shape,
 103         vga_pxlcursor,
 104         vga_pxlblink,
 105         (vr_set_mouse_t *)vga_nop,
 106         vga_pxlmouse,
 107 };
 108 RENDERER(ega, PIXEL_MODE, egarndrsw, vga_set);
 109
 110 static sc_rndr_sw_t vgarndrsw = {
 111         vga_pxlclear,
 112         vga_pxlborder,
 113         vga_vgadraw,
 114         vga_pxlcursor_shape,
 115         vga_pxlcursor,
 116         vga_pxlblink,
 117         (vr_set_mouse_t *)vga_nop,
 118         vga_pxlmouse,
 119 };
 120 RENDERER(vga, PIXEL_MODE, vgarndrsw, vga_set);
 121 #endif /* SC_PIXEL_MODE */
 122
 123 #ifndef SC_NO_MODE_CHANGE
 124 static sc_rndr_sw_t grrndrsw = {
 125         (vr_clear_t *)vga_nop,
 126         vga_grborder,
 127         (vr_draw_t *)vga_nop,
 128         (vr_set_cursor_t *)vga_nop,
 129         (vr_draw_cursor_t *)vga_nop,
 130         (vr_blink_cursor_t *)vga_nop,
 131         (vr_set_mouse_t *)vga_nop,
 132         (vr_draw_mouse_t *)vga_nop,
 133 };
 134 RENDERER(cga, GRAPHICS_MODE, grrndrsw, vga_set);
 135 RENDERER(ega, GRAPHICS_MODE, grrndrsw, vga_set);
 136 RENDERER(vga, GRAPHICS_MODE, grrndrsw, vga_set);
 137 #endif /* SC_NO_MODE_CHANGE */
 138
 139 RENDERER_MODULE(vga, vga_set);
 140
 141 #ifndef SC_NO_CUTPASTE
 142 static u_short mouse_and_mask[16] = {
 143         0xc000, 0xe000, 0xf000, 0xf800, 0xfc00, 0xfe00, 0xff00, 0xff80,
 144         0xfe00, 0x1e00, 0x1f00, 0x0f00, 0x0f00, 0x0000, 0x0000, 0x0000
 145 };
 146 static u_short mouse_or_mask[16] = {
 147         0x0000, 0x4000, 0x6000, 0x7000, 0x7800, 0x7c00, 0x7e00, 0x6800,
 148         0x0c00, 0x0c00, 0x0600, 0x0600, 0x0000, 0x0000, 0x0000, 0x0000
 149 };
 150 #endif
 151
 152 static void
 153 vga_nop(scr_stat *scp, ...)
 154 {
 155 }
 156
 157 /* text mode renderer */
 158
 159 static void
 160 vga_txtclear(scr_stat *scp, int c, int attr)
 161 {
 162         sc_vtb_clear(&scp->scr, c, attr);
 163 }
 164
 165 static void
 166 vga_txtborder(scr_stat *scp, int color)
 167 {
 168         (*vidsw[scp->sc->adapter]->set_border)(scp->sc->adp, color);
 169 }
 170
 171 static void
 172 vga_txtdraw(scr_stat *scp, int from, int count, int flip)
 173 {
 174         vm_offset_t p;
 175         int c;
 176         int a;
 177
 178         if (from + count > scp->xsize*scp->ysize)
 179                 count = scp->xsize*scp->ysize - from;
 180
 181         if (flip) {
 182                 for (p = sc_vtb_pointer(&scp->scr, from); count-- > 0; ++from) {
 183                         c = sc_vtb_getc(&scp->vtb, from);
 184                         a = sc_vtb_geta(&scp->vtb, from);
 185                         a = (a & 0x8800) | ((a & 0x7000) >> 4)
 186                                 | ((a & 0x0700) << 4);
 187                         p = sc_vtb_putchar(&scp->scr, p, c, a);
 188                 }
 189         } else {
 190                 sc_vtb_copy(&scp->vtb, from, &scp->scr, from, count);
 191         }
 192 }
 193
 194 static void
 195 vga_txtcursor_shape(scr_stat *scp, int base, int height, int blink)
 196 {
 197         if (base < 0 || base >= scp->font_size)
 198                 return;
 199         /* the caller may set height <= 0 in order to disable the cursor */
 200 #if 0
 201         scp->cursor_base = base;
 202         scp->cursor_height = height;
 203 #endif
 204         (*vidsw[scp->sc->adapter]->set_hw_cursor_shape)(scp->sc->adp,
 205                                                         base, height,
 206                                                         scp->font_size, blink);
 207 }
 208
 209 static void
 210 draw_txtcharcursor(scr_stat *scp, int at, u_short c, u_short a, int flip)
 211 {
 212         sc_softc_t *sc;
 213
 214         sc = scp->sc;
 215         scp->cursor_saveunder_char = c;
 216         scp->cursor_saveunder_attr = a;
 217
 218 #ifndef SC_NO_FONT_LOADING
 219         if (sc->flags & SC_CHAR_CURSOR) {
 220                 unsigned char *font;
 221                 int h;
 222                 int i;
 223
 224                 if (scp->font_size < 14) {
 225                         font = sc->font_8;
 226                         h = 8;
 227                 } else if (scp->font_size >= 16) {
 228                         font = sc->font_16;
 229                         h = 16;
 230                 } else {
 231                         font = sc->font_14;
 232                         h = 14;
 233                 }
 234                 if (scp->cursor_base >= h)
 235                         return;
 236                 if (flip)
 237                         a = (a & 0x8800)
 238                                 | ((a & 0x7000) >> 4) | ((a & 0x0700) << 4);
 239                 bcopy(font + c*h, font + sc->cursor_char*h, h);
 240                 font = font + sc->cursor_char*h;
 241                 for (i = imax(h - scp->cursor_base - scp->cursor_height, 0);
 242                         i < h - scp->cursor_base; ++i) {
 243                         font[i] ^= 0xff;
 244                 }
 245                 sc->font_loading_in_progress = TRUE;
 246                 /* XXX */
 247                 (*vidsw[sc->adapter]->load_font)(sc->adp, 0, h, font,
 248                                                  sc->cursor_char, 1);
 249                 sc->font_loading_in_progress = FALSE;
 250                 sc_vtb_putc(&scp->scr, at, sc->cursor_char, a);
 251         } else
 252 #endif /* SC_NO_FONT_LOADING */
 253         {
 254                 if ((a & 0x7000) == 0x7000) {
 255                         a &= 0x8f00;
 256                         if ((a & 0x0700) == 0)
 257                                 a |= 0x0700;
 258                 } else {
 259                         a |= 0x7000;
 260                         if ((a & 0x0700) == 0x0700)
 261                                 a &= 0xf000;
 262                 }
 263                 if (flip)
 264                         a = (a & 0x8800)
 265                                 | ((a & 0x7000) >> 4) | ((a & 0x0700) << 4);
 266                 sc_vtb_putc(&scp->scr, at, c, a);
 267         }
 268 }
 269
 270 static void
 271 vga_txtcursor(scr_stat *scp, int at, int blink, int on, int flip)
 272 {
 273         video_adapter_t *adp;
 274         int cursor_attr;
 275
 276         if (scp->cursor_height <= 0)    /* the text cursor is disabled */
 277                 return;
 278
 279         adp = scp->sc->adp;
 280         if (blink) {
 281                 scp->status |= VR_CURSOR_BLINK;
 282                 if (on) {
 283                         scp->status |= VR_CURSOR_ON;
 284                         (*vidsw[adp->va_index]->set_hw_cursor)(adp,
 285                                                                at%scp->xsize,
 286                                                                at/scp->xsize);
 287                 } else {
 288                         if (scp->status & VR_CURSOR_ON)
 289                                 (*vidsw[adp->va_index]->set_hw_cursor)(adp,
 290                                                                        -1, -1);
 291                         scp->status &= ~VR_CURSOR_ON;
 292                 }
 293         } else {
 294                 scp->status &= ~VR_CURSOR_BLINK;
 295                 if (on) {
 296                         scp->status |= VR_CURSOR_ON;
 297                         draw_txtcharcursor(scp, at,
 298                                            sc_vtb_getc(&scp->scr, at),
 299                                            sc_vtb_geta(&scp->scr, at),
 300                                            flip);
 301                 } else {
 302                         cursor_attr = scp->cursor_saveunder_attr;
 303                         if (flip)
 304                                 cursor_attr = (cursor_attr & 0x8800)
 305                                         | ((cursor_attr & 0x7000) >> 4)
 306                                         | ((cursor_attr & 0x0700) << 4);
 307                         if (scp->status & VR_CURSOR_ON)
 308                                 sc_vtb_putc(&scp->scr, at,
 309                                             scp->cursor_saveunder_char,
 310                                             cursor_attr);
 311                         scp->status &= ~VR_CURSOR_ON;
 312                 }
 313         }
 314 }
 315
 316 static void
 317 vga_txtblink(scr_stat *scp, int at, int flip)
 318 {
 319 }
 320
 321 #ifndef SC_NO_CUTPASTE
 322
 323 static void
 324 draw_txtmouse(scr_stat *scp, int x, int y)
 325 {
 326 #ifndef SC_ALT_MOUSE_IMAGE
 327     if (ISMOUSEAVAIL(scp->sc->adp->va_flags)) {
 328         u_char font_buf[128];
 329         u_short cursor[32];
 330         u_char c;
 331         int pos;
 332         int xoffset, yoffset;
 333         int crtc_addr;
 334         int i;
 335
 336         /* prepare mousepointer char's bitmaps */
 337         pos = (y/scp->font_size - scp->yoff)*scp->xsize + x/8 - scp->xoff;
 338         bcopy(scp->font + sc_vtb_getc(&scp->scr, pos)*scp->font_size,
 339               &font_buf[0], scp->font_size);
 340         bcopy(scp->font + sc_vtb_getc(&scp->scr, pos + 1)*scp->font_size,
 341               &font_buf[32], scp->font_size);
 342         bcopy(scp->font
 343                  + sc_vtb_getc(&scp->scr, pos + scp->xsize)*scp->font_size,
 344               &font_buf[64], scp->font_size);
 345         bcopy(scp->font
 346                  + sc_vtb_getc(&scp->scr, pos + scp->xsize + 1)*scp->font_size,
 347               &font_buf[96], scp->font_size);
 348         for (i = 0; i < scp->font_size; ++i) {
 349                 cursor[i] = font_buf[i]<<8 | font_buf[i+32];
 350                 cursor[i + scp->font_size] = font_buf[i+64]<<8 | font_buf[i+96];
 351         }
 352
 353         /* now and-or in the mousepointer image */
 354         xoffset = x%8;
 355         yoffset = y%scp->font_size;
 356         for (i = 0; i < 16; ++i) {
 357                 cursor[i + yoffset] =
 358                         (cursor[i + yoffset] & ~(mouse_and_mask[i] >> xoffset))
 359                         | (mouse_or_mask[i] >> xoffset);
 360         }
 361         for (i = 0; i < scp->font_size; ++i) {
 362                 font_buf[i] = (cursor[i] & 0xff00) >> 8;
 363                 font_buf[i + 32] = cursor[i] & 0xff;
 364                 font_buf[i + 64] = (cursor[i + scp->font_size] & 0xff00) >> 8;
 365                 font_buf[i + 96] = cursor[i + scp->font_size] & 0xff;
 366         }
 367
 368 #if 1
 369         /* wait for vertical retrace to avoid jitter on some videocards */
 370         crtc_addr = scp->sc->adp->va_crtc_addr;
 371         while (!(inb(crtc_addr + 6) & 0x08)) /* idle */ ;
 372 #endif
 373         c = scp->sc->mouse_char;
 374         (*vidsw[scp->sc->adapter]->load_font)(scp->sc->adp, 0, 32, font_buf,
 375                                               c, 4);
 376
 377         sc_vtb_putc(&scp->scr, pos, c, sc_vtb_geta(&scp->scr, pos));
 378         /* FIXME: may be out of range! */
 379         sc_vtb_putc(&scp->scr, pos + scp->xsize, c + 2,
 380                     sc_vtb_geta(&scp->scr, pos + scp->xsize));
 381         if (x < (scp->xsize - 1)*8) {
 382                 sc_vtb_putc(&scp->scr, pos + 1, c + 1,
 383                             sc_vtb_geta(&scp->scr, pos + 1));
 384                 sc_vtb_putc(&scp->scr, pos + scp->xsize + 1, c + 3,
 385                             sc_vtb_geta(&scp->scr, pos + scp->xsize + 1));
 386         }
 387     } else
 388 #endif /* SC_ALT_MOUSE_IMAGE */
 389     {
 390         /* Red, magenta and brown are mapped to green to to keep it readable */
 391         static const int col_conv[16] = {
 392                 6, 6, 6, 6, 2, 2, 2, 6, 14, 14, 14, 14, 10, 10, 10, 14
 393         };
 394         int pos;
 395         int color;
 396         int a;
 397
 398         pos = (y/scp->font_size - scp->yoff)*scp->xsize + x/8 - scp->xoff;
 399         a = sc_vtb_geta(&scp->scr, pos);
 400         if (scp->sc->adp->va_flags & V_ADP_COLOR)
 401                 color = (col_conv[(a & 0xf000) >> 12] << 12)
 402                         | ((a & 0x0f00) | 0x0800);
 403         else
 404                 color = ((a & 0xf000) >> 4) | ((a & 0x0f00) << 4);
 405         sc_vtb_putc(&scp->scr, pos, sc_vtb_getc(&scp->scr, pos), color);
 406     }
 407 }
 408
 409 static void
 410 remove_txtmouse(scr_stat *scp, int x, int y)
 411 {
 412 }
 413
 414 static void
 415 vga_txtmouse(scr_stat *scp, int x, int y, int on)
 416 {
 417         if (on)
 418                 draw_txtmouse(scp, x, y);
 419         else
 420                 remove_txtmouse(scp, x, y);
 421 }
 422
 423 #endif /* SC_NO_CUTPASTE */
 424
 425 #ifdef SC_PIXEL_MODE
 426
 427 /* pixel (raster text) mode renderer */
 428
 429 static void
 430 vga_pxlclear(scr_stat *scp, int c, int attr)
 431 {
 432         vm_offset_t p;
 433         int line_width;
 434         int lines;
 435         int i;
 436
 437         /* XXX: we are just filling the screen with the background color... */
 438         outw(GDCIDX, 0x0005);           /* read mode 0, write mode 0 */
 439         outw(GDCIDX, 0x0003);           /* data rotate/function select */
 440         outw(GDCIDX, 0x0f01);           /* set/reset enable */
 441         outw(GDCIDX, 0xff08);           /* bit mask */
 442         outw(GDCIDX, ((attr & 0xf000) >> 4) | 0x00); /* set/reset */
 443         line_width = scp->sc->adp->va_line_width;
 444         lines = scp->ysize*scp->font_size;
 445         p = scp->sc->adp->va_window + line_width*scp->yoff*scp->font_size
 446                 + scp->xoff;
 447         for (i = 0; i < lines; ++i) {
 448                 bzero_io((void *)p, scp->xsize);
 449                 p += line_width;
 450         }
 451         outw(GDCIDX, 0x0000);           /* set/reset */
 452         outw(GDCIDX, 0x0001);           /* set/reset enable */
 453 }
 454
 455 static void
 456 vga_pxlborder(scr_stat *scp, int color)
 457 {
 458         vm_offset_t p;
 459         int line_width;
 460         int x;
 461         int y;
 462         int i;
 463
 464         (*vidsw[scp->sc->adapter]->set_border)(scp->sc->adp, color);
 465
 466         outw(GDCIDX, 0x0005);           /* read mode 0, write mode 0 */
 467         outw(GDCIDX, 0x0003);           /* data rotate/function select */
 468         outw(GDCIDX, 0x0f01);           /* set/reset enable */
 469         outw(GDCIDX, 0xff08);           /* bit mask */
 470         outw(GDCIDX, (color << 8) | 0x00);      /* set/reset */
 471         line_width = scp->sc->adp->va_line_width;
 472         p = scp->sc->adp->va_window;
 473         if (scp->yoff > 0)
 474                 bzero_io((void *)p, line_width*scp->yoff*scp->font_size);
 475         y = (scp->yoff + scp->ysize)*scp->font_size;
 476         if (scp->ypixel > y)
 477                 bzero_io((void *)(p + line_width*y), line_width*(scp->ypixel - y));
 478         y = scp->yoff*scp->font_size;
 479         x = scp->xpixel/8 - scp->xoff - scp->xsize;
 480         for (i = 0; i < scp->ysize*scp->font_size; ++i) {
 481                 if (scp->xoff > 0)
 482                         bzero_io((void *)(p + line_width*(y + i)), scp->xoff);
 483                 if (x > 0)
 484                         bzero_io((void *)(p + line_width*(y + i)
 485                                      + scp->xoff + scp->xsize), x);
 486         }
 487         outw(GDCIDX, 0x0000);           /* set/reset */
 488         outw(GDCIDX, 0x0001);           /* set/reset enable */
 489 }
 490
 491 static void
 492 vga_egadraw(scr_stat *scp, int from, int count, int flip)
 493 {
 494         vm_offset_t d;
 495         vm_offset_t e;
 496         u_char *f;
 497         u_short bg;
 498         u_short col1, col2;
 499         int line_width;
 500         int i, j;
 501         int a;
 502         u_char c;
 503
 504         line_width = scp->sc->adp->va_line_width;
 505         d = scp->sc->adp->va_window
 506                 + scp->xoff
 507                 + scp->yoff*scp->font_size*line_width
 508                 + (from%scp->xsize)
 509                 + scp->font_size*line_width*(from/scp->xsize);
 510
 511         outw(GDCIDX, 0x0005);           /* read mode 0, write mode 0 */
 512         outw(GDCIDX, 0x0003);           /* data rotate/function select */
 513         outw(GDCIDX, 0x0f01);           /* set/reset enable */
 514         bg = -1;
 515         if (from + count > scp->xsize*scp->ysize)
 516                 count = scp->xsize*scp->ysize - from;
 517         for (i = from; count-- > 0; ++i) {
 518                 a = sc_vtb_geta(&scp->vtb, i);
 519                 if (flip) {
 520                         col1 = ((a & 0x7000) >> 4) | (a & 0x0800);
 521                         col2 = ((a & 0x8000) >> 4) | (a & 0x0700);
 522                 } else {
 523                         col1 = (a & 0x0f00);
 524                         col2 = (a & 0xf000) >> 4;
 525                 }
 526                 /* set background color in EGA/VGA latch */
 527                 if (bg != col2) {
 528                         bg = col2;
 529                         outw(GDCIDX, bg | 0x00);        /* set/reset */
 530                         outw(GDCIDX, 0xff08);           /* bit mask */
 531                         writeb(d, 0);
 532                         c = readb(d);   /* set bg color in the latch */
 533                 }
 534                 /* foreground color */
 535                 outw(GDCIDX, col1 | 0x00);              /* set/reset */
 536                 e = d;
 537                 f = &(scp->font[sc_vtb_getc(&scp->vtb, i)*scp->font_size]);
 538                 for (j = 0; j < scp->font_size; ++j, ++f) {
 539                         outw(GDCIDX, (*f << 8) | 0x08); /* bit mask */
 540                         writeb(e, 0);
 541                         e += line_width;
 542                 }
 543                 ++d;
 544                 if ((i % scp->xsize) == scp->xsize - 1)
 545                         d += scp->xoff*2
 546                                  + (scp->font_size - 1)*line_width;
 547         }
 548         outw(GDCIDX, 0x0000);           /* set/reset */
 549         outw(GDCIDX, 0x0001);           /* set/reset enable */
 550         outw(GDCIDX, 0xff08);           /* bit mask */
 551 }
 552
 553 static void
 554 vga_vgadraw(scr_stat *scp, int from, int count, int flip)
 555 {
 556         vm_offset_t d;
 557         vm_offset_t e;
 558         u_char *f;
 559         u_short bg;
 560         u_short col1, col2;
 561         int line_width;
 562         int i, j;
 563         int a;
 564         u_char c;
 565
 566         line_width = scp->sc->adp->va_line_width;
 567         d = scp->sc->adp->va_window
 568                 + scp->xoff
 569                 + scp->yoff*scp->font_size*line_width
 570                 + (from%scp->xsize)
 571                 + scp->font_size*line_width*(from/scp->xsize);
 572
 573         outw(GDCIDX, 0x0305);           /* read mode 0, write mode 3 */
 574         outw(GDCIDX, 0x0003);           /* data rotate/function select */
 575         outw(GDCIDX, 0x0f01);           /* set/reset enable */
 576         outw(GDCIDX, 0xff08);           /* bit mask */
 577         bg = -1;
 578         if (from + count > scp->xsize*scp->ysize)
 579                 count = scp->xsize*scp->ysize - from;
 580         for (i = from; count-- > 0; ++i) {
 581                 a = sc_vtb_geta(&scp->vtb, i);
 582                 if (flip) {
 583                         col1 = ((a & 0x7000) >> 4) | (a & 0x0800);
 584                         col2 = ((a & 0x8000) >> 4) | (a & 0x0700);
 585                 } else {
 586                         col1 = (a & 0x0f00);
 587                         col2 = (a & 0xf000) >> 4;
 588                 }
 589                 /* set background color in EGA/VGA latch */
 590                 if (bg != col2) {
 591                         bg = col2;
 592                         outw(GDCIDX, 0x0005);   /* read mode 0, write mode 0 */
 593                         outw(GDCIDX, bg | 0x00); /* set/reset */
 594                         writeb(d, 0);
 595                         c = readb(d);           /* set bg color in the latch */
 596                         outw(GDCIDX, 0x0305);   /* read mode 0, write mode 3 */
 597                 }
 598                 /* foreground color */
 599                 outw(GDCIDX, col1 | 0x00);      /* set/reset */
 600                 e = d;
 601                 f = &(scp->font[sc_vtb_getc(&scp->vtb, i)*scp->font_size]);
 602                 for (j = 0; j < scp->font_size; ++j, ++f) {
 603                         writeb(e, *f);
 604                         e += line_width;
 605                 }
 606                 ++d;
 607                 if ((i % scp->xsize) == scp->xsize - 1)
 608                         d += scp->xoff*2
 609                                  + (scp->font_size - 1)*line_width;
 610         }
 611         outw(GDCIDX, 0x0005);           /* read mode 0, write mode 0 */
 612         outw(GDCIDX, 0x0000);           /* set/reset */
 613         outw(GDCIDX, 0x0001);           /* set/reset enable */
 614 }
 615
 616 static void
 617 vga_pxlcursor_shape(scr_stat *scp, int base, int height, int blink)
 618 {
 619         if (base < 0 || base >= scp->font_size)
 620                 return;
 621         /* the caller may set height <= 0 in order to disable the cursor */
 622 #if 0
 623         scp->cursor_base = base;
 624         scp->cursor_height = height;
 625 #endif
 626 }
 627
 628 static void
 629 draw_pxlcursor(scr_stat *scp, int at, int on, int flip)
 630 {
 631         vm_offset_t d;
 632         u_char *f;
 633         int line_width;
 634         int height;
 635         int col;
 636         int a;
 637         int i;
 638         u_char c;
 639
 640         line_width = scp->sc->adp->va_line_width;
 641         d = scp->sc->adp->va_window
 642                 + scp->xoff
 643                 + scp->yoff*scp->font_size*line_width
 644                 + (at%scp->xsize)
 645                 + scp->font_size*line_width*(at/scp->xsize)
 646                 + (scp->font_size - scp->cursor_base - 1)*line_width;
 647
 648         outw(GDCIDX, 0x0005);           /* read mode 0, write mode 0 */
 649         outw(GDCIDX, 0x0003);           /* data rotate/function select */
 650         outw(GDCIDX, 0x0f01);           /* set/reset enable */
 651         /* set background color in EGA/VGA latch */
 652         a = sc_vtb_geta(&scp->vtb, at);
 653         if (flip)
 654                 col = (on) ? ((a & 0xf000) >> 4) : (a & 0x0f00);
 655         else
 656                 col = (on) ? (a & 0x0f00) : ((a & 0xf000) >> 4);
 657         outw(GDCIDX, col | 0x00);       /* set/reset */
 658         outw(GDCIDX, 0xff08);           /* bit mask */
 659         writeb(d, 0);
 660         c = readb(d);                   /* set bg color in the latch */
 661         /* foreground color */
 662         if (flip)
 663                 col = (on) ? (a & 0x0f00) : ((a & 0xf000) >> 4);
 664         else
 665                 col = (on) ? ((a & 0xf000) >> 4) : (a & 0x0f00);
 666         outw(GDCIDX, col | 0x00);       /* set/reset */
 667         f = &(scp->font[sc_vtb_getc(&scp->vtb, at)*scp->font_size
 668                 + scp->font_size - scp->cursor_base - 1]);
 669         height = imin(scp->cursor_height, scp->font_size);
 670         for (i = 0; i < height; ++i, --f) {
 671                 outw(GDCIDX, (*f << 8) | 0x08); /* bit mask */
 672                 writeb(d, 0);
 673                 d -= line_width;
 674         }
 675         outw(GDCIDX, 0x0000);           /* set/reset */
 676         outw(GDCIDX, 0x0001);           /* set/reset enable */
 677         outw(GDCIDX, 0xff08);           /* bit mask */
 678 }
 679
 680 static int pxlblinkrate = 0;
 681
 682 static void
 683 vga_pxlcursor(scr_stat *scp, int at, int blink, int on, int flip)
 684 {
 685         if (scp->cursor_height <= 0)    /* the text cursor is disabled */
 686                 return;
 687
 688         if (on) {
 689                 if (!blink) {
 690                         scp->status |= VR_CURSOR_ON;
 691                         draw_pxlcursor(scp, at, on, flip);
 692                 } else if (++pxlblinkrate & 4) {
 693                         pxlblinkrate = 0;
 694                         scp->status ^= VR_CURSOR_ON;
 695                         draw_pxlcursor(scp, at,
 696                                        scp->status & VR_CURSOR_ON,
 697                                        flip);
 698                 }
 699         } else {
 700                 if (scp->status & VR_CURSOR_ON)
 701                         draw_pxlcursor(scp, at, on, flip);
 702                 scp->status &= ~VR_CURSOR_ON;
 703         }
 704         if (blink)
 705                 scp->status |= VR_CURSOR_BLINK;
 706         else
 707                 scp->status &= ~VR_CURSOR_BLINK;
 708 }
 709
 710 static void
 711 vga_pxlblink(scr_stat *scp, int at, int flip)
 712 {
 713         if (!(scp->status & VR_CURSOR_BLINK))
 714                 return;
 715         if (!(++pxlblinkrate & 4))
 716                 return;
 717         pxlblinkrate = 0;
 718         scp->status ^= VR_CURSOR_ON;
 719         draw_pxlcursor(scp, at, scp->status & VR_CURSOR_ON, flip);
 720 }
 721
 722 #ifndef SC_NO_CUTPASTE
 723
 724 static void
 725 draw_pxlmouse(scr_stat *scp, int x, int y)
 726 {
 727         vm_offset_t p;
 728         int line_width;
 729         int xoff, yoff;
 730         int ymax;
 731         u_short m;
 732         int i, j;
 733
 734         line_width = scp->sc->adp->va_line_width;
 735         xoff = (x - scp->xoff*8)%8;
 736         yoff = y - (y/line_width)*line_width;
 737         ymax = imin(y + 16, scp->ypixel);
 738
 739         outw(GDCIDX, 0x0805);           /* read mode 1, write mode 0 */
 740         outw(GDCIDX, 0x0001);           /* set/reset enable */
 741         outw(GDCIDX, 0x0002);           /* color compare */
 742         outw(GDCIDX, 0x0007);           /* color don't care */
 743         outw(GDCIDX, 0xff08);           /* bit mask */
 744         outw(GDCIDX, 0x0803);           /* data rotate/function select (and) */
 745         p = scp->sc->adp->va_window + line_width*y + x/8;
 746         if (x < scp->xpixel - 8) {
 747                 for (i = y, j = 0; i < ymax; ++i, ++j) {
 748                         m = ~(mouse_and_mask[j] >> xoff);
 749 #ifdef __i386__
 750                         *(u_char *)p &= m >> 8;
 751                         *(u_char *)(p + 1) &= m;
 752 #elif defined(__alpha__)
 753                         writeb(p, readb(p) & (m >> 8));
 754                         writeb(p + 1, readb(p + 1) & (m >> 8));
 755 #endif
 756                         p += line_width;
 757                 }
 758         } else {
 759                 xoff += 8;
 760                 for (i = y, j = 0; i < ymax; ++i, ++j) {
 761                         m = ~(mouse_and_mask[j] >> xoff);
 762 #ifdef __i386__
 763                         *(u_char *)p &= m;
 764 #elif defined(__alpha__)
 765                         writeb(p, readb(p) & (m >> 8));
 766 #endif
 767                         p += line_width;
 768                 }
 769         }
 770         outw(GDCIDX, 0x1003);           /* data rotate/function select (or) */
 771         p = scp->sc->adp->va_window + line_width*y + x/8;
 772         if (x < scp->xpixel - 8) {
 773                 for (i = y, j = 0; i < ymax; ++i, ++j) {
 774                         m = mouse_or_mask[j] >> xoff;
 775 #ifdef __i386__
 776                         *(u_char *)p &= m >> 8;
 777                         *(u_char *)(p + 1) &= m;
 778 #elif defined(__alpha__)
 779                         writeb(p, readb(p) & (m >> 8));
 780                         writeb(p + 1, readb(p + 1) & (m >> 8));
 781 #endif
 782                         p += line_width;
 783                 }
 784         } else {
 785                 for (i = y, j = 0; i < ymax; ++i, ++j) {
 786                         m = mouse_or_mask[j] >> xoff;
 787 #ifdef __i386__
 788                         *(u_char *)p &= m;
 789 #elif defined(__alpha__)
 790                         writeb(p, readb(p) & (m >> 8));
 791 #endif
 792                         p += line_width;
 793                 }
 794         }
 795         outw(GDCIDX, 0x0005);           /* read mode 0, write mode 0 */
 796         outw(GDCIDX, 0x0003);           /* data rotate/function select */
 797 }
 798
 799 static void
 800 remove_pxlmouse(scr_stat *scp, int x, int y)
 801 {
 802         vm_offset_t p;
 803         int col, row;
 804         int pos;
 805         int line_width;
 806         int ymax;
 807         int i;
 808
 809         /* erase the mouse cursor image */
 810         col = x/8 - scp->xoff;
 811         row = y/scp->font_size - scp->yoff;
 812         pos = row*scp->xsize + col;
 813         i = (col < scp->xsize - 1) ? 2 : 1;
 814         (*scp->rndr->draw)(scp, pos, i, FALSE);
 815         if (row < scp->ysize - 1)
 816                 (*scp->rndr->draw)(scp, pos + scp->xsize, i, FALSE);
 817
 818         /* paint border if necessary */
 819         line_width = scp->sc->adp->va_line_width;
 820         outw(GDCIDX, 0x0005);           /* read mode 0, write mode 0 */
 821         outw(GDCIDX, 0x0003);           /* data rotate/function select */
 822         outw(GDCIDX, 0x0f01);           /* set/reset enable */
 823         outw(GDCIDX, 0xff08);           /* bit mask */
 824         outw(GDCIDX, (scp->border << 8) | 0x00);        /* set/reset */
 825         if (row == scp->ysize - 1) {
 826                 i = (scp->ysize + scp->yoff)*scp->font_size;
 827                 ymax = imin(i + scp->font_size, scp->ypixel);
 828                 p = scp->sc->adp->va_window + i*line_width + scp->xoff + col;
 829                 if (col < scp->xsize - 1) {
 830                         for (; i < ymax; ++i) {
 831                                 writeb(p, 0);
 832                                 writeb(p + 1, 0);
 833                                 p += line_width;
 834                         }
 835                 } else {
 836                         for (; i < ymax; ++i) {
 837                                 writeb(p, 0);
 838                                 p += line_width;
 839                         }
 840                 }
 841         }
 842         if ((col == scp->xsize - 1) && (scp->xoff > 0)) {
 843                 i = (row + scp->yoff)*scp->font_size;
 844                 ymax = imin(i + scp->font_size*2, scp->ypixel);
 845                 p = scp->sc->adp->va_window + i*line_width
 846                         + scp->xoff + scp->xsize;
 847                 for (; i < ymax; ++i) {
 848                         writeb(p, 0);
 849                         p += line_width;
 850                 }
 851         }
 852         outw(GDCIDX, 0x0000);           /* set/reset */
 853         outw(GDCIDX, 0x0001);           /* set/reset enable */
 854 }
 855
 856 static void
 857 vga_pxlmouse(scr_stat *scp, int x, int y, int on)
 858 {
 859         if (on)
 860                 draw_pxlmouse(scp, x, y);
 861         else
 862                 remove_pxlmouse(scp, x, y);
 863 }
 864
 865 #endif /* SC_NO_CUTPASTE */
 866 #endif /* SC_PIXEL_MODE */
 867
 868 #ifndef SC_NO_MODE_CHANGE
 869
 870 /* graphics mode renderer */
 871
 872 static void
 873 vga_grborder(scr_stat *scp, int color)
 874 {
 875         (*vidsw[scp->sc->adapter]->set_border)(scp->sc->adp, color);
 876 }
 877
 878 #endif