1 /*- 2 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD 3 * 4 * Copyright (c) 1999 Kazutaka YOKOTA <yokota@zodiac.mech.utsunomiya-u.ac.jp> 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The DragonFly Project 8 * by Sascha Wildner <saw@online.de> 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer as 15 * the first lines of this file unmodified. 16 * 2. Redistributions in binary form must reproduce the above copyright 17 * notice, this list of conditions and the following disclaimer in the 18 * documentation and/or other materials provided with the distribution. 19 * 20 * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR 21 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 22 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 23 * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT, 24 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 25 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 26 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 27 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 28 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 29 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 30 * 31 */ 32 33 #include <sys/cdefs.h> 34 __FBSDID("$FreeBSD$"); 35 36 #include "opt_syscons.h" 37 #include "opt_vga.h" 38 39 #include <sys/param.h> 40 #include <sys/systm.h> 41 #include <sys/kernel.h> 42 #include <sys/module.h> 43 #include <sys/fbio.h> 44 #include <sys/consio.h> 45 #include <sys/sysctl.h> 46 47 #include <machine/bus.h> 48 49 #include <dev/fb/fbreg.h> 50 #include <dev/fb/vgareg.h> 51 #include <dev/syscons/syscons.h> 52 53 #include <isa/isareg.h> 54 55 #ifndef SC_RENDER_DEBUG 56 #define SC_RENDER_DEBUG 0 57 #endif 58 59 static vr_clear_t vga_txtclear; 60 static vr_draw_border_t vga_txtborder; 61 static vr_draw_t vga_txtdraw; 62 static vr_set_cursor_t vga_txtcursor_shape; 63 static vr_draw_cursor_t vga_txtcursor; 64 static vr_blink_cursor_t vga_txtblink; 65 #ifndef SC_NO_CUTPASTE 66 static vr_draw_mouse_t vga_txtmouse; 67 #else 68 #define vga_txtmouse (vr_draw_mouse_t *)vga_nop 69 #endif 70 71 #ifdef SC_PIXEL_MODE 72 static vr_init_t vga_rndrinit; 73 static vr_clear_t vga_pxlclear_direct; 74 static vr_clear_t vga_pxlclear_planar; 75 static vr_draw_border_t vga_pxlborder_direct; 76 static vr_draw_border_t vga_pxlborder_planar; 77 static vr_draw_t vga_vgadraw_direct; 78 static vr_draw_t vga_vgadraw_planar; 79 static vr_set_cursor_t vga_pxlcursor_shape; 80 static vr_draw_cursor_t vga_pxlcursor_direct; 81 static vr_draw_cursor_t vga_pxlcursor_planar; 82 static vr_blink_cursor_t vga_pxlblink_direct; 83 static vr_blink_cursor_t vga_pxlblink_planar; 84 #ifndef SC_NO_CUTPASTE 85 static vr_draw_mouse_t vga_pxlmouse_direct; 86 static vr_draw_mouse_t vga_pxlmouse_planar; 87 #else 88 #define vga_pxlmouse_direct (vr_draw_mouse_t *)vga_nop 89 #define vga_pxlmouse_planar (vr_draw_mouse_t *)vga_nop 90 #endif 91 #endif /* SC_PIXEL_MODE */ 92 93 #ifndef SC_NO_MODE_CHANGE 94 static vr_draw_border_t vga_grborder; 95 #endif 96 97 static void vga_nop(scr_stat *scp); 98 99 static sc_rndr_sw_t txtrndrsw = { 100 (vr_init_t *)vga_nop, 101 vga_txtclear, 102 vga_txtborder, 103 vga_txtdraw, 104 vga_txtcursor_shape, 105 vga_txtcursor, 106 vga_txtblink, 107 (vr_set_mouse_t *)vga_nop, 108 vga_txtmouse, 109 }; 110 RENDERER(mda, 0, txtrndrsw, vga_set); 111 RENDERER(cga, 0, txtrndrsw, vga_set); 112 RENDERER(ega, 0, txtrndrsw, vga_set); 113 RENDERER(vga, 0, txtrndrsw, vga_set); 114 115 #ifdef SC_PIXEL_MODE 116 static sc_rndr_sw_t vgarndrsw = { 117 vga_rndrinit, 118 (vr_clear_t *)vga_nop, 119 (vr_draw_border_t *)vga_nop, 120 (vr_draw_t *)vga_nop, 121 vga_pxlcursor_shape, 122 (vr_draw_cursor_t *)vga_nop, 123 (vr_blink_cursor_t *)vga_nop, 124 (vr_set_mouse_t *)vga_nop, 125 (vr_draw_mouse_t *)vga_nop, 126 }; 127 RENDERER(ega, PIXEL_MODE, vgarndrsw, vga_set); 128 RENDERER(vga, PIXEL_MODE, vgarndrsw, vga_set); 129 #endif /* SC_PIXEL_MODE */ 130 131 #ifndef SC_NO_MODE_CHANGE 132 static sc_rndr_sw_t grrndrsw = { 133 (vr_init_t *)vga_nop, 134 (vr_clear_t *)vga_nop, 135 vga_grborder, 136 (vr_draw_t *)vga_nop, 137 (vr_set_cursor_t *)vga_nop, 138 (vr_draw_cursor_t *)vga_nop, 139 (vr_blink_cursor_t *)vga_nop, 140 (vr_set_mouse_t *)vga_nop, 141 (vr_draw_mouse_t *)vga_nop, 142 }; 143 RENDERER(cga, GRAPHICS_MODE, grrndrsw, vga_set); 144 RENDERER(ega, GRAPHICS_MODE, grrndrsw, vga_set); 145 RENDERER(vga, GRAPHICS_MODE, grrndrsw, vga_set); 146 #endif /* SC_NO_MODE_CHANGE */ 147 148 RENDERER_MODULE(vga, vga_set); 149 150 #ifndef SC_NO_CUTPASTE 151 #if !defined(SC_ALT_MOUSE_IMAGE) || defined(SC_PIXEL_MODE) 152 struct mousedata { 153 u_short md_border[16]; 154 u_short md_interior[16]; 155 u_char md_width; 156 u_char md_height; 157 u_char md_baspect; 158 u_char md_iaspect; 159 const char *md_name; 160 }; 161 162 static const struct mousedata mouse10x16_50 = { { 163 0xC000, 0xA000, 0x9000, 0x8800, 0x8400, 0x8200, 0x8100, 0x8200, 164 0x8400, 0x8400, 0x8400, 0x9200, 0xB200, 0xA900, 0xC900, 0x8600, }, { 165 0x0000, 0x4000, 0x6000, 0x7000, 0x7800, 0x7C00, 0x7E00, 0x7C00, 166 0x7800, 0x7800, 0x7800, 0x6C00, 0x4C00, 0x4600, 0x0600, 0x0000, }, 167 10, 16, 49, 52, "mouse10x16_50", 168 }; 169 170 static const struct mousedata mouse8x14_67 = { { 171 0xC000, 0xA000, 0x9000, 0x8800, 0x8400, 0x8200, 0x8100, 0x8700, 172 0x8400, 0x9200, 0xB200, 0xA900, 0xC900, 0x0600, 0x0000, 0x0000, }, { 173 0x0000, 0x4000, 0x6000, 0x7000, 0x7800, 0x7C00, 0x7E00, 0x7800, 174 0x7800, 0x6C00, 0x4C00, 0x4600, 0x0600, 0x0000, 0x0000, 0x0000, }, 175 8, 14, 64, 65, "mouse8x14_67", 176 }; 177 178 static const struct mousedata mouse8x13_75 = { { 179 0xC000, 0xA000, 0x9000, 0x8800, 0x8400, 0x8200, 0x8600, 0x8400, 180 0xB200, 0xD200, 0x0900, 0x0900, 0x0600, 0x0000, 0x0000, 0x0000, }, { 181 0x0000, 0x4000, 0x6000, 0x7000, 0x7800, 0x7C00, 0x7800, 0x7800, 182 0x4C00, 0x0C00, 0x0600, 0x0600, 0x0000, 0x0000, 0x0000, 0x0000, }, 183 8, 13, 75, 80, "mouse8x13_75", 184 }; 185 186 static const struct mousedata mouse10x16_75 = { { 187 0xC000, 0xA000, 0x9000, 0x8800, 0x8400, 0x8200, 0x8100, 0x8700, 188 0x8400, 0x9200, 0xB200, 0xC900, 0x0900, 0x0480, 0x0480, 0x0300, }, { 189 0x0000, 0x4000, 0x6000, 0x7000, 0x7800, 0x7C00, 0x7E00, 0x7800, 190 0x7800, 0x6C00, 0x4C00, 0x0600, 0x0600, 0x0300, 0x0300, 0x0000, }, 191 10, 16, 72, 75, "mouse10x16_75", 192 }; 193 194 static const struct mousedata mouse9x13_90 = { { 195 0xC000, 0xA000, 0x9000, 0x8800, 0x8400, 0x8200, 0x8100, 0x8780, 196 0x9200, 0xB200, 0xD900, 0x8900, 0x0600, 0x0000, 0x0000, 0x0000, }, { 197 0x0000, 0x4000, 0x6000, 0x7000, 0x7800, 0x7C00, 0x7E00, 0x7800, 198 0x6C00, 0x4C00, 0x0600, 0x0600, 0x0000, 0x0000, 0x0000, 0x0000, }, 199 9, 13, 89, 89, "mouse9x13_90", 200 }; 201 202 static const struct mousedata mouse10x16_90 = { { 203 0xC000, 0xA000, 0x9000, 0x8800, 0x8400, 0x8200, 0x8100, 0x8080, 204 0x8040, 0x83E0, 0x8200, 0x9900, 0xA900, 0xC480, 0x8480, 0x0300, }, { 205 0x0000, 0x4000, 0x6000, 0x7000, 0x7800, 0x7C00, 0x7E00, 0x7F00, 206 0x7F80, 0x7C00, 0x7C00, 0x6600, 0x4600, 0x0300, 0x0300, 0x0000, }, 207 10, 16, 89, 89, "mouse10x16_90", 208 }; 209 210 static const struct mousedata mouse9x13_100 = { { 211 0xC000, 0xA000, 0x9000, 0x8800, 0x8400, 0x8200, 0x8100, 0x8780, 212 0xB200, 0xD200, 0x8900, 0x0900, 0x0600, 0x0000, 0x0000, 0x0000, }, { 213 0x0000, 0x4000, 0x6000, 0x7000, 0x7800, 0x7C00, 0x7E00, 0x7800, 214 0x4C00, 0x0C00, 0x0600, 0x0600, 0x0000, 0x0000, 0x0000, 0x0000, }, 215 9, 13, 106, 113, "mouse9x13_100", 216 }; 217 218 static const struct mousedata mouse10x16_100 = { { 219 0xC000, 0xA000, 0x9000, 0x8800, 0x8400, 0x8200, 0x8100, 0x8080, 220 0x8040, 0x83C0, 0x9200, 0xA900, 0xC900, 0x0480, 0x0480, 0x0300, }, { 221 0x0000, 0x4000, 0x6000, 0x7000, 0x7800, 0x7C00, 0x7E00, 0x7F00, 222 0x7F80, 0x7C00, 0x6C00, 0x4600, 0x0600, 0x0300, 0x0300, 0x0000, }, 223 10, 16, 96, 106, "mouse10x16_100", 224 }; 225 226 static const struct mousedata mouse10x14_120 = { { 227 0xC000, 0xA000, 0x9000, 0x8800, 0x8400, 0x8200, 0x8100, 0x8080, 228 0x97C0, 0xB200, 0xF200, 0xC900, 0x8900, 0x0600, 0x0000, 0x0000, }, { 229 0x0000, 0x4000, 0x6000, 0x7000, 0x7800, 0x7C00, 0x7E00, 0x7F00, 230 0x6800, 0x4C00, 0x0C00, 0x0600, 0x0600, 0x0000, 0x0000, 0x0000, }, 231 10, 14, 120, 124, "mouse10x14_120", 232 }; 233 234 static const struct mousedata mouse10x16_120 = { { 235 0xC000, 0xA000, 0x9000, 0x8800, 0x8400, 0x8200, 0x8100, 0x8080, 236 0x97C0, 0xB200, 0xF200, 0xC900, 0x8900, 0x0480, 0x0480, 0x0300, }, { 237 0x0000, 0x4000, 0x6000, 0x7000, 0x7800, 0x7C00, 0x7E00, 0x7F00, 238 0x6800, 0x4C00, 0x0C00, 0x0600, 0x0600, 0x0300, 0x0300, 0x0000, }, 239 10, 16, 120, 124, "mouse10x16_120", 240 }; 241 242 static const struct mousedata mouse9x13_133 = { { 243 0xC000, 0xA000, 0x9000, 0x8800, 0x8400, 0x8200, 0x8100, 0x8080, 244 0x9780, 0xB200, 0xC900, 0x0900, 0x0600, 0x0000, 0x0000, 0x0000, }, { 245 0x0000, 0x4000, 0x6000, 0x7000, 0x7800, 0x7C00, 0x7E00, 0x7F00, 246 0x6800, 0x4C00, 0x0600, 0x0600, 0x0000, 0x0000, 0x0000, 0x0000, }, 247 9, 13, 142, 124, "mouse9x13_133", 248 }; 249 250 static const struct mousedata mouse10x16_133 = { { 251 0xC000, 0xA000, 0x9000, 0x8800, 0x8400, 0x8200, 0x8100, 0x8080, 252 0x8040, 0x93E0, 0xB200, 0xC900, 0x8900, 0x0480, 0x0480, 0x0300, }, { 253 0x0000, 0x4000, 0x6000, 0x7000, 0x7800, 0x7C00, 0x7E00, 0x7F00, 254 0x7F80, 0x6C00, 0x4C00, 0x0600, 0x0600, 0x0300, 0x0300, 0x0000, }, 255 10, 16, 120, 133, "mouse10x16_133", 256 }; 257 258 static const struct mousedata mouse14x10_240 = { { 259 0xF800, 0xCE00, 0xC380, 0xC0E0, 0xC038, 0xC1FC, 0xDCC0, 0xF660, 260 0xC330, 0x01E0, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, }, { 261 0x0000, 0x3000, 0x3C00, 0x3F00, 0x3FC0, 0x3E00, 0x2300, 0x0180, 262 0x00C0, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, }, 263 14, 10, 189, 189, "mouse14x10_240", 264 }; 265 266 static const struct mousedata * const mouselarge[] = { 267 &mouse10x16_50, 268 &mouse8x14_67, 269 &mouse10x16_75, 270 &mouse10x16_90, 271 &mouse10x16_100, 272 &mouse10x16_120, 273 &mouse10x16_133, 274 &mouse14x10_240, 275 }; 276 277 static const struct mousedata * const mousesmall[] = { 278 &mouse8x14_67, 279 &mouse8x13_75, 280 &mouse9x13_90, 281 &mouse9x13_100, 282 &mouse10x14_120, 283 &mouse9x13_133, 284 &mouse14x10_240, 285 }; 286 #endif 287 #endif 288 289 #ifdef SC_PIXEL_MODE 290 #define GET_PIXEL(scp, pos, x, w) \ 291 ({ \ 292 (scp)->sc->adp->va_window + \ 293 (x) * (scp)->xoff + \ 294 (scp)->yoff * (scp)->font_size * (w) + \ 295 (x) * ((pos) % (scp)->xsize) + \ 296 (scp)->font_size * (w) * ((pos) / (scp)->xsize); \ 297 }) 298 299 #define DRAW_PIXEL(scp, pos, color) do { \ 300 switch ((scp)->sc->adp->va_info.vi_depth) { \ 301 case 32: \ 302 writel((pos), vga_palette32[color]); \ 303 break; \ 304 case 24: \ 305 if (((pos) & 1) == 0) { \ 306 writew((pos), vga_palette32[color]); \ 307 writeb((pos) + 2, vga_palette32[color] >> 16); \ 308 } else { \ 309 writeb((pos), vga_palette32[color]); \ 310 writew((pos) + 1, vga_palette32[color] >> 8); \ 311 } \ 312 break; \ 313 case 16: \ 314 if ((scp)->sc->adp->va_info.vi_pixel_fsizes[1] == 5) \ 315 writew((pos), vga_palette15[color]); \ 316 else \ 317 writew((pos), vga_palette16[color]); \ 318 break; \ 319 case 15: \ 320 writew((pos), vga_palette15[color]); \ 321 break; \ 322 case 8: \ 323 writeb((pos), (uint8_t)(color)); \ 324 } \ 325 } while (0) 326 327 static uint32_t vga_palette32[16] = { 328 0x000000, 0x0000ad, 0x00ad00, 0x00adad, 329 0xad0000, 0xad00ad, 0xad5200, 0xadadad, 330 0x525252, 0x5252ff, 0x52ff52, 0x52ffff, 331 0xff5252, 0xff52ff, 0xffff52, 0xffffff 332 }; 333 334 static uint16_t vga_palette16[16] = { 335 0x0000, 0x0016, 0x0560, 0x0576, 0xb000, 0xb016, 0xb2a0, 0xb576, 336 0x52aa, 0x52bf, 0x57ea, 0x57ff, 0xfaaa, 0xfabf, 0xffea, 0xffff 337 }; 338 339 static uint16_t vga_palette15[16] = { 340 0x0000, 0x0016, 0x02c0, 0x02d6, 0x5800, 0x5816, 0x5940, 0x5ad6, 341 0x294a, 0x295f, 0x2bea, 0x2bff, 0x7d4a, 0x7d5f, 0x7fea, 0x7fff 342 }; 343 #endif 344 345 static int vga_aspect_scale= 100; 346 SYSCTL_INT(_machdep, OID_AUTO, vga_aspect_scale, CTLFLAG_RW, 347 &vga_aspect_scale, 0, "Aspect scale ratio (3:4):actual times 100"); 348 349 static u_short 350 vga_flipattr(u_short a, int blink) 351 { 352 if (blink) 353 a = (a & 0x8800) | ((a & 0x7000) >> 4) | 354 ((a & 0x0700) << 4); 355 else 356 a = ((a & 0xf000) >> 4) | ((a & 0x0f00) << 4); 357 return (a); 358 } 359 360 static u_short 361 vga_cursorattr_adj(scr_stat *scp, u_short a, int blink) 362 { 363 int i; 364 u_short bg, bgmask, fg, newbg; 365 366 /* 367 * The cursor attribute is usually that of the underlying char 368 * with only the bg changed, to the first preferred color that 369 * differs from both the fg and bg. If there is no such color, 370 * use reverse video. 371 */ 372 bgmask = blink ? 0x7000 : 0xf000; 373 bg = a & bgmask; 374 fg = a & 0x0f00; 375 for (i = 0; i < nitems(scp->curs_attr.bg); i++) { 376 newbg = (scp->curs_attr.bg[i] << 12) & bgmask; 377 if (newbg != bg && newbg != (fg << 4)) 378 break; 379 } 380 if (i == nitems(scp->curs_attr.bg)) 381 return (vga_flipattr(a, blink)); 382 return (fg | newbg | (blink ? a & 0x8000 : 0)); 383 } 384 385 static void 386 vga_setmdp(scr_stat *scp) 387 { 388 #if !defined(SC_NO_CUTPASTE) && \ 389 (!defined(SC_ALT_MOUSE_IMAGE) || defined(SC_PIXEL_MODE)) 390 const struct mousedata *mdp; 391 const struct mousedata * const *mdpp; 392 int aspect, best_i, best_v, i, n, v, wb, wi, xpixel, ypixel; 393 394 xpixel = scp->xpixel; 395 ypixel = scp->ypixel; 396 if (scp->sc->adp->va_flags & V_ADP_CWIDTH9) 397 xpixel = xpixel * 9 / 8; 398 399 /* If 16:9 +-1%, assume square pixels, else scale to 4:3 or full. */ 400 aspect = xpixel * 900 / ypixel / 16; 401 if (aspect < 99 || aspect > 100) 402 aspect = xpixel * 300 / ypixel / 4 * vga_aspect_scale / 100; 403 404 /* 405 * Use 10x16 cursors except even with 8x8 fonts except in ~200- 406 * line modes where pixels are very large and in text mode where 407 * even 13 pixels high is really 4 too many. Clipping a 16-high 408 * cursor at 9-high gives a variable tail which looks better than 409 * a smaller cursor with a constant tail. 410 * 411 * XXX: the IS*SC() macros don't work when this is called at the 412 * end of a mode switch since UNKNOWN_SC is still set. 413 */ 414 if (scp->font_size <= 8 && 415 (ypixel < 300 || !(scp->status & PIXEL_MODE))) { 416 mdpp = &mousesmall[0]; 417 n = nitems(mousesmall); 418 } else { 419 mdpp = &mouselarge[0]; 420 n = nitems(mouselarge); 421 } 422 if (scp->status & PIXEL_MODE) { 423 wb = 1024; 424 wi = 256; 425 } else { 426 wb = 256; 427 wi = 1024; 428 } 429 best_i = 0; 430 best_v = 0x7fffffff; 431 for (i = 0; i < n; i++) { 432 v = (wb * abs(mdpp[i]->md_baspect - aspect) + 433 wi * abs(mdpp[i]->md_iaspect - aspect)) / aspect; 434 if (best_v > v) { 435 best_v = v; 436 best_i = i; 437 } 438 } 439 mdp = mdpp[best_i]; 440 scp->mouse_data = mdp; 441 #endif /* !SC_NO_CUTPASTE && (!SC_ALT_MOUSE_IMAGE || SC_PIXEL_MODE) */ 442 } 443 444 static void 445 vga_nop(scr_stat *scp) 446 { 447 } 448 449 /* text mode renderer */ 450 451 static void 452 vga_txtclear(scr_stat *scp, int c, int attr) 453 { 454 sc_vtb_clear(&scp->scr, c, attr); 455 } 456 457 static void 458 vga_txtborder(scr_stat *scp, int color) 459 { 460 vidd_set_border(scp->sc->adp, color); 461 } 462 463 static void 464 vga_txtdraw(scr_stat *scp, int from, int count, int flip) 465 { 466 vm_offset_t p; 467 int c; 468 int a; 469 470 if (from + count > scp->xsize*scp->ysize) 471 count = scp->xsize*scp->ysize - from; 472 473 if (flip) { 474 for (p = sc_vtb_pointer(&scp->scr, from); count-- > 0; ++from) { 475 c = sc_vtb_getc(&scp->vtb, from); 476 a = sc_vtb_geta(&scp->vtb, from); 477 a = vga_flipattr(a, TRUE); 478 p = sc_vtb_putchar(&scp->scr, p, c, a); 479 } 480 } else { 481 sc_vtb_copy(&scp->vtb, from, &scp->scr, from, count); 482 } 483 } 484 485 static void 486 vga_txtcursor_shape(scr_stat *scp, int base, int height, int blink) 487 { 488 vga_setmdp(scp); 489 if (base < 0 || base >= scp->font_size) 490 return; 491 /* the caller may set height <= 0 in order to disable the cursor */ 492 vidd_set_hw_cursor_shape(scp->sc->adp, base, height, 493 scp->font_size, blink); 494 } 495 496 static void 497 draw_txtcharcursor(scr_stat *scp, int at, u_short c, u_short a, int flip) 498 { 499 sc_softc_t *sc; 500 501 sc = scp->sc; 502 503 #ifndef SC_NO_FONT_LOADING 504 if (scp->curs_attr.flags & CONS_CHAR_CURSOR) { 505 unsigned char *font; 506 int h; 507 int i; 508 509 if (scp->font_size < 14) { 510 font = sc->font_8; 511 h = 8; 512 } else if (scp->font_size >= 16) { 513 font = sc->font_16; 514 h = 16; 515 } else { 516 font = sc->font_14; 517 h = 14; 518 } 519 if (scp->curs_attr.base >= h) 520 return; 521 if (flip) 522 a = vga_flipattr(a, TRUE); 523 /* 524 * This clause handles partial-block cursors in text mode. 525 * We want to change the attribute only under the partial 526 * block, but in text mode we can only change full blocks. 527 * Use reverse video instead. 528 */ 529 bcopy(font + c*h, font + sc->cursor_char*h, h); 530 font = font + sc->cursor_char*h; 531 for (i = imax(h - scp->curs_attr.base - scp->curs_attr.height, 0); 532 i < h - scp->curs_attr.base; ++i) { 533 font[i] ^= 0xff; 534 } 535 /* XXX */ 536 vidd_load_font(sc->adp, 0, h, 8, font, sc->cursor_char, 1); 537 sc_vtb_putc(&scp->scr, at, sc->cursor_char, a); 538 } else 539 #endif /* SC_NO_FONT_LOADING */ 540 { 541 if (flip) 542 a = vga_flipattr(a, TRUE); 543 a = vga_cursorattr_adj(scp, a, TRUE); 544 sc_vtb_putc(&scp->scr, at, c, a); 545 } 546 } 547 548 static void 549 vga_txtcursor(scr_stat *scp, int at, int blink, int on, int flip) 550 { 551 video_adapter_t *adp; 552 int cursor_attr; 553 554 if (scp->curs_attr.height <= 0) /* the text cursor is disabled */ 555 return; 556 557 adp = scp->sc->adp; 558 if (blink) { 559 scp->status |= VR_CURSOR_BLINK; 560 if (on) { 561 scp->status |= VR_CURSOR_ON; 562 vidd_set_hw_cursor(adp, at%scp->xsize, 563 at/scp->xsize); 564 } else { 565 if (scp->status & VR_CURSOR_ON) 566 vidd_set_hw_cursor(adp, -1, -1); 567 scp->status &= ~VR_CURSOR_ON; 568 } 569 } else { 570 scp->status &= ~VR_CURSOR_BLINK; 571 if (on) { 572 scp->status |= VR_CURSOR_ON; 573 draw_txtcharcursor(scp, at, 574 sc_vtb_getc(&scp->vtb, at), 575 sc_vtb_geta(&scp->vtb, at), 576 flip); 577 } else { 578 cursor_attr = sc_vtb_geta(&scp->vtb, at); 579 if (flip) 580 cursor_attr = vga_flipattr(cursor_attr, TRUE); 581 if (scp->status & VR_CURSOR_ON) 582 sc_vtb_putc(&scp->scr, at, 583 sc_vtb_getc(&scp->vtb, at), 584 cursor_attr); 585 scp->status &= ~VR_CURSOR_ON; 586 } 587 } 588 } 589 590 static void 591 vga_txtblink(scr_stat *scp, int at, int flip) 592 { 593 } 594 595 int sc_txtmouse_no_retrace_wait; 596 597 #ifndef SC_NO_CUTPASTE 598 599 static void 600 draw_txtmouse(scr_stat *scp, int x, int y) 601 { 602 #ifndef SC_ALT_MOUSE_IMAGE 603 if (ISMOUSEAVAIL(scp->sc->adp->va_flags)) { 604 const struct mousedata *mdp; 605 uint32_t border, interior; 606 u_char font_buf[128]; 607 u_short cursor[32]; 608 u_char c; 609 int pos; 610 int xoffset, yoffset; 611 int crtc_addr; 612 int i; 613 614 mdp = scp->mouse_data; 615 616 /* prepare mousepointer char's bitmaps */ 617 pos = (y/scp->font_size - scp->yoff)*scp->xsize + x/8 - scp->xoff; 618 bcopy(scp->font + sc_vtb_getc(&scp->scr, pos)*scp->font_size, 619 &font_buf[0], scp->font_size); 620 bcopy(scp->font + sc_vtb_getc(&scp->scr, pos + 1)*scp->font_size, 621 &font_buf[32], scp->font_size); 622 bcopy(scp->font 623 + sc_vtb_getc(&scp->scr, pos + scp->xsize)*scp->font_size, 624 &font_buf[64], scp->font_size); 625 bcopy(scp->font 626 + sc_vtb_getc(&scp->scr, pos + scp->xsize + 1)*scp->font_size, 627 &font_buf[96], scp->font_size); 628 for (i = 0; i < scp->font_size; ++i) { 629 cursor[i] = font_buf[i]<<8 | font_buf[i+32]; 630 cursor[i + scp->font_size] = font_buf[i+64]<<8 | font_buf[i+96]; 631 } 632 633 /* now and-or in the mousepointer image */ 634 xoffset = x%8; 635 yoffset = y%scp->font_size; 636 for (i = 0; i < 16; ++i) { 637 border = mdp->md_border[i] << 8; /* avoid right shifting out */ 638 interior = mdp->md_interior[i] << 8; 639 border >>= xoffset; /* normalize */ 640 interior >>= xoffset; 641 if (scp->sc->adp->va_flags & V_ADP_CWIDTH9) { 642 /* skip gaps between characters */ 643 border = (border & 0xff0000) | 644 (border & 0x007f80) << 1 | 645 (border & 0x00003f) << 2; 646 interior = (interior & 0xff0000) | 647 (interior & 0x007f80) << 1 | 648 (interior & 0x00003f) << 2; 649 } 650 border >>= 8; /* back to normal position */ 651 interior >>= 8; 652 cursor[i + yoffset] = (cursor[i + yoffset] & ~border) | 653 interior; 654 } 655 for (i = 0; i < scp->font_size; ++i) { 656 font_buf[i] = (cursor[i] & 0xff00) >> 8; 657 font_buf[i + 32] = cursor[i] & 0xff; 658 font_buf[i + 64] = (cursor[i + scp->font_size] & 0xff00) >> 8; 659 font_buf[i + 96] = cursor[i + scp->font_size] & 0xff; 660 } 661 662 #if 1 663 /* wait for vertical retrace to avoid jitter on some videocards */ 664 crtc_addr = scp->sc->adp->va_crtc_addr; 665 while (!sc_txtmouse_no_retrace_wait && 666 !(inb(crtc_addr + 6) & 0x08)) 667 /* idle */ ; 668 #endif 669 c = scp->sc->mouse_char; 670 vidd_load_font(scp->sc->adp, 0, 32, 8, font_buf, c, 4); 671 672 sc_vtb_putc(&scp->scr, pos, c, sc_vtb_geta(&scp->scr, pos)); 673 /* FIXME: may be out of range! */ 674 sc_vtb_putc(&scp->scr, pos + scp->xsize, c + 2, 675 sc_vtb_geta(&scp->scr, pos + scp->xsize)); 676 if (x < (scp->xsize - 1)*8) { 677 sc_vtb_putc(&scp->scr, pos + 1, c + 1, 678 sc_vtb_geta(&scp->scr, pos + 1)); 679 sc_vtb_putc(&scp->scr, pos + scp->xsize + 1, c + 3, 680 sc_vtb_geta(&scp->scr, pos + scp->xsize + 1)); 681 } 682 } else 683 #endif /* SC_ALT_MOUSE_IMAGE */ 684 { 685 /* Red, magenta and brown are mapped to green to keep it readable */ 686 static const int col_conv[16] = { 687 6, 6, 6, 6, 2, 2, 2, 6, 14, 14, 14, 14, 10, 10, 10, 14 688 }; 689 int pos; 690 int color; 691 int a; 692 693 pos = (y/scp->font_size - scp->yoff)*scp->xsize + x/8 - scp->xoff; 694 a = sc_vtb_geta(&scp->scr, pos); 695 if (scp->sc->adp->va_flags & V_ADP_COLOR) 696 color = (col_conv[(a & 0xf000) >> 12] << 12) 697 | ((a & 0x0f00) | 0x0800); 698 else 699 color = ((a & 0xf000) >> 4) | ((a & 0x0f00) << 4); 700 sc_vtb_putc(&scp->scr, pos, sc_vtb_getc(&scp->scr, pos), color); 701 } 702 } 703 704 static void 705 remove_txtmouse(scr_stat *scp, int x, int y) 706 { 707 } 708 709 static void 710 vga_txtmouse(scr_stat *scp, int x, int y, int on) 711 { 712 if (on) 713 draw_txtmouse(scp, x, y); 714 else 715 remove_txtmouse(scp, x, y); 716 } 717 718 #endif /* SC_NO_CUTPASTE */ 719 720 #ifdef SC_PIXEL_MODE 721 722 /* pixel (raster text) mode renderer */ 723 724 static void 725 vga_rndrinit(scr_stat *scp) 726 { 727 if (scp->sc->adp->va_info.vi_mem_model == V_INFO_MM_PLANAR) { 728 scp->rndr->clear = vga_pxlclear_planar; 729 scp->rndr->draw_border = vga_pxlborder_planar; 730 scp->rndr->draw = vga_vgadraw_planar; 731 scp->rndr->draw_cursor = vga_pxlcursor_planar; 732 scp->rndr->blink_cursor = vga_pxlblink_planar; 733 scp->rndr->draw_mouse = vga_pxlmouse_planar; 734 } else 735 if (scp->sc->adp->va_info.vi_mem_model == V_INFO_MM_DIRECT || 736 scp->sc->adp->va_info.vi_mem_model == V_INFO_MM_PACKED) { 737 scp->rndr->clear = vga_pxlclear_direct; 738 scp->rndr->draw_border = vga_pxlborder_direct; 739 scp->rndr->draw = vga_vgadraw_direct; 740 scp->rndr->draw_cursor = vga_pxlcursor_direct; 741 scp->rndr->blink_cursor = vga_pxlblink_direct; 742 scp->rndr->draw_mouse = vga_pxlmouse_direct; 743 } 744 } 745 746 static void 747 vga_pxlclear_direct(scr_stat *scp, int c, int attr) 748 { 749 vm_offset_t p; 750 int line_width; 751 int pixel_size; 752 int lines; 753 int i; 754 755 line_width = scp->sc->adp->va_line_width; 756 pixel_size = scp->sc->adp->va_info.vi_pixel_size; 757 lines = scp->ysize * scp->font_size; 758 p = scp->sc->adp->va_window + 759 line_width * scp->yoff * scp->font_size + 760 scp->xoff * 8 * pixel_size; 761 762 for (i = 0; i < lines; ++i) { 763 bzero_io((void *)p, scp->xsize * 8 * pixel_size); 764 p += line_width; 765 } 766 } 767 768 static void 769 vga_pxlclear_planar(scr_stat *scp, int c, int attr) 770 { 771 vm_offset_t p; 772 int line_width; 773 int lines; 774 int i; 775 776 /* XXX: we are just filling the screen with the background color... */ 777 outw(GDCIDX, 0x0005); /* read mode 0, write mode 0 */ 778 outw(GDCIDX, 0x0003); /* data rotate/function select */ 779 outw(GDCIDX, 0x0f01); /* set/reset enable */ 780 outw(GDCIDX, 0xff08); /* bit mask */ 781 outw(GDCIDX, ((attr & 0xf000) >> 4) | 0x00); /* set/reset */ 782 line_width = scp->sc->adp->va_line_width; 783 lines = scp->ysize*scp->font_size; 784 p = scp->sc->adp->va_window + line_width*scp->yoff*scp->font_size 785 + scp->xoff; 786 for (i = 0; i < lines; ++i) { 787 bzero_io((void *)p, scp->xsize); 788 p += line_width; 789 } 790 outw(GDCIDX, 0x0000); /* set/reset */ 791 outw(GDCIDX, 0x0001); /* set/reset enable */ 792 } 793 794 static void 795 vga_pxlborder_direct(scr_stat *scp, int color) 796 { 797 vm_offset_t s; 798 vm_offset_t e; 799 vm_offset_t f; 800 int line_width; 801 int pixel_size; 802 int x; 803 int y; 804 int i; 805 806 line_width = scp->sc->adp->va_line_width; 807 pixel_size = scp->sc->adp->va_info.vi_pixel_size; 808 809 if (scp->yoff > 0) { 810 s = scp->sc->adp->va_window; 811 e = s + line_width * scp->yoff * scp->font_size; 812 813 for (f = s; f < e; f += pixel_size) 814 DRAW_PIXEL(scp, f, color); 815 } 816 817 y = (scp->yoff + scp->ysize) * scp->font_size; 818 819 if (scp->ypixel > y) { 820 s = scp->sc->adp->va_window + line_width * y; 821 e = s + line_width * (scp->ypixel - y); 822 823 for (f = s; f < e; f += pixel_size) 824 DRAW_PIXEL(scp, f, color); 825 } 826 827 y = scp->yoff * scp->font_size; 828 x = scp->xpixel / 8 - scp->xoff - scp->xsize; 829 830 for (i = 0; i < scp->ysize * scp->font_size; ++i) { 831 if (scp->xoff > 0) { 832 s = scp->sc->adp->va_window + line_width * (y + i); 833 e = s + scp->xoff * 8 * pixel_size; 834 835 for (f = s; f < e; f += pixel_size) 836 DRAW_PIXEL(scp, f, color); 837 } 838 839 if (x > 0) { 840 s = scp->sc->adp->va_window + line_width * (y + i) + 841 scp->xoff * 8 * pixel_size + 842 scp->xsize * 8 * pixel_size; 843 e = s + x * 8 * pixel_size; 844 845 for (f = s; f < e; f += pixel_size) 846 DRAW_PIXEL(scp, f, color); 847 } 848 } 849 } 850 851 static void 852 vga_pxlborder_planar(scr_stat *scp, int color) 853 { 854 vm_offset_t p; 855 int line_width; 856 int x; 857 int y; 858 int i; 859 860 vidd_set_border(scp->sc->adp, color); 861 862 outw(GDCIDX, 0x0005); /* read mode 0, write mode 0 */ 863 outw(GDCIDX, 0x0003); /* data rotate/function select */ 864 outw(GDCIDX, 0x0f01); /* set/reset enable */ 865 outw(GDCIDX, 0xff08); /* bit mask */ 866 outw(GDCIDX, (color << 8) | 0x00); /* set/reset */ 867 line_width = scp->sc->adp->va_line_width; 868 p = scp->sc->adp->va_window; 869 if (scp->yoff > 0) 870 bzero_io((void *)p, line_width*scp->yoff*scp->font_size); 871 y = (scp->yoff + scp->ysize)*scp->font_size; 872 if (scp->ypixel > y) 873 bzero_io((void *)(p + line_width*y), line_width*(scp->ypixel - y)); 874 y = scp->yoff*scp->font_size; 875 x = scp->xpixel/8 - scp->xoff - scp->xsize; 876 for (i = 0; i < scp->ysize*scp->font_size; ++i) { 877 if (scp->xoff > 0) 878 bzero_io((void *)(p + line_width*(y + i)), scp->xoff); 879 if (x > 0) 880 bzero_io((void *)(p + line_width*(y + i) 881 + scp->xoff + scp->xsize), x); 882 } 883 outw(GDCIDX, 0x0000); /* set/reset */ 884 outw(GDCIDX, 0x0001); /* set/reset enable */ 885 } 886 887 static void 888 vga_vgadraw_direct(scr_stat *scp, int from, int count, int flip) 889 { 890 vm_offset_t d; 891 vm_offset_t e; 892 u_char *f; 893 u_short col1, col2, color; 894 int line_width, pixel_size; 895 int i, j, k; 896 int a; 897 898 line_width = scp->sc->adp->va_line_width; 899 pixel_size = scp->sc->adp->va_info.vi_pixel_size; 900 901 d = GET_PIXEL(scp, from, 8 * pixel_size, line_width); 902 903 if (from + count > scp->xsize * scp->ysize) 904 count = scp->xsize * scp->ysize - from; 905 906 for (i = from; count-- > 0; ++i) { 907 a = sc_vtb_geta(&scp->vtb, i); 908 909 if (flip) 910 a = vga_flipattr(a, FALSE); 911 col1 = (a & 0x0f00) >> 8; 912 col2 = (a & 0xf000) >> 12; 913 914 e = d; 915 f = &(scp->font[sc_vtb_getc(&scp->vtb, i) * scp->font_size]); 916 917 for (j = 0; j < scp->font_size; ++j, ++f) { 918 for (k = 0; k < 8; ++k) { 919 color = *f & (1 << (7 - k)) ? col1 : col2; 920 DRAW_PIXEL(scp, e + pixel_size * k, color); 921 } 922 923 e += line_width; 924 } 925 926 d += 8 * pixel_size; 927 928 if ((i % scp->xsize) == scp->xsize - 1) 929 d += scp->font_size * line_width - 930 scp->xsize * 8 * pixel_size; 931 } 932 } 933 934 static void 935 vga_vgadraw_planar(scr_stat *scp, int from, int count, int flip) 936 { 937 vm_offset_t d; 938 vm_offset_t e; 939 u_char *f; 940 u_short bg, fg; 941 u_short col1, col2; 942 int line_width; 943 int i, j; 944 int a; 945 u_char c; 946 947 line_width = scp->sc->adp->va_line_width; 948 949 d = GET_PIXEL(scp, from, 1, line_width); 950 951 if (scp->sc->adp->va_type == KD_VGA) { 952 outw(GDCIDX, 0x0305); /* read mode 0, write mode 3 */ 953 outw(GDCIDX, 0xff08); /* bit mask */ 954 } else 955 outw(GDCIDX, 0x0005); /* read mode 0, write mode 0 */ 956 outw(GDCIDX, 0x0003); /* data rotate/function select */ 957 outw(GDCIDX, 0x0f01); /* set/reset enable */ 958 fg = bg = -1; 959 if (from + count > scp->xsize*scp->ysize) 960 count = scp->xsize*scp->ysize - from; 961 for (i = from; count-- > 0; ++i) { 962 a = sc_vtb_geta(&scp->vtb, i); 963 if (flip) 964 a = vga_flipattr(a, FALSE); 965 col1 = a & 0x0f00; 966 col2 = (a & 0xf000) >> 4; 967 /* set background color in EGA/VGA latch */ 968 if (bg != col2) { 969 bg = col2; 970 fg = -1; 971 outw(GDCIDX, bg | 0x00); /* set/reset */ 972 if (scp->sc->adp->va_type != KD_VGA) 973 outw(GDCIDX, 0xff08); /* bit mask */ 974 writeb(d, 0xff); 975 c = readb(d); /* set bg color in the latch */ 976 } 977 /* foreground color */ 978 if (fg != col1) { 979 fg = col1; 980 outw(GDCIDX, col1 | 0x00); /* set/reset */ 981 } 982 e = d; 983 f = &(scp->font[sc_vtb_getc(&scp->vtb, i)*scp->font_size]); 984 for (j = 0; j < scp->font_size; ++j, ++f) { 985 if (scp->sc->adp->va_type == KD_VGA) 986 writeb(e, *f); 987 else { 988 outw(GDCIDX, (*f << 8) | 0x08); /* bit mask */ 989 writeb(e, 0); 990 } 991 e += line_width; 992 } 993 ++d; 994 if ((i % scp->xsize) == scp->xsize - 1) 995 d += scp->font_size * line_width - scp->xsize; 996 } 997 if (scp->sc->adp->va_type == KD_VGA) 998 outw(GDCIDX, 0x0005); /* read mode 0, write mode 0 */ 999 else 1000 outw(GDCIDX, 0xff08); /* bit mask */ 1001 outw(GDCIDX, 0x0000); /* set/reset */ 1002 outw(GDCIDX, 0x0001); /* set/reset enable */ 1003 } 1004 1005 static void 1006 vga_pxlcursor_shape(scr_stat *scp, int base, int height, int blink) 1007 { 1008 vga_setmdp(scp); 1009 } 1010 1011 static void 1012 draw_pxlcursor_direct(scr_stat *scp, int at, int on, int flip) 1013 { 1014 vm_offset_t d; 1015 u_char *f; 1016 int line_width, pixel_size; 1017 int height; 1018 int col1, col2, color; 1019 int a; 1020 int i, j; 1021 1022 line_width = scp->sc->adp->va_line_width; 1023 pixel_size = scp->sc->adp->va_info.vi_pixel_size; 1024 1025 d = GET_PIXEL(scp, at, 8 * pixel_size, line_width) + 1026 (scp->font_size - scp->curs_attr.base - 1) * line_width; 1027 1028 a = sc_vtb_geta(&scp->vtb, at); 1029 1030 if (flip) 1031 a = vga_flipattr(a, FALSE); 1032 if (on) 1033 a = vga_cursorattr_adj(scp, a, FALSE); 1034 col1 = (a & 0x0f00) >> 8; 1035 col2 = a >> 12; 1036 1037 f = &(scp->font[sc_vtb_getc(&scp->vtb, at) * scp->font_size + 1038 scp->font_size - scp->curs_attr.base - 1]); 1039 1040 height = imin(scp->curs_attr.height, scp->font_size); 1041 1042 for (i = 0; i < height; ++i, --f) { 1043 for (j = 0; j < 8; ++j) { 1044 color = *f & (1 << (7 - j)) ? col1 : col2; 1045 DRAW_PIXEL(scp, d + pixel_size * j, color); 1046 } 1047 1048 d -= line_width; 1049 } 1050 } 1051 1052 static void 1053 draw_pxlcursor_planar(scr_stat *scp, int at, int on, int flip) 1054 { 1055 vm_offset_t d; 1056 u_char *f; 1057 int line_width; 1058 int height; 1059 int col; 1060 int a; 1061 int i; 1062 u_char c; 1063 1064 line_width = scp->sc->adp->va_line_width; 1065 1066 d = GET_PIXEL(scp, at, 1, line_width) + 1067 (scp->font_size - scp->curs_attr.base - 1) * line_width; 1068 1069 outw(GDCIDX, 0x0005); /* read mode 0, write mode 0 */ 1070 outw(GDCIDX, 0x0003); /* data rotate/function select */ 1071 outw(GDCIDX, 0x0f01); /* set/reset enable */ 1072 /* set background color in EGA/VGA latch */ 1073 a = sc_vtb_geta(&scp->vtb, at); 1074 if (flip) 1075 a = vga_flipattr(a, FALSE); 1076 if (on) 1077 a = vga_cursorattr_adj(scp, a, FALSE); 1078 col = (a & 0xf000) >> 4; 1079 outw(GDCIDX, col | 0x00); /* set/reset */ 1080 outw(GDCIDX, 0xff08); /* bit mask */ 1081 writeb(d, 0); 1082 c = readb(d); /* set bg color in the latch */ 1083 /* foreground color */ 1084 col = a & 0x0f00; 1085 outw(GDCIDX, col | 0x00); /* set/reset */ 1086 f = &(scp->font[sc_vtb_getc(&scp->vtb, at)*scp->font_size 1087 + scp->font_size - scp->curs_attr.base - 1]); 1088 height = imin(scp->curs_attr.height, scp->font_size); 1089 for (i = 0; i < height; ++i, --f) { 1090 outw(GDCIDX, (*f << 8) | 0x08); /* bit mask */ 1091 writeb(d, 0); 1092 d -= line_width; 1093 } 1094 outw(GDCIDX, 0x0000); /* set/reset */ 1095 outw(GDCIDX, 0x0001); /* set/reset enable */ 1096 outw(GDCIDX, 0xff08); /* bit mask */ 1097 } 1098 1099 static int pxlblinkrate = 0; 1100 1101 static void 1102 vga_pxlcursor_direct(scr_stat *scp, int at, int blink, int on, int flip) 1103 { 1104 if (scp->curs_attr.height <= 0) /* the text cursor is disabled */ 1105 return; 1106 1107 if (on) { 1108 if (!blink) { 1109 scp->status |= VR_CURSOR_ON; 1110 draw_pxlcursor_direct(scp, at, on, flip); 1111 } else if (++pxlblinkrate & 4) { 1112 pxlblinkrate = 0; 1113 scp->status ^= VR_CURSOR_ON; 1114 draw_pxlcursor_direct(scp, at, 1115 scp->status & VR_CURSOR_ON, 1116 flip); 1117 } 1118 } else { 1119 if (scp->status & VR_CURSOR_ON) 1120 draw_pxlcursor_direct(scp, at, on, flip); 1121 scp->status &= ~VR_CURSOR_ON; 1122 } 1123 if (blink) 1124 scp->status |= VR_CURSOR_BLINK; 1125 else 1126 scp->status &= ~VR_CURSOR_BLINK; 1127 } 1128 1129 static void 1130 vga_pxlcursor_planar(scr_stat *scp, int at, int blink, int on, int flip) 1131 { 1132 if (scp->curs_attr.height <= 0) /* the text cursor is disabled */ 1133 return; 1134 1135 if (on) { 1136 if (!blink) { 1137 scp->status |= VR_CURSOR_ON; 1138 draw_pxlcursor_planar(scp, at, on, flip); 1139 } else if (++pxlblinkrate & 4) { 1140 pxlblinkrate = 0; 1141 scp->status ^= VR_CURSOR_ON; 1142 draw_pxlcursor_planar(scp, at, 1143 scp->status & VR_CURSOR_ON, 1144 flip); 1145 } 1146 } else { 1147 if (scp->status & VR_CURSOR_ON) 1148 draw_pxlcursor_planar(scp, at, on, flip); 1149 scp->status &= ~VR_CURSOR_ON; 1150 } 1151 if (blink) 1152 scp->status |= VR_CURSOR_BLINK; 1153 else 1154 scp->status &= ~VR_CURSOR_BLINK; 1155 } 1156 1157 static void 1158 vga_pxlblink_direct(scr_stat *scp, int at, int flip) 1159 { 1160 if (!(scp->status & VR_CURSOR_BLINK)) 1161 return; 1162 if (!(++pxlblinkrate & 4)) 1163 return; 1164 pxlblinkrate = 0; 1165 scp->status ^= VR_CURSOR_ON; 1166 draw_pxlcursor_direct(scp, at, scp->status & VR_CURSOR_ON, flip); 1167 } 1168 1169 static void 1170 vga_pxlblink_planar(scr_stat *scp, int at, int flip) 1171 { 1172 if (!(scp->status & VR_CURSOR_BLINK)) 1173 return; 1174 if (!(++pxlblinkrate & 4)) 1175 return; 1176 pxlblinkrate = 0; 1177 scp->status ^= VR_CURSOR_ON; 1178 draw_pxlcursor_planar(scp, at, scp->status & VR_CURSOR_ON, flip); 1179 } 1180 1181 #ifndef SC_NO_CUTPASTE 1182 1183 static void 1184 draw_pxlmouse_planar(scr_stat *scp, int x, int y) 1185 { 1186 const struct mousedata *mdp; 1187 vm_offset_t p; 1188 int line_width; 1189 int xoff, yoff; 1190 int ymax; 1191 uint32_t m; 1192 int i, j, k; 1193 uint8_t m1; 1194 1195 mdp = scp->mouse_data; 1196 line_width = scp->sc->adp->va_line_width; 1197 xoff = (x - scp->xoff*8)%8; 1198 yoff = y - rounddown(y, line_width); 1199 ymax = imin(y + mdp->md_height, scp->ypixel); 1200 1201 if (scp->sc->adp->va_type == KD_VGA) { 1202 outw(GDCIDX, 0x0305); /* read mode 0, write mode 3 */ 1203 outw(GDCIDX, 0xff08); /* bit mask */ 1204 } else 1205 outw(GDCIDX, 0x0005); /* read mode 0, write mode 0 */ 1206 outw(GDCIDX, 0x0003); /* data rotate/function select */ 1207 outw(GDCIDX, 0x0f01); /* set/reset enable */ 1208 1209 outw(GDCIDX, (scp->curs_attr.mouse_ba << 8) | 0x00); /* set/reset */ 1210 p = scp->sc->adp->va_window + line_width*y + x/8; 1211 for (i = y, j = 0; i < ymax; ++i, ++j) { 1212 m = mdp->md_border[j] << 8 >> xoff; 1213 for (k = 0; k < 3; ++k) { 1214 m1 = m >> (8 * (2 - k)); 1215 if (m1 != 0 && x + 8 * k < scp->xpixel) { 1216 readb(p + k); 1217 if (scp->sc->adp->va_type == KD_VGA) 1218 writeb(p + k, m1); 1219 else { 1220 /* bit mask: */ 1221 outw(GDCIDX, (m1 << 8) | 0x08); 1222 writeb(p + k, 0); 1223 } 1224 } 1225 } 1226 p += line_width; 1227 } 1228 outw(GDCIDX, (scp->curs_attr.mouse_ia << 8) | 0x00); /* set/reset */ 1229 p = scp->sc->adp->va_window + line_width*y + x/8; 1230 for (i = y, j = 0; i < ymax; ++i, ++j) { 1231 m = mdp->md_interior[j] << 8 >> xoff; 1232 for (k = 0; k < 3; ++k) { 1233 m1 = m >> (8 * (2 - k)); 1234 if (m1 != 0 && x + 8 * k < scp->xpixel) { 1235 readb(p + k); 1236 if (scp->sc->adp->va_type == KD_VGA) 1237 writeb(p + k, m1); 1238 else { 1239 /* bit mask: */ 1240 outw(GDCIDX, (m1 << 8) | 0x08); 1241 writeb(p + k, 0); 1242 } 1243 } 1244 } 1245 p += line_width; 1246 } 1247 if (scp->sc->adp->va_type == KD_VGA) 1248 outw(GDCIDX, 0x0005); /* read mode 0, write mode 0 */ 1249 else 1250 outw(GDCIDX, 0xff08); /* bit mask */ 1251 outw(GDCIDX, 0x0000); /* set/reset */ 1252 outw(GDCIDX, 0x0001); /* set/reset enable */ 1253 } 1254 1255 static void 1256 remove_pxlmouse_planar(scr_stat *scp, int x, int y) 1257 { 1258 const struct mousedata *mdp; 1259 vm_offset_t p; 1260 int bx, by, i, line_width, xend, xoff, yend, yoff; 1261 1262 mdp = scp->mouse_data; 1263 1264 /* 1265 * It is only necessary to remove the mouse image where it overlaps 1266 * the border. Determine the overlap, and do nothing if it is empty. 1267 */ 1268 bx = (scp->xoff + scp->xsize) * 8; 1269 by = (scp->yoff + scp->ysize) * scp->font_size; 1270 xend = imin(x + mdp->md_width, scp->xpixel); 1271 yend = imin(y + mdp->md_height, scp->ypixel); 1272 if (xend <= bx && yend <= by) 1273 return; 1274 1275 /* Repaint the non-empty overlap. */ 1276 line_width = scp->sc->adp->va_line_width; 1277 outw(GDCIDX, 0x0005); /* read mode 0, write mode 0 */ 1278 outw(GDCIDX, 0x0003); /* data rotate/function select */ 1279 outw(GDCIDX, 0x0f01); /* set/reset enable */ 1280 outw(GDCIDX, 0xff08); /* bit mask */ 1281 outw(GDCIDX, (scp->border << 8) | 0x00); /* set/reset */ 1282 for (i = x / 8, xoff = i * 8; xoff < xend; ++i, xoff += 8) { 1283 yoff = (xoff >= bx) ? y : by; 1284 p = scp->sc->adp->va_window + yoff * line_width + i; 1285 for (; yoff < yend; ++yoff, p += line_width) 1286 writeb(p, 0); 1287 } 1288 outw(GDCIDX, 0x0000); /* set/reset */ 1289 outw(GDCIDX, 0x0001); /* set/reset enable */ 1290 } 1291 1292 static void 1293 vga_pxlmouse_direct(scr_stat *scp, int x, int y, int on) 1294 { 1295 const struct mousedata *mdp; 1296 vm_offset_t p; 1297 int line_width, pixel_size; 1298 int xend, yend; 1299 int i, j; 1300 1301 mdp = scp->mouse_data; 1302 1303 /* 1304 * Determine overlap with the border and then if removing, do nothing 1305 * if the overlap is empty. 1306 */ 1307 xend = imin(x + mdp->md_width, scp->xpixel); 1308 yend = imin(y + mdp->md_height, scp->ypixel); 1309 if (!on && xend <= (scp->xoff + scp->xsize) * 8 && 1310 yend <= (scp->yoff + scp->ysize) * scp->font_size) 1311 return; 1312 1313 line_width = scp->sc->adp->va_line_width; 1314 pixel_size = scp->sc->adp->va_info.vi_pixel_size; 1315 1316 if (on) 1317 goto do_on; 1318 1319 /* Repaint overlap with the border (mess up the corner a little). */ 1320 p = scp->sc->adp->va_window + y * line_width + x * pixel_size; 1321 for (i = 0; i < yend - y; i++, p += line_width) 1322 for (j = xend - x - 1; j >= 0; j--) 1323 DRAW_PIXEL(scp, p + j * pixel_size, scp->border); 1324 1325 return; 1326 1327 do_on: 1328 p = scp->sc->adp->va_window + y * line_width + x * pixel_size; 1329 for (i = 0; i < yend - y; i++, p += line_width) 1330 for (j = xend - x - 1; j >= 0; j--) 1331 if (mdp->md_interior[i] & (1 << (15 - j))) 1332 DRAW_PIXEL(scp, p + j * pixel_size, 1333 scp->curs_attr.mouse_ia); 1334 else if (mdp->md_border[i] & (1 << (15 - j))) 1335 DRAW_PIXEL(scp, p + j * pixel_size, 1336 scp->curs_attr.mouse_ba); 1337 } 1338 1339 static void 1340 vga_pxlmouse_planar(scr_stat *scp, int x, int y, int on) 1341 { 1342 if (on) 1343 draw_pxlmouse_planar(scp, x, y); 1344 else 1345 remove_pxlmouse_planar(scp, x, y); 1346 } 1347 1348 #endif /* SC_NO_CUTPASTE */ 1349 #endif /* SC_PIXEL_MODE */ 1350 1351 #ifndef SC_NO_MODE_CHANGE 1352 1353 /* graphics mode renderer */ 1354 1355 static void 1356 vga_grborder(scr_stat *scp, int color) 1357 { 1358 vidd_set_border(scp->sc->adp, color); 1359 } 1360 1361 #endif 1362