crmfb.c revision 1.2
1 /* $NetBSD: crmfb.c,v 1.2 2007/04/12 22:30:48 jmcneill Exp $ */ 2 3 /*- 4 * Copyright (c) 2007 Jared D. McNeill <jmcneill (at) invisible.ca> 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 * 3. All advertising materials mentioning features or use of this software 16 * must display the following acknowledgement: 17 * This product includes software developed by Jared D. McNeill. 18 * 4. Neither the name of The NetBSD Foundation nor the names of its 19 * contributors may be used to endorse or promote products derived 20 * from this software without specific prior written permission. 21 * 22 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 23 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 24 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 25 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 26 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 27 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 28 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 29 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 30 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 31 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 32 * POSSIBILITY OF SUCH DAMAGE. 33 */ 34 35 /* 36 * SGI-CRM (O2) Framebuffer driver 37 */ 38 39 #include <sys/cdefs.h> 40 __KERNEL_RCSID(0, "$NetBSD: crmfb.c,v 1.2 2007/04/12 22:30:48 jmcneill Exp $"); 41 42 #include <sys/param.h> 43 #include <sys/systm.h> 44 #include <sys/device.h> 45 #include <sys/malloc.h> 46 47 #define _SGIMIPS_BUS_DMA_PRIVATE 48 #include <machine/autoconf.h> 49 #include <machine/bus.h> 50 #include <machine/machtype.h> 51 #include <machine/vmparam.h> 52 53 #include <dev/arcbios/arcbios.h> 54 #include <dev/arcbios/arcbiosvar.h> 55 56 #include <dev/wscons/wsdisplayvar.h> 57 #include <dev/wscons/wsconsio.h> 58 #include <dev/wsfont/wsfont.h> 59 #include <dev/rasops/rasops.h> 60 #include <dev/wscons/wsdisplay_vconsvar.h> 61 62 struct wsscreen_descr crmfb_defaultscreen = { 63 "default", 64 0, 0, 65 NULL, 66 8, 16, 67 WSSCREEN_WSCOLORS, 68 NULL, 69 }; 70 71 const struct wsscreen_descr *_crmfb_scrlist[] = { 72 &crmfb_defaultscreen, 73 }; 74 75 struct wsscreen_list crmfb_screenlist = { 76 sizeof(_crmfb_scrlist) / sizeof(struct wsscreen_descr *), 77 _crmfb_scrlist 78 }; 79 80 static struct vcons_screen crmfb_console_screen; 81 82 static int crmfb_ioctl(void *, void *, u_long, void *, int, struct lwp *); 83 static paddr_t crmfb_mmap(void *, void *, off_t, int); 84 static void crmfb_init_screen(void *, struct vcons_screen *, int, long *); 85 86 struct wsdisplay_accessops crmfb_accessops = { 87 crmfb_ioctl, 88 crmfb_mmap, 89 NULL, /* alloc_screen */ 90 NULL, /* free_screen */ 91 NULL, /* show_screen */ 92 NULL, /* load_font */ 93 NULL, /* pollc */ 94 NULL, /* scroll */ 95 }; 96 97 /* Memory to allocate to SGI-CRM -- remember, this is stolen from 98 * host memory! 99 */ 100 #define CRMFB_TILESIZE (512*128) 101 102 #define CRMFB_DOTCLOCK 0x00000004 103 #define CRMFB_DOTCLOCK_CLKRUN_SHIFT 20 104 #define CRMFB_VT_XY 0x00010000 105 #define CRMFB_VT_XY_FREEZE_SHIFT 31 106 #define CRMFB_VT_INTR01 0x00010020 107 #define CRMFB_VT_INTR01_EN 0xffffffff 108 #define CRMFB_VT_INTR23 0x00010024 109 #define CRMFB_VT_INTR23_EN 0xffffffff 110 #define CRMFB_VT_VPIX_EN 0x00010038 111 #define CRMFB_VT_VPIX_EN_OFF_SHIFT 0 112 #define CRMFB_VT_VCMAP 0x0001003c 113 #define CRMFB_VT_VCMAP_ON_SHIFT 12 114 #define CRMFB_VT_HCMAP 0x00010040 115 #define CRMFB_VT_HCMAP_ON_SHIFT 12 116 #define CRMFB_OVR_WIDTH_TILE 0x00020000 117 #define CRMFB_OVR_CONTROL 0x00020008 118 #define CRMFB_OVR_CONTROL_DMAEN_SHIFT 0 119 #define CRMFB_FRM_TILESIZE 0x00030000 120 #define CRMFB_FRM_TILESIZE_RHS_SHIFT 0 121 #define CRMFB_FRM_TILESIZE_WIDTH_SHIFT 5 122 #define CRMFB_FRM_TILESIZE_DEPTH_SHIFT 13 123 #define CRMFB_FRM_TILESIZE_DEPTH_8 0 124 #define CRMFB_FRM_TILESIZE_DEPTH_16 1 125 #define CRMFB_FRM_TILESIZE_DEPTH_32 2 126 #define CRMFB_FRM_TILESIZE_FIFOR_SHIFT 15 127 #define CRMFB_FRM_PIXSIZE 0x00030004 128 #define CRMFB_FRM_PIXSIZE_HEIGHT_SHIFT 16 129 #define CRMFB_FRM_CONTROL 0x0003000c 130 #define CRMFB_FRM_CONTROL_DMAEN_SHIFT 0 131 #define CRMFB_FRM_CONTROL_LINEAR_SHIFT 1 132 #define CRMFB_FRM_CONTROL_TILEPTR_SHIFT 9 133 #define CRMFB_DID_CONTROL 0x00040004 134 #define CRMFB_DID_CONTROL_DMAEN_SHIFT 0 135 #define CRMFB_MODE 0x00048000 136 #define CRMFB_MODE_TYP_SHIFT 2 137 #define CRMFB_MODE_TYP_I8 0 138 #define CRMFB_MODE_TYP_ARGB5 4 139 #define CRMFB_MODE_TYP_RGB8 5 140 #define CRMFB_MODE_BUF_SHIFT 0 141 #define CRMFB_MODE_BUF_BOTH 3 142 #define CRMFB_CMAP 0x00050000 143 #define CRMFB_CMAP_FIFO 0x00058000 144 #define CRMFB_GMAP 0x00060000 145 #define CRMFB_CRS_CONTROL 0x00070004 146 147 static int crmfb_match(struct device *, struct cfdata *, void *); 148 static void crmfb_attach(struct device *, struct device *, void *); 149 int crmfb_probe(void); 150 151 #define KERNADDR(p) ((void *)((p).addr)) 152 #define DMAADDR(p) ((p).map->dm_segs[0].ds_addr) 153 154 struct crmfb_dma { 155 bus_dmamap_t map; 156 void *addr; 157 bus_dma_segment_t segs[1]; 158 int nsegs; 159 size_t size; 160 }; 161 162 struct crmfb_softc { 163 struct device sc_dev; 164 struct vcons_data sc_vd; 165 166 bus_space_tag_t sc_iot; 167 bus_space_handle_t sc_ioh; 168 bus_dma_tag_t sc_dmat; 169 170 struct crmfb_dma sc_dma; 171 struct crmfb_dma sc_dmai; 172 173 int sc_width; 174 int sc_height; 175 int sc_depth; 176 uint32_t sc_fbsize; 177 178 int sc_wsmode; 179 u_char sc_cmap_red[256]; 180 u_char sc_cmap_green[256]; 181 u_char sc_cmap_blue[256]; 182 }; 183 184 static int crmfb_putcmap(struct crmfb_softc *, struct wsdisplay_cmap *); 185 static int crmfb_getcmap(struct crmfb_softc *, struct wsdisplay_cmap *); 186 static void crmfb_set_palette(struct crmfb_softc *, 187 int, uint8_t, uint8_t, uint8_t); 188 189 CFATTACH_DECL(crmfb, sizeof(struct crmfb_softc), 190 crmfb_match, crmfb_attach, NULL, NULL); 191 192 static int 193 crmfb_match(struct device *parent, struct cfdata *cf, void *opaque) 194 { 195 return crmfb_probe(); 196 } 197 198 static void 199 crmfb_attach(struct device *parent, struct device *self, void *opaque) 200 { 201 struct mainbus_attach_args *ma; 202 struct crmfb_softc *sc; 203 struct rasops_info *ri; 204 struct wsemuldisplaydev_attach_args aa; 205 uint32_t d, h; 206 uint16_t *p; 207 unsigned long v; 208 long defattr; 209 const char *consdev; 210 int rv, i; 211 212 sc = (struct crmfb_softc *)self; 213 ma = (struct mainbus_attach_args *)opaque; 214 215 sc->sc_iot = SGIMIPS_BUS_SPACE_CRIME; 216 sc->sc_dmat = &sgimips_default_bus_dma_tag; 217 sc->sc_wsmode = WSDISPLAYIO_MODE_EMUL; 218 219 aprint_normal(": SGI CRIME Graphics Display Engine\n"); 220 rv = bus_space_map(sc->sc_iot, ma->ma_addr, 0 /* XXX */, 221 BUS_SPACE_MAP_LINEAR, &sc->sc_ioh); 222 if (rv) 223 panic("crmfb_attach: can't map I/O space"); 224 225 /* determine mode configured by firmware */ 226 d = bus_space_read_4(sc->sc_iot, sc->sc_ioh, CRMFB_VT_VCMAP); 227 sc->sc_width = (d >> CRMFB_VT_VCMAP_ON_SHIFT) & 0xfff; 228 d = bus_space_read_4(sc->sc_iot, sc->sc_ioh, CRMFB_VT_HCMAP); 229 sc->sc_height = (d >> CRMFB_VT_HCMAP_ON_SHIFT) & 0xfff; 230 d = bus_space_read_4(sc->sc_iot, sc->sc_ioh, CRMFB_FRM_TILESIZE); 231 h = (d >> CRMFB_FRM_TILESIZE_DEPTH_SHIFT) & 0x3; 232 if (h == 0) 233 sc->sc_depth = 8; 234 else if (h == 1) 235 sc->sc_depth = 16; 236 else 237 sc->sc_depth = 32; 238 239 printf("%s: initial resolution %dx%d %d bpp\n", 240 sc->sc_dev.dv_xname, sc->sc_width, sc->sc_height, sc->sc_depth); 241 242 #if 0 243 /* Changing the colour depth is easy... */ 244 sc->sc_depth = 32; 245 printf("%s: using resolution %dx%d %d bpp\n", 246 sc->sc_dev.dv_xname, sc->sc_width, sc->sc_height, sc->sc_depth); 247 #endif 248 249 sc->sc_fbsize = sc->sc_width * sc->sc_height * sc->sc_depth / 8; 250 sc->sc_fbsize = (sc->sc_fbsize / CRMFB_TILESIZE) * CRMFB_TILESIZE; 251 252 sc->sc_dmai.size = 128 * sizeof(uint16_t); 253 rv = bus_dmamem_alloc(sc->sc_dmat, sc->sc_dmai.size, 65536, 0, 254 sc->sc_dmai.segs, 255 sizeof(sc->sc_dmai.segs) / sizeof(sc->sc_dmai.segs[0]), 256 &sc->sc_dmai.nsegs, BUS_DMA_NOWAIT); 257 if (rv) 258 panic("crmfb_attach: can't allocate DMA memory"); 259 rv = bus_dmamem_map(sc->sc_dmat, sc->sc_dmai.segs, sc->sc_dmai.nsegs, 260 sc->sc_dmai.size, &sc->sc_dmai.addr, 261 BUS_DMA_NOWAIT); 262 if (rv) 263 panic("crmfb_attach: can't map DMA memory"); 264 rv = bus_dmamap_create(sc->sc_dmat, sc->sc_dmai.size, 1, 265 sc->sc_dmai.size, 0, BUS_DMA_NOWAIT, &sc->sc_dmai.map); 266 if (rv) 267 panic("crmfb_attach: can't create DMA map"); 268 rv = bus_dmamap_load(sc->sc_dmat, sc->sc_dmai.map, sc->sc_dmai.addr, 269 sc->sc_dmai.size, NULL, BUS_DMA_NOWAIT); 270 if (rv) 271 panic("crmfb_attach: can't load DMA map"); 272 273 sc->sc_dma.size = sc->sc_fbsize; 274 rv = bus_dmamem_alloc(sc->sc_dmat, sc->sc_dma.size, 65536, 0, 275 sc->sc_dma.segs, 276 sizeof(sc->sc_dma.segs) / sizeof(sc->sc_dma.segs[0]), 277 &sc->sc_dma.nsegs, BUS_DMA_NOWAIT); 278 if (rv) 279 panic("crmfb_attach: can't allocate DMA memory"); 280 rv = bus_dmamem_map(sc->sc_dmat, sc->sc_dma.segs, sc->sc_dma.nsegs, 281 sc->sc_dma.size, &sc->sc_dma.addr, 282 BUS_DMA_NOWAIT | BUS_DMA_COHERENT); 283 if (rv) 284 panic("crmfb_attach: can't map DMA memory"); 285 rv = bus_dmamap_create(sc->sc_dmat, sc->sc_dma.size, 1, 286 sc->sc_dma.size, 0, BUS_DMA_NOWAIT, &sc->sc_dma.map); 287 if (rv) 288 panic("crmfb_attach: can't create DMA map"); 289 rv = bus_dmamap_load(sc->sc_dmat, sc->sc_dma.map, sc->sc_dma.addr, 290 sc->sc_dma.size, NULL, BUS_DMA_NOWAIT); 291 if (rv) 292 panic("crmfb_attach: can't load DMA map"); 293 294 p = KERNADDR(sc->sc_dmai); 295 v = (unsigned long)DMAADDR(sc->sc_dma); 296 for (i = 0; i < (sc->sc_fbsize >> 16); i++) { 297 p[i] = ((uint32_t)v >> 16) + i; 298 } 299 300 memset(KERNADDR(sc->sc_dma), 0x00, sc->sc_fbsize); 301 302 printf("%s: allocated %d byte fb @ %p (%p)\n", sc->sc_dev.dv_xname, 303 sc->sc_fbsize, KERNADDR(sc->sc_dmai), KERNADDR(sc->sc_dma)); 304 305 ri = &crmfb_console_screen.scr_ri; 306 memset(ri, 0, sizeof(struct rasops_info)); 307 308 vcons_init(&sc->sc_vd, sc, &crmfb_defaultscreen, &crmfb_accessops); 309 sc->sc_vd.init_screen = crmfb_init_screen; 310 crmfb_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC; 311 vcons_init_screen(&sc->sc_vd, &crmfb_console_screen, 1, &defattr); 312 313 crmfb_defaultscreen.ncols = ri->ri_cols; 314 crmfb_defaultscreen.nrows = ri->ri_rows; 315 crmfb_defaultscreen.textops = &ri->ri_ops; 316 crmfb_defaultscreen.capabilities = ri->ri_caps; 317 crmfb_defaultscreen.modecookie = NULL; 318 319 /* disable DMA */ 320 d = bus_space_read_4(sc->sc_iot, sc->sc_ioh, CRMFB_OVR_CONTROL); 321 d &= ~(1 << CRMFB_OVR_CONTROL_DMAEN_SHIFT); 322 bus_space_write_4(sc->sc_iot, sc->sc_ioh, CRMFB_OVR_CONTROL, d); 323 DELAY(10000); 324 d = bus_space_read_4(sc->sc_iot, sc->sc_ioh, CRMFB_FRM_CONTROL); 325 d &= ~(1 << CRMFB_FRM_CONTROL_DMAEN_SHIFT); 326 bus_space_write_4(sc->sc_iot, sc->sc_ioh, CRMFB_FRM_CONTROL, d); 327 DELAY(10000); 328 bus_space_write_4(sc->sc_iot, sc->sc_ioh, CRMFB_DID_CONTROL, 0); 329 DELAY(10000); 330 331 /* ensure that CRM starts drawing at the top left of the screen 332 * when we re-enable DMA later 333 */ 334 d = (1 << CRMFB_VT_XY_FREEZE_SHIFT); 335 bus_space_write_4(sc->sc_iot, sc->sc_ioh, CRMFB_VT_XY, d); 336 d = bus_space_read_4(sc->sc_iot, sc->sc_ioh, CRMFB_DOTCLOCK); 337 d &= ~(1 << CRMFB_DOTCLOCK_CLKRUN_SHIFT); 338 bus_space_write_4(sc->sc_iot, sc->sc_ioh, CRMFB_DOTCLOCK, d); 339 340 /* reset FIFO */ 341 d = bus_space_read_4(sc->sc_iot, sc->sc_ioh, CRMFB_FRM_TILESIZE); 342 d |= (1 << CRMFB_FRM_TILESIZE_FIFOR_SHIFT); 343 bus_space_write_4(sc->sc_iot, sc->sc_ioh, CRMFB_FRM_TILESIZE, d); 344 d &= ~(1 << CRMFB_FRM_TILESIZE_FIFOR_SHIFT); 345 bus_space_write_4(sc->sc_iot, sc->sc_ioh, CRMFB_FRM_TILESIZE, d); 346 347 /* setup colour mode */ 348 switch (sc->sc_depth) { 349 case 8: 350 h = CRMFB_MODE_TYP_I8; 351 break; 352 case 16: 353 h = CRMFB_MODE_TYP_ARGB5; 354 break; 355 case 32: 356 h = CRMFB_MODE_TYP_RGB8; 357 break; 358 default: 359 panic("Unsupported depth"); 360 } 361 d = h << CRMFB_MODE_TYP_SHIFT; 362 d |= CRMFB_MODE_BUF_BOTH << CRMFB_MODE_BUF_SHIFT; 363 for (i = 0; i < (32 * 4); i += 4) 364 bus_space_write_4(sc->sc_iot, sc->sc_ioh, CRMFB_MODE + i, d); 365 366 /* setup tile pointer, but don't turn on DMA yet! */ 367 h = DMAADDR(sc->sc_dmai); 368 d = (h >> 9) << CRMFB_FRM_CONTROL_TILEPTR_SHIFT; 369 bus_space_write_4(sc->sc_iot, sc->sc_ioh, CRMFB_FRM_CONTROL, d); 370 371 /* init framebuffer width and pixel size */ 372 d = (1 << CRMFB_FRM_TILESIZE_WIDTH_SHIFT); 373 switch (sc->sc_depth) { 374 case 8: 375 h = CRMFB_FRM_TILESIZE_DEPTH_8; 376 break; 377 case 16: 378 h = CRMFB_FRM_TILESIZE_DEPTH_16; 379 break; 380 case 32: 381 h = CRMFB_FRM_TILESIZE_DEPTH_32; 382 break; 383 default: 384 panic("Unsupported depth"); 385 } 386 d |= (h << CRMFB_FRM_TILESIZE_DEPTH_SHIFT); 387 bus_space_write_4(sc->sc_iot, sc->sc_ioh, CRMFB_FRM_TILESIZE, d); 388 389 /* init framebuffer height, we use the trick that the Linux 390 * driver uses to fool the CRM out of tiled mode and into 391 * linear mode 392 */ 393 h = sc->sc_width * sc->sc_height / (512 / (sc->sc_depth / 8)); 394 d = h << CRMFB_FRM_PIXSIZE_HEIGHT_SHIFT; 395 bus_space_write_4(sc->sc_iot, sc->sc_ioh, CRMFB_FRM_PIXSIZE, d); 396 397 /* turn off firmware overlay and hardware cursor */ 398 bus_space_write_4(sc->sc_iot, sc->sc_ioh, CRMFB_OVR_WIDTH_TILE, 0); 399 bus_space_write_4(sc->sc_iot, sc->sc_ioh, CRMFB_CRS_CONTROL, 0); 400 401 /* enable drawing again */ 402 d = bus_space_read_4(sc->sc_iot, sc->sc_ioh, CRMFB_DOTCLOCK); 403 d |= (1 << CRMFB_DOTCLOCK_CLKRUN_SHIFT); 404 bus_space_write_4(sc->sc_iot, sc->sc_ioh, CRMFB_DOTCLOCK, d); 405 bus_space_write_4(sc->sc_iot, sc->sc_ioh, CRMFB_VT_XY, 0); 406 407 /* turn on DMA for the framebuffer */ 408 d = bus_space_read_4(sc->sc_iot, sc->sc_ioh, CRMFB_FRM_CONTROL); 409 d |= (1 << CRMFB_FRM_CONTROL_DMAEN_SHIFT); 410 bus_space_write_4(sc->sc_iot, sc->sc_ioh, CRMFB_FRM_CONTROL, d); 411 412 for (i = 0; i < 256; i++) { 413 crmfb_set_palette(sc, i, rasops_cmap[(i * 3) + 2], 414 rasops_cmap[(i * 3) + 1], rasops_cmap[(i * 3) + 0]); 415 sc->sc_cmap_red[i] = rasops_cmap[(i * 3) + 2]; 416 sc->sc_cmap_green[i] = rasops_cmap[(i * 3) + 1]; 417 sc->sc_cmap_blue[i] = rasops_cmap[(i * 3) + 0]; 418 } 419 420 consdev = ARCBIOS->GetEnvironmentVariable("ConsoleOut"); 421 if (consdev != NULL && strcmp(consdev, "video()") == 0) { 422 wsdisplay_cnattach(&crmfb_defaultscreen, ri, 0, 0, defattr); 423 aa.console = 1; 424 } else 425 aa.console = 0; 426 aa.scrdata = &crmfb_screenlist; 427 aa.accessops = &crmfb_accessops; 428 aa.accesscookie = &sc->sc_vd; 429 430 config_found(self, &aa, wsemuldisplaydevprint); 431 432 return; 433 } 434 435 int 436 crmfb_probe(void) 437 { 438 439 if (mach_type != MACH_SGI_IP32) 440 return 0; 441 442 return 1; 443 } 444 445 static int 446 crmfb_ioctl(void *v, void *vs, u_long cmd, void *data, int flag, struct lwp *l) 447 { 448 struct vcons_data *vd; 449 struct crmfb_softc *sc; 450 struct vcons_screen *ms; 451 struct wsdisplay_fbinfo *wdf; 452 int nmode; 453 454 vd = (struct vcons_data *)v; 455 sc = (struct crmfb_softc *)vd->cookie; 456 ms = (struct vcons_screen *)vd->active; 457 458 switch (cmd) { 459 case WSDISPLAYIO_GTYPE: 460 /* not really, but who cares? */ 461 *(u_int *)data = WSDISPLAY_TYPE_NEWPORT; 462 return 0; 463 case WSDISPLAYIO_GINFO: 464 if (vd->active != NULL) { 465 wdf = (void *)data; 466 wdf->height = sc->sc_height; 467 wdf->width = sc->sc_width; 468 wdf->depth = sc->sc_depth; 469 wdf->cmsize = 256; 470 return 0; 471 } else 472 return ENODEV; 473 case WSDISPLAYIO_GETCMAP: 474 if (sc->sc_depth == 8) 475 return crmfb_getcmap(sc, (struct wsdisplay_cmap *)data); 476 else 477 return EINVAL; 478 case WSDISPLAYIO_PUTCMAP: 479 if (sc->sc_depth == 8) 480 return crmfb_putcmap(sc, (struct wsdisplay_cmap *)data); 481 else 482 return EINVAL; 483 case WSDISPLAYIO_LINEBYTES: 484 *(u_int *)data = sc->sc_width * sc->sc_depth / 8; 485 return 0; 486 case WSDISPLAYIO_SMODE: 487 nmode = *(int *)data; 488 if (nmode != sc->sc_wsmode) { 489 sc->sc_wsmode = nmode; 490 if (nmode == WSDISPLAYIO_MODE_EMUL) 491 vcons_redraw_screen(vd->active); 492 } 493 return 0; 494 } 495 496 return EPASSTHROUGH; 497 } 498 499 static paddr_t 500 crmfb_mmap(void *v, void *vs, off_t offset, int prot) 501 { 502 struct vcons_data *vd; 503 struct crmfb_softc *sc; 504 paddr_t pa; 505 506 vd = (struct vcons_data *)v; 507 sc = (struct crmfb_softc *)vd->cookie; 508 509 if (offset >= 0 && offset < sc->sc_fbsize) { 510 pa = bus_dmamem_mmap(sc->sc_dmat, sc->sc_dma.segs, 511 sc->sc_dma.nsegs, offset, prot, 512 BUS_DMA_WAITOK | BUS_DMA_NOCACHE); 513 return pa; 514 } 515 516 return -1; 517 } 518 519 static void 520 crmfb_init_screen(void *c, struct vcons_screen *scr, int existing, 521 long *defattr) 522 { 523 struct crmfb_softc *sc; 524 struct rasops_info *ri; 525 526 sc = (struct crmfb_softc *)c; 527 ri = &scr->scr_ri; 528 529 ri->ri_flg = RI_CENTER; 530 ri->ri_depth = sc->sc_depth; 531 ri->ri_width = sc->sc_width; 532 ri->ri_height = sc->sc_height; 533 ri->ri_stride = ri->ri_width * (ri->ri_depth / 8); 534 535 switch (ri->ri_depth) { 536 case 16: 537 ri->ri_rnum = ri->ri_gnum = ri->ri_bnum = 5; 538 ri->ri_rpos = 10; 539 ri->ri_gpos = 5; 540 ri->ri_bpos = 0; 541 break; 542 case 32: 543 ri->ri_rnum = ri->ri_gnum = ri->ri_bnum = 8; 544 ri->ri_rpos = 8; 545 ri->ri_gpos = 16; 546 ri->ri_bpos = 24; 547 break; 548 } 549 550 ri->ri_bits = KERNADDR(sc->sc_dma); 551 552 if (existing) 553 ri->ri_flg |= RI_CLEAR; 554 555 rasops_init(ri, ri->ri_height / 16, ri->ri_width / 8); 556 ri->ri_caps = WSSCREEN_WSCOLORS; 557 rasops_reconfig(ri, ri->ri_height / ri->ri_font->fontheight, 558 ri->ri_width / ri->ri_font->fontwidth); 559 ri->ri_hw = scr; 560 561 return; 562 } 563 564 static int 565 crmfb_putcmap(struct crmfb_softc *sc, struct wsdisplay_cmap *cm) 566 { 567 u_int idx, cnt; 568 u_char r[256], g[256], b[256]; 569 u_char *rp, *gp, *bp; 570 int rv, i; 571 572 idx = cm->index; 573 cnt = cm->count; 574 575 if (idx >= 255 || cnt > 256 || idx + cnt > 256) 576 return EINVAL; 577 578 rv = copyin(cm->red, &r[idx], cnt); 579 if (rv) 580 return rv; 581 rv = copyin(cm->green, &g[idx], cnt); 582 if (rv) 583 return rv; 584 rv = copyin(cm->blue, &b[idx], cnt); 585 if (rv) 586 return rv; 587 588 memcpy(&sc->sc_cmap_red[idx], &r[idx], cnt); 589 memcpy(&sc->sc_cmap_green[idx], &g[idx], cnt); 590 memcpy(&sc->sc_cmap_blue[idx], &b[idx], cnt); 591 592 rp = &sc->sc_cmap_red[idx]; 593 gp = &sc->sc_cmap_green[idx]; 594 bp = &sc->sc_cmap_blue[idx]; 595 596 for (i = 0; i < cnt; i++) { 597 crmfb_set_palette(sc, idx, *rp, *gp, *bp); 598 idx++; 599 rp++, gp++, bp++; 600 } 601 602 return 0; 603 } 604 605 static int 606 crmfb_getcmap(struct crmfb_softc *sc, struct wsdisplay_cmap *cm) 607 { 608 u_int idx, cnt; 609 int rv; 610 611 idx = cm->index; 612 cnt = cm->count; 613 614 if (idx >= 255 || cnt > 256 || idx + cnt > 256) 615 return EINVAL; 616 617 rv = copyout(&sc->sc_cmap_red[idx], cm->red, cnt); 618 if (rv) 619 return rv; 620 rv = copyout(&sc->sc_cmap_green[idx], cm->green, cnt); 621 if (rv) 622 return rv; 623 rv = copyout(&sc->sc_cmap_blue[idx], cm->blue, cnt); 624 if (rv) 625 return rv; 626 627 return 0; 628 } 629 630 static void 631 crmfb_set_palette(struct crmfb_softc *sc, int reg, uint8_t r, uint8_t g, 632 uint8_t b) 633 { 634 uint32_t val; 635 636 if (reg > 255 || sc->sc_depth != 8) 637 return; 638 639 while (bus_space_read_4(sc->sc_iot, sc->sc_ioh, CRMFB_CMAP_FIFO) >= 63) 640 DELAY(10); 641 642 val = (r << 24) | (g << 16) | (b << 8); 643 bus_space_write_4(sc->sc_iot, sc->sc_ioh, CRMFB_CMAP + (reg * 4), val); 644 645 return; 646 } 647
Indexes created Fri Sep 26 20:09:58 GMT 2025