gfb.c revision 1.12 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