1 1.12 thorpej /* $NetBSD: gfb.c,v 1.12 2023/12/20 05:33:58 thorpej Exp $ */ 2 1.1 macallan 3 1.1 macallan /* 4 1.1 macallan * Copyright (c) 2009 Michael Lorenz 5 1.1 macallan * All rights reserved. 6 1.1 macallan * 7 1.1 macallan * Redistribution and use in source and binary forms, with or without 8 1.1 macallan * modification, are permitted provided that the following conditions 9 1.1 macallan * are met: 10 1.1 macallan * 1. Redistributions of source code must retain the above copyright 11 1.1 macallan * notice, this list of conditions and the following disclaimer. 12 1.1 macallan * 2. Redistributions in binary form must reproduce the above copyright 13 1.1 macallan * notice, this list of conditions and the following disclaimer in the 14 1.1 macallan * documentation and/or other materials provided with the distribution. 15 1.1 macallan * 16 1.1 macallan * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 17 1.1 macallan * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 18 1.1 macallan * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 19 1.1 macallan * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 20 1.1 macallan * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 21 1.1 macallan * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 22 1.1 macallan * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 23 1.1 macallan * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 24 1.1 macallan * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 25 1.1 macallan * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 26 1.1 macallan */ 27 1.1 macallan 28 1.1 macallan /* 29 1.1 macallan * A console driver for Sun XVR-1000 graphics cards 30 1.1 macallan */ 31 1.1 macallan 32 1.1 macallan #include <sys/cdefs.h> 33 1.12 thorpej __KERNEL_RCSID(0, "$NetBSD: gfb.c,v 1.12 2023/12/20 05:33:58 thorpej Exp $"); 34 1.1 macallan 35 1.1 macallan #include <sys/param.h> 36 1.1 macallan #include <sys/systm.h> 37 1.1 macallan #include <sys/kernel.h> 38 1.1 macallan #include <sys/device.h> 39 1.1 macallan #include <sys/lwp.h> 40 1.1 macallan #include <sys/kauth.h> 41 1.1 macallan #include <sys/kmem.h> 42 1.1 macallan 43 1.1 macallan #include <uvm/uvm_extern.h> 44 1.1 macallan 45 1.1 macallan #include <dev/videomode/videomode.h> 46 1.1 macallan 47 1.4 dyoung #include <sys/bus.h> 48 1.1 macallan #include <machine/autoconf.h> 49 1.1 macallan #include <machine/openfirm.h> 50 1.1 macallan 51 1.1 macallan #include <dev/wscons/wsdisplayvar.h> 52 1.1 macallan #include <dev/wscons/wsconsio.h> 53 1.1 macallan #include <dev/wsfont/wsfont.h> 54 1.1 macallan #include <dev/rasops/rasops.h> 55 1.1 macallan #include <dev/wscons/wsdisplay_vconsvar.h> 56 1.1 macallan 57 1.1 macallan 58 1.1 macallan struct gfb_softc { 59 1.1 macallan device_t sc_dev; 60 1.1 macallan 61 1.1 macallan bus_space_tag_t sc_memt; 62 1.1 macallan 63 1.1 macallan bus_space_handle_t sc_fbh; 64 1.1 macallan bus_addr_t sc_fb_paddr; 65 1.1 macallan 66 1.1 macallan int sc_width, sc_height, sc_depth, sc_stride, sc_fblen; 67 1.1 macallan int sc_locked; 68 1.3 macallan void *sc_fbaddr; 69 1.1 macallan struct vcons_screen sc_console_screen; 70 1.1 macallan struct wsscreen_descr sc_defaultscreen_descr; 71 1.1 macallan const struct wsscreen_descr *sc_screens[1]; 72 1.1 macallan struct wsscreen_list sc_screenlist; 73 1.1 macallan struct vcons_data vd; 74 1.1 macallan int sc_mode; 75 1.1 macallan int sc_node; 76 1.1 macallan u_char sc_cmap_red[256]; 77 1.1 macallan u_char sc_cmap_green[256]; 78 1.1 macallan u_char sc_cmap_blue[256]; 79 1.1 macallan }; 80 1.1 macallan 81 1.1 macallan static int gfb_match(device_t, cfdata_t, void *); 82 1.1 macallan static void gfb_attach(device_t, device_t, void *); 83 1.1 macallan 84 1.1 macallan CFATTACH_DECL_NEW(gfb, sizeof(struct gfb_softc), 85 1.1 macallan gfb_match, gfb_attach, NULL, NULL); 86 1.1 macallan 87 1.1 macallan extern const u_char rasops_cmap[768]; 88 1.1 macallan 89 1.1 macallan static int gfb_ioctl(void *, void *, u_long, void *, int, 90 1.1 macallan struct lwp *); 91 1.1 macallan static paddr_t gfb_mmap(void *, void *, off_t, int); 92 1.1 macallan static void gfb_init_screen(void *, struct vcons_screen *, int, long *); 93 1.1 macallan 94 1.1 macallan static int gfb_putcmap(struct gfb_softc *, struct wsdisplay_cmap *); 95 1.1 macallan static int gfb_getcmap(struct gfb_softc *, struct wsdisplay_cmap *); 96 1.1 macallan static void gfb_restore_palette(struct gfb_softc *); 97 1.1 macallan static int gfb_putpalreg(struct gfb_softc *, uint8_t, uint8_t, 98 1.1 macallan uint8_t, uint8_t); 99 1.1 macallan 100 1.1 macallan struct wsdisplay_accessops gfb_accessops = { 101 1.1 macallan gfb_ioctl, 102 1.1 macallan gfb_mmap, 103 1.1 macallan NULL, /* alloc_screen */ 104 1.1 macallan NULL, /* free_screen */ 105 1.1 macallan NULL, /* show_screen */ 106 1.1 macallan NULL, /* load_font */ 107 1.1 macallan NULL, /* pollc */ 108 1.1 macallan NULL /* scroll */ 109 1.1 macallan }; 110 1.1 macallan 111 1.1 macallan extern int prom_stdout_node; 112 1.1 macallan 113 1.1 macallan static int 114 1.1 macallan gfb_match(device_t parent, cfdata_t match, void *aux) 115 1.1 macallan { 116 1.1 macallan struct mainbus_attach_args *ma = aux; 117 1.1 macallan 118 1.1 macallan if (strcmp(ma->ma_name, "SUNW,gfb") == 0 ) 119 1.1 macallan return 100; 120 1.1 macallan return 0; 121 1.1 macallan } 122 1.1 macallan 123 1.1 macallan static void 124 1.1 macallan gfb_attach(device_t parent, device_t self, void *aux) 125 1.1 macallan { 126 1.1 macallan struct gfb_softc *sc = device_private(self); 127 1.1 macallan struct mainbus_attach_args *ma = aux; 128 1.1 macallan struct rasops_info *ri; 129 1.1 macallan struct wsemuldisplaydev_attach_args aa; 130 1.1 macallan unsigned long defattr; 131 1.1 macallan bool is_console; 132 1.1 macallan int i, j; 133 1.1 macallan 134 1.1 macallan sc->sc_memt = ma->ma_bustag; 135 1.1 macallan sc->sc_dev = self; 136 1.1 macallan sc->sc_node = ma->ma_node; 137 1.1 macallan 138 1.1 macallan if (ma->ma_nreg < 7) { 139 1.1 macallan aprint_error("%s: can't find the fb range\n", 140 1.1 macallan device_xname(self)); 141 1.1 macallan return; 142 1.1 macallan } 143 1.1 macallan 144 1.1 macallan is_console = (prom_stdout_node == ma->ma_node); 145 1.1 macallan 146 1.1 macallan aprint_normal(": Sun XVR-1000%s\n", is_console ? " (console)" : ""); 147 1.1 macallan 148 1.1 macallan sc->sc_depth = 32; 149 1.1 macallan sc->sc_stride = 0x4000; 150 1.1 macallan sc->sc_height = prom_getpropint(sc->sc_node, "height", 0); 151 1.1 macallan sc->sc_width = prom_getpropint(sc->sc_node, "width", 0); 152 1.1 macallan sc->sc_fblen = sc->sc_stride * sc->sc_height; 153 1.1 macallan 154 1.1 macallan if (sc->sc_fblen == 0) { 155 1.1 macallan aprint_error("%s: not set up by firmware, can't continue.\n", 156 1.1 macallan device_xname(self)); 157 1.1 macallan return; 158 1.1 macallan } 159 1.1 macallan 160 1.1 macallan sc->sc_locked = 0; 161 1.1 macallan sc->sc_mode = WSDISPLAYIO_MODE_EMUL; 162 1.1 macallan 163 1.1 macallan if (bus_space_map(sc->sc_memt, ma->ma_reg[6].ur_paddr, 164 1.9 macallan sc->sc_fblen, BUS_SPACE_MAP_LINEAR | BUS_SPACE_MAP_PREFETCHABLE, 165 1.9 macallan &sc->sc_fbh)) { 166 1.1 macallan printf(": failed to map the framebuffer\n"); 167 1.1 macallan return; 168 1.1 macallan } 169 1.1 macallan sc->sc_fbaddr = bus_space_vaddr(sc->sc_memt, sc->sc_fbh); 170 1.1 macallan sc->sc_fb_paddr = ma->ma_reg[6].ur_paddr; 171 1.1 macallan 172 1.1 macallan sc->sc_defaultscreen_descr = (struct wsscreen_descr){ 173 1.1 macallan "default", 174 1.1 macallan 0, 0, 175 1.1 macallan NULL, 176 1.1 macallan 8, 16, 177 1.1 macallan WSSCREEN_WSCOLORS | WSSCREEN_HILIT, 178 1.1 macallan NULL 179 1.1 macallan }; 180 1.1 macallan sc->sc_screens[0] = &sc->sc_defaultscreen_descr; 181 1.1 macallan sc->sc_screenlist = (struct wsscreen_list){1, sc->sc_screens}; 182 1.1 macallan sc->sc_mode = WSDISPLAYIO_MODE_EMUL; 183 1.1 macallan sc->sc_locked = 0; 184 1.1 macallan 185 1.1 macallan vcons_init(&sc->vd, sc, &sc->sc_defaultscreen_descr, 186 1.1 macallan &gfb_accessops); 187 1.1 macallan sc->vd.init_screen = gfb_init_screen; 188 1.1 macallan 189 1.1 macallan ri = &sc->sc_console_screen.scr_ri; 190 1.1 macallan 191 1.1 macallan j = 0; 192 1.7 macallan for (i = 0; i < 256; i++) { 193 1.1 macallan 194 1.1 macallan sc->sc_cmap_red[i] = rasops_cmap[j]; 195 1.1 macallan sc->sc_cmap_green[i] = rasops_cmap[j + 1]; 196 1.1 macallan sc->sc_cmap_blue[i] = rasops_cmap[j + 2]; 197 1.1 macallan gfb_putpalreg(sc, i, rasops_cmap[j], rasops_cmap[j + 1], 198 1.1 macallan rasops_cmap[j + 2]); 199 1.1 macallan j += 3; 200 1.1 macallan } 201 1.1 macallan 202 1.1 macallan if (is_console) { 203 1.1 macallan vcons_init_screen(&sc->vd, &sc->sc_console_screen, 1, 204 1.1 macallan &defattr); 205 1.1 macallan sc->sc_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC; 206 1.1 macallan 207 1.1 macallan #if notyet 208 1.1 macallan gfb_rectfill(sc, 0, 0, sc->sc_width, sc->sc_height, 209 1.1 macallan ri->ri_devcmap[(defattr >> 16) & 0xff]); 210 1.1 macallan #endif 211 1.1 macallan sc->sc_defaultscreen_descr.textops = &ri->ri_ops; 212 1.1 macallan sc->sc_defaultscreen_descr.capabilities = ri->ri_caps; 213 1.1 macallan sc->sc_defaultscreen_descr.nrows = ri->ri_rows; 214 1.1 macallan sc->sc_defaultscreen_descr.ncols = ri->ri_cols; 215 1.1 macallan wsdisplay_cnattach(&sc->sc_defaultscreen_descr, ri, 0, 0, 216 1.1 macallan defattr); 217 1.1 macallan vcons_replay_msgbuf(&sc->sc_console_screen); 218 1.1 macallan } else { 219 1.1 macallan /* 220 1.1 macallan * since we're not the console we can postpone the rest 221 1.1 macallan * until someone actually allocates a screen for us 222 1.1 macallan */ 223 1.1 macallan (*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr); 224 1.1 macallan } 225 1.1 macallan 226 1.1 macallan aa.console = is_console; 227 1.1 macallan aa.scrdata = &sc->sc_screenlist; 228 1.1 macallan aa.accessops = &gfb_accessops; 229 1.1 macallan aa.accesscookie = &sc->vd; 230 1.1 macallan 231 1.11 thorpej config_found(sc->sc_dev, &aa, wsemuldisplaydevprint, CFARGS_NONE); 232 1.3 macallan 233 1.3 macallan #ifdef GFB_DEBUG 234 1.3 macallan /* 235 1.3 macallan * now dump a register range 236 1.3 macallan * try 1, 2 and 4 since they're only 0x2000 each 237 1.3 macallan */ 238 1.3 macallan bus_space_handle_t regh; 239 1.3 macallan 240 1.3 macallan if (bus_space_map(sc->sc_memt, ma->ma_reg[3].ur_paddr, 241 1.3 macallan 0x2000, BUS_SPACE_MAP_LINEAR, ®h) == 0) { 242 1.3 macallan for (i = 0; i < 0x200; i += 32) { 243 1.3 macallan printf("%04x", i); 244 1.3 macallan for (j = 0; j < 32; j += 4) { 245 1.3 macallan printf(" %08x", bus_space_read_4(sc->sc_memt, 246 1.3 macallan regh, i + j)); 247 1.3 macallan } 248 1.8 msaitoh printf("\n"); 249 1.3 macallan } 250 1.3 macallan bus_space_unmap(sc->sc_memt, regh, 0x2000); 251 1.3 macallan } 252 1.3 macallan #endif 253 1.1 macallan } 254 1.1 macallan 255 1.1 macallan static int 256 1.1 macallan gfb_ioctl(void *v, void *vs, u_long cmd, void *data, int flag, 257 1.1 macallan struct lwp *l) 258 1.1 macallan { 259 1.1 macallan struct vcons_data *vd = v; 260 1.1 macallan struct gfb_softc *sc = vd->cookie; 261 1.1 macallan struct wsdisplay_fbinfo *wdf; 262 1.1 macallan struct vcons_screen *ms = vd->active; 263 1.1 macallan 264 1.1 macallan switch (cmd) { 265 1.1 macallan 266 1.1 macallan case WSDISPLAYIO_GTYPE: 267 1.2 macallan *(u_int *)data = WSDISPLAY_TYPE_XVR1000; 268 1.1 macallan return 0; 269 1.1 macallan 270 1.1 macallan case WSDISPLAYIO_GINFO: 271 1.1 macallan if (ms == NULL) 272 1.1 macallan return ENODEV; 273 1.1 macallan wdf = (void *)data; 274 1.1 macallan wdf->height = ms->scr_ri.ri_height; 275 1.1 macallan wdf->width = ms->scr_ri.ri_width; 276 1.1 macallan wdf->depth = ms->scr_ri.ri_depth; 277 1.1 macallan wdf->cmsize = 256; 278 1.1 macallan return 0; 279 1.1 macallan 280 1.1 macallan case WSDISPLAYIO_GETCMAP: 281 1.1 macallan return gfb_getcmap(sc, 282 1.1 macallan (struct wsdisplay_cmap *)data); 283 1.1 macallan 284 1.1 macallan case WSDISPLAYIO_PUTCMAP: 285 1.1 macallan return gfb_putcmap(sc, 286 1.1 macallan (struct wsdisplay_cmap *)data); 287 1.1 macallan 288 1.1 macallan case WSDISPLAYIO_LINEBYTES: 289 1.1 macallan *(u_int *)data = sc->sc_stride; 290 1.1 macallan return 0; 291 1.1 macallan 292 1.1 macallan case WSDISPLAYIO_SMODE: 293 1.1 macallan { 294 1.1 macallan int new_mode = *(int*)data; 295 1.1 macallan 296 1.1 macallan /* notify the bus backend */ 297 1.1 macallan if (new_mode != sc->sc_mode) { 298 1.1 macallan sc->sc_mode = new_mode; 299 1.1 macallan if(new_mode == WSDISPLAYIO_MODE_EMUL) { 300 1.1 macallan gfb_restore_palette(sc); 301 1.1 macallan vcons_redraw_screen(ms); 302 1.1 macallan } 303 1.1 macallan } 304 1.1 macallan } 305 1.1 macallan return 0; 306 1.9 macallan case WSDISPLAYIO_GET_FBINFO: 307 1.9 macallan { 308 1.9 macallan struct wsdisplayio_fbinfo *fbi = data; 309 1.9 macallan return wsdisplayio_get_fbinfo(&ms->scr_ri, fbi); 310 1.9 macallan } 311 1.1 macallan } 312 1.1 macallan return EPASSTHROUGH; 313 1.1 macallan } 314 1.1 macallan 315 1.1 macallan static paddr_t 316 1.1 macallan gfb_mmap(void *v, void *vs, off_t offset, int prot) 317 1.1 macallan { 318 1.1 macallan struct vcons_data *vd = v; 319 1.1 macallan struct gfb_softc *sc = vd->cookie; 320 1.1 macallan paddr_t pa; 321 1.1 macallan 322 1.1 macallan /* 'regular' framebuffer mmap()ing */ 323 1.1 macallan if (offset < sc->sc_fblen) { 324 1.9 macallan /* 325 1.9 macallan * XXX 326 1.9 macallan * BUS_SPACE_MAP_PREFETCHABLE produces artifacts with X, but 327 1.9 macallan * not with the console code, so don't set it here 328 1.9 macallan */ 329 1.1 macallan pa = bus_space_mmap(sc->sc_memt, sc->sc_fb_paddr + offset, 0, 330 1.1 macallan prot, BUS_SPACE_MAP_LINEAR); 331 1.1 macallan return pa; 332 1.1 macallan } 333 1.1 macallan 334 1.1 macallan /* 335 1.1 macallan * restrict all other mappings to processes with superuser privileges 336 1.1 macallan * or the kernel itself 337 1.1 macallan */ 338 1.6 elad if (kauth_authorize_machdep(kauth_cred_get(), KAUTH_MACHDEP_UNMANAGEDMEM, 339 1.6 elad NULL, NULL, NULL, NULL) != 0) { 340 1.1 macallan aprint_normal("%s: mmap() rejected.\n", 341 1.1 macallan device_xname(sc->sc_dev)); 342 1.1 macallan return -1; 343 1.1 macallan } 344 1.1 macallan 345 1.1 macallan /* let userland map other ranges */ 346 1.1 macallan 347 1.1 macallan return -1; 348 1.1 macallan } 349 1.1 macallan 350 1.1 macallan static void 351 1.1 macallan gfb_init_screen(void *cookie, struct vcons_screen *scr, 352 1.1 macallan int existing, long *defattr) 353 1.1 macallan { 354 1.1 macallan struct gfb_softc *sc = cookie; 355 1.1 macallan struct rasops_info *ri = &scr->scr_ri; 356 1.1 macallan 357 1.1 macallan ri->ri_depth = sc->sc_depth; 358 1.1 macallan ri->ri_width = sc->sc_width; 359 1.1 macallan ri->ri_height = sc->sc_height; 360 1.1 macallan ri->ri_stride = sc->sc_stride; 361 1.7 macallan ri->ri_flg = RI_CENTER | RI_FULLCLEAR | RI_ENABLE_ALPHA; 362 1.1 macallan 363 1.3 macallan ri->ri_bits = (char *)sc->sc_fbaddr; 364 1.3 macallan scr->scr_flags |= VCONS_DONT_READ; 365 1.1 macallan 366 1.1 macallan if (existing) { 367 1.1 macallan ri->ri_flg |= RI_CLEAR; 368 1.1 macallan } 369 1.1 macallan 370 1.7 macallan /* explicitly request BGR in case the default changes */ 371 1.7 macallan ri->ri_rnum = 8; 372 1.7 macallan ri->ri_gnum = 8; 373 1.7 macallan ri->ri_bnum = 8; 374 1.7 macallan ri->ri_rpos = 0; 375 1.7 macallan ri->ri_gpos = 8; 376 1.7 macallan ri->ri_bpos = 16; 377 1.7 macallan 378 1.5 macallan rasops_init(ri, 0, 0); 379 1.1 macallan ri->ri_caps = WSSCREEN_WSCOLORS; 380 1.1 macallan 381 1.1 macallan rasops_reconfig(ri, sc->sc_height / ri->ri_font->fontheight, 382 1.1 macallan sc->sc_width / ri->ri_font->fontwidth); 383 1.1 macallan 384 1.1 macallan ri->ri_hw = scr; 385 1.1 macallan #if 0 386 1.1 macallan ri->ri_ops.copyrows = gfb_copyrows; 387 1.1 macallan ri->ri_ops.copycols = gfb_copycols; 388 1.1 macallan ri->ri_ops.cursor = gfb_cursor; 389 1.1 macallan ri->ri_ops.eraserows = gfb_eraserows; 390 1.1 macallan ri->ri_ops.erasecols = gfb_erasecols; 391 1.1 macallan ri->ri_ops.putchar = gfb_putchar; 392 1.1 macallan #endif 393 1.1 macallan } 394 1.1 macallan 395 1.1 macallan static int 396 1.1 macallan gfb_putcmap(struct gfb_softc *sc, struct wsdisplay_cmap *cm) 397 1.1 macallan { 398 1.1 macallan u_char *r, *g, *b; 399 1.1 macallan u_int index = cm->index; 400 1.1 macallan u_int count = cm->count; 401 1.1 macallan int i, error; 402 1.1 macallan u_char rbuf[256], gbuf[256], bbuf[256]; 403 1.1 macallan 404 1.1 macallan #ifdef GFB_DEBUG 405 1.1 macallan aprint_debug("putcmap: %d %d\n",index, count); 406 1.1 macallan #endif 407 1.1 macallan if (cm->index >= 256 || cm->count > 256 || 408 1.1 macallan (cm->index + cm->count) > 256) 409 1.1 macallan return EINVAL; 410 1.1 macallan error = copyin(cm->red, &rbuf[index], count); 411 1.1 macallan if (error) 412 1.1 macallan return error; 413 1.1 macallan error = copyin(cm->green, &gbuf[index], count); 414 1.1 macallan if (error) 415 1.1 macallan return error; 416 1.1 macallan error = copyin(cm->blue, &bbuf[index], count); 417 1.1 macallan if (error) 418 1.1 macallan return error; 419 1.1 macallan 420 1.1 macallan memcpy(&sc->sc_cmap_red[index], &rbuf[index], count); 421 1.1 macallan memcpy(&sc->sc_cmap_green[index], &gbuf[index], count); 422 1.1 macallan memcpy(&sc->sc_cmap_blue[index], &bbuf[index], count); 423 1.1 macallan 424 1.1 macallan r = &sc->sc_cmap_red[index]; 425 1.1 macallan g = &sc->sc_cmap_green[index]; 426 1.1 macallan b = &sc->sc_cmap_blue[index]; 427 1.1 macallan 428 1.1 macallan for (i = 0; i < count; i++) { 429 1.1 macallan gfb_putpalreg(sc, index, *r, *g, *b); 430 1.1 macallan index++; 431 1.1 macallan r++, g++, b++; 432 1.1 macallan } 433 1.1 macallan return 0; 434 1.1 macallan } 435 1.1 macallan 436 1.1 macallan static int 437 1.1 macallan gfb_getcmap(struct gfb_softc *sc, struct wsdisplay_cmap *cm) 438 1.1 macallan { 439 1.1 macallan u_int index = cm->index; 440 1.1 macallan u_int count = cm->count; 441 1.1 macallan int error; 442 1.1 macallan 443 1.1 macallan if (index >= 255 || count > 256 || index + count > 256) 444 1.1 macallan return EINVAL; 445 1.1 macallan 446 1.1 macallan error = copyout(&sc->sc_cmap_red[index], cm->red, count); 447 1.1 macallan if (error) 448 1.1 macallan return error; 449 1.1 macallan error = copyout(&sc->sc_cmap_green[index], cm->green, count); 450 1.1 macallan if (error) 451 1.1 macallan return error; 452 1.1 macallan error = copyout(&sc->sc_cmap_blue[index], cm->blue, count); 453 1.1 macallan if (error) 454 1.1 macallan return error; 455 1.1 macallan 456 1.1 macallan return 0; 457 1.1 macallan } 458 1.1 macallan 459 1.1 macallan static void 460 1.1 macallan gfb_restore_palette(struct gfb_softc *sc) 461 1.1 macallan { 462 1.1 macallan int i; 463 1.1 macallan 464 1.1 macallan for (i = 0; i < (1 << sc->sc_depth); i++) { 465 1.1 macallan gfb_putpalreg(sc, i, sc->sc_cmap_red[i], 466 1.1 macallan sc->sc_cmap_green[i], sc->sc_cmap_blue[i]); 467 1.1 macallan } 468 1.1 macallan } 469 1.1 macallan 470 1.1 macallan static int 471 1.1 macallan gfb_putpalreg(struct gfb_softc *sc, uint8_t idx, uint8_t r, uint8_t g, 472 1.1 macallan uint8_t b) 473 1.1 macallan { 474 1.1 macallan return 0; 475 1.1 macallan } 476