1 /* $NetBSD: wcfb.c,v 1.6 2010/03/10 05:16:17 macallan Exp $ */ 2 3 /*- 4 * Copyright (c) 2010 Michael Lorenz 5 * All rights reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 1. Redistributions of source code must retain the above copyright 11 * notice, this list of conditions and the following disclaimer. 12 * 2. Redistributions in binary form must reproduce the above copyright 13 * notice, this list of conditions and the following disclaimer in the 14 * documentation and/or other materials provided with the distribution. 15 * 16 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 17 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 18 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 19 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 20 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 21 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 22 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 23 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 24 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 25 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 26 * POSSIBILITY OF SUCH DAMAGE. 27 */ 28 29 #include <sys/cdefs.h> 30 __KERNEL_RCSID(0, "$NetBSD: wcfb.c,v 1.6 2010/03/10 05:16:17 macallan Exp $"); 31 32 #include <sys/param.h> 33 #include <sys/systm.h> 34 #include <sys/kernel.h> 35 #include <sys/device.h> 36 #include <sys/proc.h> 37 #include <sys/mutex.h> 38 #include <sys/ioctl.h> 39 #include <sys/kernel.h> 40 #include <sys/systm.h> 41 #include <sys/kauth.h> 42 #include <sys/kmem.h> 43 44 #include <dev/pci/pcidevs.h> 45 #include <dev/pci/pcireg.h> 46 #include <dev/pci/pcivar.h> 47 #include <dev/pci/pciio.h> 48 #include <dev/pci/wcfbreg.h> 49 50 #include <dev/wscons/wsdisplayvar.h> 51 #include <dev/wscons/wsconsio.h> 52 #include <dev/wsfont/wsfont.h> 53 #include <dev/rasops/rasops.h> 54 #include <dev/wscons/wsdisplay_vconsvar.h> 55 56 #include "opt_wsfb.h" 57 #include "opt_wsdisplay_compat.h" 58 59 #ifdef WCFB_DEBUG 60 # define DPRINTF printf 61 #else 62 # define DPRINTF while (0) printf 63 #endif 64 65 static int wcfb_match(device_t, cfdata_t, void *); 66 static void wcfb_attach(device_t, device_t, void *); 67 static int wcfb_ioctl(void *, void *, u_long, void *, int, 68 struct lwp *); 69 static paddr_t wcfb_mmap(void *, void *, off_t, int); 70 71 struct wcfb_softc { 72 device_t sc_dev; 73 74 pci_chipset_tag_t sc_pc; 75 pcitag_t sc_pcitag; 76 77 bus_space_tag_t sc_memt; 78 bus_space_tag_t sc_regt, sc_wtft; 79 bus_space_tag_t sc_iot; 80 81 bus_space_handle_t sc_fbh, sc_wtfh; 82 bus_space_handle_t sc_regh; 83 bus_addr_t sc_fb, sc_reg, sc_wtf; 84 bus_size_t sc_fbsize, sc_regsize, sc_wtfsize; 85 86 int sc_width, sc_height, sc_stride; 87 int sc_locked; 88 uint8_t *sc_fbaddr, *sc_fb0, *sc_fb1, *sc_shadow; 89 struct vcons_screen sc_console_screen; 90 struct wsscreen_descr sc_defaultscreen_descr; 91 const struct wsscreen_descr *sc_screens[1]; 92 struct wsscreen_list sc_screenlist; 93 struct vcons_data vd; 94 int sc_mode; 95 u_char sc_cmap_red[256]; 96 u_char sc_cmap_green[256]; 97 u_char sc_cmap_blue[256]; 98 uint32_t sc_fb0off, sc_fb1off; 99 100 void (*copycols)(void *, int, int, int, int); 101 void (*erasecols)(void *, int, int, int, long); 102 void (*copyrows)(void *, int, int, int); 103 void (*eraserows)(void *, int, int, long); 104 void (*putchar)(void *, int, int, u_int, long); 105 void (*cursor)(void *, int, int, int); 106 107 }; 108 109 static void wcfb_init_screen(void *, struct vcons_screen *, int, long *); 110 111 CFATTACH_DECL_NEW(wcfb, sizeof(struct wcfb_softc), 112 wcfb_match, wcfb_attach, NULL, NULL); 113 114 struct wsdisplay_accessops wcfb_accessops = { 115 wcfb_ioctl, 116 wcfb_mmap, 117 NULL, /* alloc_screen */ 118 NULL, /* free_screen */ 119 NULL, /* show_screen */ 120 NULL, /* load_font */ 121 NULL, /* pollc */ 122 NULL /* scroll */ 123 }; 124 125 static void wcfb_putchar(void *, int, int, u_int, long); 126 static void wcfb_cursor(void *, int, int, int); 127 static void wcfb_copycols(void *, int, int, int, int); 128 static void wcfb_erasecols(void *, int, int, int, long); 129 static void wcfb_copyrows(void *, int, int, int); 130 static void wcfb_eraserows(void *, int, int, long); 131 132 static void wcfb_putpalreg(struct wcfb_softc *, int, int, int, int); 133 134 static int 135 wcfb_match(device_t parent, cfdata_t match, void *aux) 136 { 137 struct pci_attach_args *pa = aux; 138 139 if (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_3DLABS && 140 PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_3DLABS_WILDCAT5110) 141 return 100; 142 143 return 0; 144 } 145 146 static void 147 wcfb_attach(device_t parent, device_t self, void *aux) 148 { 149 struct wcfb_softc *sc = device_private(self); 150 struct pci_attach_args *pa = aux; 151 struct rasops_info *ri; 152 prop_dictionary_t dict; 153 struct wsemuldisplaydev_attach_args aa; 154 int i, j; 155 uint32_t reg; 156 unsigned long defattr; 157 bool is_console = 0; 158 char devinfo[256]; 159 void *wtf; 160 161 sc->sc_dev = self; 162 sc->putchar = NULL; 163 pci_devinfo(pa->pa_id, pa->pa_class, 0, devinfo, sizeof(devinfo)); 164 aprint_naive("\n"); 165 aprint_normal(": %s\n", devinfo); 166 167 dict = device_properties(self); 168 prop_dictionary_get_bool(dict, "is_console", &is_console); 169 #ifndef WCFB_DEBUG 170 if (!is_console) return; 171 #endif 172 sc->sc_memt = pa->pa_memt; 173 sc->sc_iot = pa->pa_iot; 174 sc->sc_pc = pa->pa_pc; 175 sc->sc_pcitag = pa->pa_tag; 176 177 if (pci_mapreg_map(pa, 0x14, PCI_MAPREG_TYPE_MEM, 0, 178 &sc->sc_regt, &sc->sc_regh, &sc->sc_reg, &sc->sc_regsize)) { 179 aprint_error("%s: failed to map registers.\n", 180 device_xname(sc->sc_dev)); 181 } 182 183 if (pci_mapreg_map(pa, 0x10, PCI_MAPREG_TYPE_MEM, BUS_SPACE_MAP_LINEAR, 184 &sc->sc_memt, &sc->sc_fbh, &sc->sc_fb, &sc->sc_fbsize)) { 185 aprint_error("%s: failed to map framebuffer.\n", 186 device_xname(sc->sc_dev)); 187 } 188 189 if (pci_mapreg_map(pa, 0x18, PCI_MAPREG_TYPE_MEM, BUS_SPACE_MAP_LINEAR, 190 &sc->sc_wtft, &sc->sc_wtfh, &sc->sc_wtf, &sc->sc_wtfsize)) { 191 aprint_error("%s: failed to map wtf.\n", 192 device_xname(sc->sc_dev)); 193 } 194 wtf = bus_space_vaddr(sc->sc_wtft, sc->sc_wtfh); 195 memset(wtf, 0, 0x100000); 196 197 sc->sc_fbaddr = bus_space_vaddr(sc->sc_memt, sc->sc_fbh); 198 199 sc->sc_fb0off = 200 bus_space_read_4(sc->sc_regt, sc->sc_regh, WC_FB8_ADDR0) - sc->sc_fb; 201 sc->sc_fb0 = sc->sc_fbaddr + sc->sc_fb0off; 202 sc->sc_fb1off = 203 bus_space_read_4(sc->sc_regt, sc->sc_regh, WC_FB8_ADDR1) - sc->sc_fb; 204 sc->sc_fb1 = sc->sc_fbaddr + sc->sc_fb1off; 205 206 reg = bus_space_read_4(sc->sc_regt, sc->sc_regh, WC_RESOLUTION); 207 sc->sc_height = (reg >> 16) + 1; 208 sc->sc_width = (reg & 0xffff) + 1; 209 sc->sc_stride = 1 << 210 ((bus_space_read_4(sc->sc_regt, sc->sc_regh, WC_CONFIG) & 211 0x00ff0000) >> 16); 212 printf("%s: %d x %d, %d\n", device_xname(sc->sc_dev), 213 sc->sc_width, sc->sc_height, sc->sc_stride); 214 215 sc->sc_shadow = kmem_alloc(sc->sc_stride * sc->sc_height, KM_SLEEP); 216 if (sc->sc_shadow == NULL) { 217 printf("%s: failed to allocate shadow buffer\n", 218 device_xname(self)); 219 return; 220 } 221 222 for (i = 0x40; i < 0x100; i += 16) { 223 printf("%04x:", i); 224 for (j = 0; j < 16; j += 4) { 225 printf(" %08x", bus_space_read_4(sc->sc_regt, 226 sc->sc_regh, 0x8000 + i + j)); 227 } 228 printf("\n"); 229 } 230 231 /* make sure video output is on */ 232 bus_space_write_4(sc->sc_regt, sc->sc_regh, WC_DPMS_STATE, WC_DPMS_ON); 233 234 sc->sc_defaultscreen_descr = (struct wsscreen_descr){ 235 "default", 236 0, 0, 237 NULL, 238 8, 16, 239 WSSCREEN_WSCOLORS | WSSCREEN_HILIT, 240 NULL 241 }; 242 sc->sc_screens[0] = &sc->sc_defaultscreen_descr; 243 sc->sc_screenlist = (struct wsscreen_list){1, sc->sc_screens}; 244 sc->sc_mode = WSDISPLAYIO_MODE_EMUL; 245 sc->sc_locked = 0; 246 247 vcons_init(&sc->vd, sc, &sc->sc_defaultscreen_descr, 248 &wcfb_accessops); 249 sc->vd.init_screen = wcfb_init_screen; 250 251 /* init engine here */ 252 #if 0 253 wcfb_init(sc); 254 #endif 255 256 ri = &sc->sc_console_screen.scr_ri; 257 258 j = 0; 259 for (i = 0; i < 256; i++) { 260 261 sc->sc_cmap_red[i] = rasops_cmap[j]; 262 sc->sc_cmap_green[i] = rasops_cmap[j + 1]; 263 sc->sc_cmap_blue[i] = rasops_cmap[j + 2]; 264 wcfb_putpalreg(sc, i, rasops_cmap[j], rasops_cmap[j + 1], 265 rasops_cmap[j + 2]); 266 j += 3; 267 } 268 269 if (is_console) { 270 vcons_init_screen(&sc->vd, &sc->sc_console_screen, 1, 271 &defattr); 272 sc->sc_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC; 273 274 memset(sc->sc_fb0, ri->ri_devcmap[(defattr >> 16) & 0xff], 275 sc->sc_stride * sc->sc_height); 276 memset(sc->sc_fb1, ri->ri_devcmap[(defattr >> 16) & 0xff], 277 sc->sc_stride * sc->sc_height); 278 sc->sc_defaultscreen_descr.textops = &ri->ri_ops; 279 sc->sc_defaultscreen_descr.capabilities = ri->ri_caps; 280 sc->sc_defaultscreen_descr.nrows = ri->ri_rows; 281 sc->sc_defaultscreen_descr.ncols = ri->ri_cols; 282 wsdisplay_cnattach(&sc->sc_defaultscreen_descr, ri, 0, 0, 283 defattr); 284 vcons_replay_msgbuf(&sc->sc_console_screen); 285 } else { 286 /* 287 * since we're not the console we can postpone the rest 288 * until someone actually allocates a screen for us 289 */ 290 memset(sc->sc_fb0, WS_DEFAULT_BG, 291 sc->sc_stride * sc->sc_height); 292 memset(sc->sc_fb1, WS_DEFAULT_BG, 293 sc->sc_stride * sc->sc_height); 294 return; 295 } 296 297 aa.console = is_console; 298 aa.scrdata = &sc->sc_screenlist; 299 aa.accessops = &wcfb_accessops; 300 aa.accesscookie = &sc->vd; 301 302 config_found(sc->sc_dev, &aa, wsemuldisplaydevprint); 303 } 304 305 static int 306 wcfb_ioctl(void *v, void *vs, u_long cmd, void *data, int flag, 307 struct lwp *l) 308 { 309 struct wcfb_softc *sc = v; 310 311 switch (cmd) { 312 case WSDISPLAYIO_GTYPE: 313 *(u_int *)data = WSDISPLAY_TYPE_PCIMISC; 314 return 0; 315 316 /* PCI config read/write passthrough. */ 317 case PCI_IOC_CFGREAD: 318 case PCI_IOC_CFGWRITE: 319 return (pci_devioctl(sc->sc_pc, sc->sc_pcitag, 320 cmd, data, flag, l)); 321 case WSDISPLAYIO_SMODE: 322 { 323 /*int new_mode = *(int*)data, i;*/ 324 } 325 return 0; 326 } 327 328 return EPASSTHROUGH; 329 } 330 331 static paddr_t 332 wcfb_mmap(void *v, void *vs, off_t offset, int prot) 333 { 334 struct wcfb_softc *sc = v; 335 336 /* no point in allowing a wsfb map if we can't provide one */ 337 /* 338 * restrict all other mappings to processes with superuser privileges 339 * or the kernel itself 340 */ 341 if (kauth_authorize_generic(kauth_cred_get(), KAUTH_GENERIC_ISSUSER, 342 NULL) != 0) { 343 aprint_normal_dev(sc->sc_dev, "mmap() rejected.\n"); 344 return -1; 345 } 346 347 #ifdef WSFB_FAKE_VGA_FB 348 if ((offset >= 0xa0000) && (offset < 0xbffff)) { 349 350 return bus_space_mmap(sc->sc_memt, sc->sc_gen.sc_fboffset, 351 offset - 0xa0000, prot, BUS_SPACE_MAP_LINEAR); 352 } 353 #endif 354 355 return -1; 356 } 357 358 static void 359 wcfb_init_screen(void *cookie, struct vcons_screen *scr, 360 int existing, long *defattr) 361 { 362 struct wcfb_softc *sc = cookie; 363 struct rasops_info *ri = &scr->scr_ri; 364 365 ri->ri_depth = 8; 366 ri->ri_width = sc->sc_width; 367 ri->ri_height = sc->sc_height; 368 ri->ri_stride = sc->sc_stride; 369 ri->ri_flg = RI_CENTER /*| RI_FULLCLEAR*/; 370 371 ri->ri_bits = sc->sc_shadow; 372 373 if (existing) { 374 ri->ri_flg |= RI_CLEAR; 375 } 376 377 rasops_init(ri, sc->sc_height / 8, sc->sc_width / 8); 378 ri->ri_caps = WSSCREEN_WSCOLORS; 379 380 rasops_reconfig(ri, sc->sc_height / ri->ri_font->fontheight, 381 sc->sc_width / ri->ri_font->fontwidth); 382 383 ri->ri_hw = scr; 384 sc->putchar = ri->ri_ops.putchar; 385 sc->copyrows = ri->ri_ops.copyrows; 386 sc->eraserows = ri->ri_ops.eraserows; 387 sc->copycols = ri->ri_ops.copycols; 388 sc->erasecols = ri->ri_ops.erasecols; 389 390 ri->ri_ops.copyrows = wcfb_copyrows; 391 ri->ri_ops.copycols = wcfb_copycols; 392 ri->ri_ops.eraserows = wcfb_eraserows; 393 ri->ri_ops.erasecols = wcfb_erasecols; 394 ri->ri_ops.putchar = wcfb_putchar; 395 ri->ri_ops.cursor = wcfb_cursor; 396 } 397 398 static void 399 wcfb_putchar(void *cookie, int row, int col, u_int c, long attr) 400 { 401 struct rasops_info *ri = cookie; 402 struct vcons_screen *scr = ri->ri_hw; 403 struct wcfb_softc *sc = scr->scr_cookie; 404 int offset = (ri->ri_yorigin + row * ri->ri_font->fontheight) * 405 sc->sc_stride + ri->ri_xorigin + col * ri->ri_font->fontwidth; 406 uint8_t *from, *to0, *to1; 407 int i; 408 409 sc->putchar(ri, row, col, c, attr); 410 from = sc->sc_shadow + offset; 411 to0 = sc->sc_fb0 + offset; 412 to1 = sc->sc_fb1 + offset; 413 for (i = 0; i < ri->ri_font->fontheight; i++) { 414 memcpy(to0, from, ri->ri_font->fontwidth); 415 memcpy(to1, from, ri->ri_font->fontwidth); 416 to0 += sc->sc_stride; 417 to1 += sc->sc_stride; 418 from += sc->sc_stride; 419 } 420 } 421 422 static void 423 wcfb_putpalreg(struct wcfb_softc *sc, int i, int r, int g, int b) 424 { 425 uint32_t rgb; 426 427 bus_space_write_4(sc->sc_regt, sc->sc_regh, WC_CMAP_INDEX, i); 428 rgb = (b << 22) | (g << 12) | (r << 2); 429 bus_space_write_4(sc->sc_regt, sc->sc_regh, WC_CMAP_DATA, rgb); 430 } 431 432 static void 433 wcfb_cursor(void *cookie, int on, int row, int col) 434 { 435 struct rasops_info *ri = cookie; 436 struct vcons_screen *scr = ri->ri_hw; 437 struct wcfb_softc *sc = scr->scr_cookie; 438 int coffset; 439 440 if (sc->sc_mode == WSDISPLAYIO_MODE_EMUL) { 441 442 if (ri->ri_flg & RI_CURSOR) { 443 /* remove cursor */ 444 coffset = ri->ri_ccol + (ri->ri_crow * ri->ri_cols); 445 #ifdef WSDISPLAY_SCROLLSUPPORT 446 coffset += scr->scr_offset_to_zero; 447 #endif 448 wcfb_putchar(cookie, ri->ri_crow, 449 ri->ri_ccol, scr->scr_chars[coffset], 450 scr->scr_attrs[coffset]); 451 ri->ri_flg &= ~RI_CURSOR; 452 } 453 ri->ri_crow = row; 454 ri->ri_ccol = col; 455 if (on) { 456 long attr, revattr; 457 coffset = col + (row * ri->ri_cols); 458 #ifdef WSDISPLAY_SCROLLSUPPORT 459 coffset += scr->scr_offset_to_zero; 460 #endif 461 attr = scr->scr_attrs[coffset]; 462 revattr = attr ^ 0xffff0000; 463 464 wcfb_putchar(cookie, ri->ri_crow, ri->ri_ccol, 465 scr->scr_chars[coffset], revattr); 466 ri->ri_flg |= RI_CURSOR; 467 } 468 } else { 469 ri->ri_crow = row; 470 ri->ri_ccol = col; 471 ri->ri_flg &= ~RI_CURSOR; 472 } 473 } 474 475 static void 476 wcfb_copycols(void *cookie, int row, int srccol, int dstcol, int ncols) 477 { 478 struct rasops_info *ri = cookie; 479 struct vcons_screen *scr = ri->ri_hw; 480 struct wcfb_softc *sc = scr->scr_cookie; 481 int offset = (ri->ri_yorigin + row * ri->ri_font->fontheight) * 482 sc->sc_stride + ri->ri_xorigin + dstcol * ri->ri_font->fontwidth; 483 uint8_t *from, *to0, *to1; 484 int i; 485 486 sc->copycols(ri, row, srccol, dstcol, ncols); 487 from = sc->sc_shadow + offset; 488 to0 = sc->sc_fb0 + offset; 489 to1 = sc->sc_fb1 + offset; 490 for (i = 0; i < ri->ri_font->fontheight; i++) { 491 memcpy(to0, from, ri->ri_font->fontwidth * ncols); 492 memcpy(to1, from, ri->ri_font->fontwidth * ncols); 493 to0 += sc->sc_stride; 494 to1 += sc->sc_stride; 495 from += sc->sc_stride; 496 } 497 } 498 499 static void 500 wcfb_erasecols(void *cookie, int row, int startcol, int ncols, long fillattr) 501 { 502 struct rasops_info *ri = cookie; 503 struct vcons_screen *scr = ri->ri_hw; 504 struct wcfb_softc *sc = scr->scr_cookie; 505 int offset = (ri->ri_yorigin + row * ri->ri_font->fontheight) * 506 sc->sc_stride + ri->ri_xorigin + startcol * ri->ri_font->fontwidth; 507 uint8_t *to0, *to1; 508 int i; 509 510 sc->erasecols(ri, row, startcol, ncols, fillattr); 511 512 to0 = sc->sc_fb0 + offset; 513 to1 = sc->sc_fb1 + offset; 514 for (i = 0; i < ri->ri_font->fontheight; i++) { 515 memset(to0, ri->ri_devcmap[(fillattr >> 16) & 0xff], 516 ri->ri_font->fontwidth * ncols); 517 memset(to1, ri->ri_devcmap[(fillattr >> 16) & 0xff], 518 ri->ri_font->fontwidth * ncols); 519 to0 += sc->sc_stride; 520 to1 += sc->sc_stride; 521 } 522 } 523 524 static void 525 wcfb_copyrows(void *cookie, int srcrow, int dstrow, int nrows) 526 { 527 struct rasops_info *ri = cookie; 528 struct vcons_screen *scr = ri->ri_hw; 529 struct wcfb_softc *sc = scr->scr_cookie; 530 int offset = (ri->ri_yorigin + dstrow * ri->ri_font->fontheight) * 531 sc->sc_stride + ri->ri_xorigin; 532 uint8_t *from, *to0, *to1; 533 int i; 534 535 sc->copyrows(ri, srcrow, dstrow, nrows); 536 537 from = sc->sc_shadow + offset; 538 to0 = sc->sc_fb0 + offset; 539 to1 = sc->sc_fb1 + offset; 540 for (i = 0; i < ri->ri_font->fontheight * nrows; i++) { 541 memcpy(to0, from, ri->ri_emuwidth); 542 memcpy(to1, from, ri->ri_emuwidth); 543 to0 += sc->sc_stride; 544 to1 += sc->sc_stride; 545 from += sc->sc_stride; 546 } 547 } 548 549 static void 550 wcfb_eraserows(void *cookie, int row, int nrows, long fillattr) 551 { 552 struct rasops_info *ri = cookie; 553 struct vcons_screen *scr = ri->ri_hw; 554 struct wcfb_softc *sc = scr->scr_cookie; 555 int offset = (ri->ri_yorigin + row * ri->ri_font->fontheight) * 556 sc->sc_stride + ri->ri_xorigin; 557 uint8_t *to0, *to1; 558 int i; 559 560 sc->eraserows(ri, row, nrows, fillattr); 561 562 to0 = sc->sc_fb0 + offset; 563 to1 = sc->sc_fb1 + offset; 564 for (i = 0; i < ri->ri_font->fontheight * nrows; i++) { 565 memset(to0, ri->ri_devcmap[(fillattr >> 16) & 0xff], 566 ri->ri_emuwidth); 567 memset(to1, ri->ri_devcmap[(fillattr >> 16) & 0xff], 568 ri->ri_emuwidth); 569 to0 += sc->sc_stride; 570 to1 += sc->sc_stride; 571 } 572 } 573