r128fb.c revision 1.33 1 /* $NetBSD: r128fb.c,v 1.33 2012/04/19 06:58:55 macallan Exp $ */
2
3 /*
4 * Copyright (c) 2007 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 AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
21 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
22 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
23 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
24 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
25 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26 */
27
28 /*
29 * A console driver for ATI Rage 128 graphics controllers
30 * tested on macppc only so far
31 */
32
33 #include <sys/cdefs.h>
34 __KERNEL_RCSID(0, "$NetBSD: r128fb.c,v 1.33 2012/04/19 06:58:55 macallan Exp $");
35
36 #include <sys/param.h>
37 #include <sys/systm.h>
38 #include <sys/kernel.h>
39 #include <sys/device.h>
40 #include <sys/malloc.h>
41 #include <sys/lwp.h>
42 #include <sys/kauth.h>
43
44 #include <dev/videomode/videomode.h>
45
46 #include <dev/pci/pcivar.h>
47 #include <dev/pci/pcireg.h>
48 #include <dev/pci/pcidevs.h>
49 #include <dev/pci/pciio.h>
50 #include <dev/pci/r128fbreg.h>
51
52 #include <dev/wscons/wsdisplayvar.h>
53 #include <dev/wscons/wsconsio.h>
54 #include <dev/wsfont/wsfont.h>
55 #include <dev/rasops/rasops.h>
56 #include <dev/wscons/wsdisplay_vconsvar.h>
57 #include <dev/pci/wsdisplay_pci.h>
58 #include <dev/wscons/wsdisplay_glyphcachevar.h>
59
60 #include <dev/i2c/i2cvar.h>
61
62 #include "opt_r128fb.h"
63 #include "opt_vcons.h"
64
65 #ifdef R128FB_DEBUG
66 #define DPRINTF printf
67 #else
68 #define DPRINTF while(0) printf
69 #endif
70
71 struct r128fb_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_iot;
79
80 bus_space_handle_t sc_regh;
81 bus_addr_t sc_fb, sc_reg;
82 bus_size_t sc_fbsize, sc_regsize;
83
84 int sc_width, sc_height, sc_depth, sc_stride;
85 int sc_locked, sc_have_backlight, sc_bl_level, sc_bl_on;
86 struct vcons_screen sc_console_screen;
87 struct wsscreen_descr sc_defaultscreen_descr;
88 const struct wsscreen_descr *sc_screens[1];
89 struct wsscreen_list sc_screenlist;
90 struct vcons_data vd;
91 int sc_mode;
92 u_char sc_cmap_red[256];
93 u_char sc_cmap_green[256];
94 u_char sc_cmap_blue[256];
95 /* engine stuff */
96 uint32_t sc_master_cntl;
97 glyphcache sc_gc;
98 };
99
100 static int r128fb_match(device_t, cfdata_t, void *);
101 static void r128fb_attach(device_t, device_t, void *);
102
103 CFATTACH_DECL_NEW(r128fb, sizeof(struct r128fb_softc),
104 r128fb_match, r128fb_attach, NULL, NULL);
105
106 static int r128fb_ioctl(void *, void *, u_long, void *, int,
107 struct lwp *);
108 static paddr_t r128fb_mmap(void *, void *, off_t, int);
109 static void r128fb_init_screen(void *, struct vcons_screen *, int, long *);
110
111 static int r128fb_putcmap(struct r128fb_softc *, struct wsdisplay_cmap *);
112 static int r128fb_getcmap(struct r128fb_softc *, struct wsdisplay_cmap *);
113 static void r128fb_restore_palette(struct r128fb_softc *);
114 static int r128fb_putpalreg(struct r128fb_softc *, uint8_t, uint8_t,
115 uint8_t, uint8_t);
116
117 static void r128fb_init(struct r128fb_softc *);
118 static void r128fb_flush_engine(struct r128fb_softc *);
119 static void r128fb_rectfill(struct r128fb_softc *, int, int, int, int,
120 uint32_t);
121 static void r128fb_bitblt(void *, int, int, int, int, int,
122 int, int);
123
124 static void r128fb_cursor(void *, int, int, int);
125 static void r128fb_putchar(void *, int, int, u_int, long);
126 static void r128fb_putchar_aa(void *, int, int, u_int, long);
127 static void r128fb_copycols(void *, int, int, int, int);
128 static void r128fb_erasecols(void *, int, int, int, long);
129 static void r128fb_copyrows(void *, int, int, int);
130 static void r128fb_eraserows(void *, int, int, long);
131
132 static void r128fb_brightness_up(device_t);
133 static void r128fb_brightness_down(device_t);
134 /* set backlight level */
135 static void r128fb_set_backlight(struct r128fb_softc *, int);
136 /* turn backlight on and off without messing with the level */
137 static void r128fb_switch_backlight(struct r128fb_softc *, int);
138
139 struct wsdisplay_accessops r128fb_accessops = {
140 r128fb_ioctl,
141 r128fb_mmap,
142 NULL, /* alloc_screen */
143 NULL, /* free_screen */
144 NULL, /* show_screen */
145 NULL, /* load_font */
146 NULL, /* pollc */
147 NULL /* scroll */
148 };
149
150 static inline void
151 r128fb_wait(struct r128fb_softc *sc, int slots)
152 {
153 uint32_t reg;
154
155 do {
156 reg = (bus_space_read_4(sc->sc_memt, sc->sc_regh,
157 R128_GUI_STAT) & R128_GUI_FIFOCNT_MASK);
158 } while (reg <= slots);
159 }
160
161 static void
162 r128fb_flush_engine(struct r128fb_softc *sc)
163 {
164 uint32_t reg;
165
166 reg = bus_space_read_4(sc->sc_memt, sc->sc_regh, R128_PC_NGUI_CTLSTAT);
167 reg |= R128_PC_FLUSH_ALL;
168 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_PC_NGUI_CTLSTAT, reg);
169 do {
170 reg = bus_space_read_4(sc->sc_memt, sc->sc_regh,
171 R128_PC_NGUI_CTLSTAT);
172 } while (reg & R128_PC_BUSY);
173 }
174
175 static int
176 r128fb_match(device_t parent, cfdata_t match, void *aux)
177 {
178 struct pci_attach_args *pa = (struct pci_attach_args *)aux;
179
180 if (PCI_CLASS(pa->pa_class) != PCI_CLASS_DISPLAY)
181 return 0;
182 if (PCI_VENDOR(pa->pa_id) != PCI_VENDOR_ATI)
183 return 0;
184
185 /* only cards tested on so far - likely need a list */
186 if ((PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_ATI_RAGE1AGP4XT) ||
187 (PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_ATI_RAGE3AGP4XT) ||
188 (PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_ATI_RAGEGLPCI) ||
189 (PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_ATI_RAGE_MOB_M3_AGP))
190 return 100;
191 return (0);
192 }
193
194 static void
195 r128fb_attach(device_t parent, device_t self, void *aux)
196 {
197 struct r128fb_softc *sc = device_private(self);
198 struct pci_attach_args *pa = aux;
199 struct rasops_info *ri;
200 bus_space_tag_t tag;
201 struct wsemuldisplaydev_attach_args aa;
202 prop_dictionary_t dict;
203 unsigned long defattr;
204 bool is_console;
205 int i, j;
206 uint32_t reg, flags;
207 uint8_t cmap[768];
208
209 sc->sc_pc = pa->pa_pc;
210 sc->sc_pcitag = pa->pa_tag;
211 sc->sc_memt = pa->pa_memt;
212 sc->sc_iot = pa->pa_iot;
213 sc->sc_dev = self;
214
215 pci_aprint_devinfo(pa, NULL);
216
217 /* fill in parameters from properties */
218 dict = device_properties(self);
219 if (!prop_dictionary_get_uint32(dict, "width", &sc->sc_width)) {
220 aprint_error("%s: no width property\n", device_xname(self));
221 return;
222 }
223 if (!prop_dictionary_get_uint32(dict, "height", &sc->sc_height)) {
224 aprint_error("%s: no height property\n", device_xname(self));
225 return;
226 }
227 if (!prop_dictionary_get_uint32(dict, "depth", &sc->sc_depth)) {
228 aprint_error("%s: no depth property\n", device_xname(self));
229 return;
230 }
231 if (!prop_dictionary_get_uint32(dict, "linebytes", &sc->sc_stride)) {
232 aprint_error("%s: no linebytes property\n",
233 device_xname(self));
234 return;
235 }
236
237 prop_dictionary_get_bool(dict, "is_console", &is_console);
238
239 if (pci_mapreg_info(pa->pa_pc, pa->pa_tag, 0x10, PCI_MAPREG_TYPE_MEM,
240 &sc->sc_fb, &sc->sc_fbsize, &flags)) {
241 aprint_error("%s: failed to map the frame buffer.\n",
242 device_xname(sc->sc_dev));
243 }
244
245 if (pci_mapreg_map(pa, 0x18, PCI_MAPREG_TYPE_MEM, 0,
246 &tag, &sc->sc_regh, &sc->sc_reg, &sc->sc_regsize)) {
247 aprint_error("%s: failed to map registers.\n",
248 device_xname(sc->sc_dev));
249 }
250
251 aprint_normal("%s: %d MB aperture at 0x%08x\n", device_xname(self),
252 (int)(sc->sc_fbsize >> 20), (uint32_t)sc->sc_fb);
253
254 sc->sc_defaultscreen_descr = (struct wsscreen_descr){
255 "default",
256 0, 0,
257 NULL,
258 8, 16,
259 WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
260 NULL
261 };
262 sc->sc_screens[0] = &sc->sc_defaultscreen_descr;
263 sc->sc_screenlist = (struct wsscreen_list){1, sc->sc_screens};
264 sc->sc_mode = WSDISPLAYIO_MODE_EMUL;
265 sc->sc_locked = 0;
266
267 vcons_init(&sc->vd, sc, &sc->sc_defaultscreen_descr,
268 &r128fb_accessops);
269 sc->vd.init_screen = r128fb_init_screen;
270
271 /* init engine here */
272 r128fb_init(sc);
273
274 ri = &sc->sc_console_screen.scr_ri;
275
276 sc->sc_gc.gc_bitblt = r128fb_bitblt;
277 sc->sc_gc.gc_blitcookie = sc;
278 sc->sc_gc.gc_rop = R128_ROP3_S;
279 if (is_console) {
280 vcons_init_screen(&sc->vd, &sc->sc_console_screen, 1,
281 &defattr);
282 sc->sc_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC;
283
284 r128fb_rectfill(sc, 0, 0, sc->sc_width, sc->sc_height,
285 ri->ri_devcmap[(defattr >> 16) & 0xff]);
286 sc->sc_defaultscreen_descr.textops = &ri->ri_ops;
287 sc->sc_defaultscreen_descr.capabilities = ri->ri_caps;
288 sc->sc_defaultscreen_descr.nrows = ri->ri_rows;
289 sc->sc_defaultscreen_descr.ncols = ri->ri_cols;
290 glyphcache_init(&sc->sc_gc, sc->sc_height + 5,
291 sc->sc_width,
292 (0x800000 / sc->sc_stride) - sc->sc_height - 5,
293 ri->ri_font->fontwidth,
294 ri->ri_font->fontheight,
295 defattr);
296 wsdisplay_cnattach(&sc->sc_defaultscreen_descr, ri, 0, 0,
297 defattr);
298 vcons_replay_msgbuf(&sc->sc_console_screen);
299 } else {
300 /*
301 * since we're not the console we can postpone the rest
302 * until someone actually allocates a screen for us
303 */
304 (*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
305 glyphcache_init(&sc->sc_gc, sc->sc_height,
306 sc->sc_width,
307 (0x800000 / sc->sc_stride) - sc->sc_height,
308 ri->ri_font->fontwidth,
309 ri->ri_font->fontheight,
310 defattr);
311 }
312
313 j = 0;
314 rasops_get_cmap(ri, cmap, sizeof(cmap));
315 for (i = 0; i < 256; i++) {
316 sc->sc_cmap_red[i] = cmap[j];
317 sc->sc_cmap_green[i] = cmap[j + 1];
318 sc->sc_cmap_blue[i] = cmap[j + 2];
319 r128fb_putpalreg(sc, i, cmap[j], cmap[j + 1], cmap[j + 2]);
320 j += 3;
321 }
322
323 /* no suspend/resume support yet */
324 pmf_device_register(sc->sc_dev, NULL, NULL);
325
326 reg = bus_space_read_4(sc->sc_memt, sc->sc_regh, R128_LVDS_GEN_CNTL);
327 DPRINTF("R128_LVDS_GEN_CNTL: %08x\n", reg);
328 if (reg & R128_LVDS_ON) {
329 sc->sc_have_backlight = 1;
330 sc->sc_bl_on = 1;
331 sc->sc_bl_level = 255 -
332 ((reg & R128_LEVEL_MASK) >> R128_LEVEL_SHIFT);
333 pmf_event_register(sc->sc_dev, PMFE_DISPLAY_BRIGHTNESS_UP,
334 r128fb_brightness_up, TRUE);
335 pmf_event_register(sc->sc_dev, PMFE_DISPLAY_BRIGHTNESS_DOWN,
336 r128fb_brightness_down, TRUE);
337 aprint_verbose("%s: LVDS output is active, enabling backlight"
338 " control\n", device_xname(self));
339 } else
340 sc->sc_have_backlight = 0;
341
342 aa.console = is_console;
343 aa.scrdata = &sc->sc_screenlist;
344 aa.accessops = &r128fb_accessops;
345 aa.accesscookie = &sc->vd;
346
347 config_found(sc->sc_dev, &aa, wsemuldisplaydevprint);
348 }
349
350 static int
351 r128fb_ioctl(void *v, void *vs, u_long cmd, void *data, int flag,
352 struct lwp *l)
353 {
354 struct vcons_data *vd = v;
355 struct r128fb_softc *sc = vd->cookie;
356 struct wsdisplay_fbinfo *wdf;
357 struct vcons_screen *ms = vd->active;
358 struct wsdisplay_param *param;
359
360 switch (cmd) {
361 case WSDISPLAYIO_GTYPE:
362 *(u_int *)data = WSDISPLAY_TYPE_PCIMISC;
363 return 0;
364
365 /* PCI config read/write passthrough. */
366 case PCI_IOC_CFGREAD:
367 case PCI_IOC_CFGWRITE:
368 return pci_devioctl(sc->sc_pc, sc->sc_pcitag,
369 cmd, data, flag, l);
370
371 case WSDISPLAYIO_GET_BUSID:
372 return wsdisplayio_busid_pci(sc->sc_dev, sc->sc_pc, sc->sc_pcitag, data);
373
374 case WSDISPLAYIO_GINFO:
375 if (ms == NULL)
376 return ENODEV;
377 wdf = (void *)data;
378 wdf->height = ms->scr_ri.ri_height;
379 wdf->width = ms->scr_ri.ri_width;
380 wdf->depth = ms->scr_ri.ri_depth;
381 wdf->cmsize = 256;
382 return 0;
383
384 case WSDISPLAYIO_GETCMAP:
385 return r128fb_getcmap(sc,
386 (struct wsdisplay_cmap *)data);
387
388 case WSDISPLAYIO_PUTCMAP:
389 return r128fb_putcmap(sc,
390 (struct wsdisplay_cmap *)data);
391
392 case WSDISPLAYIO_LINEBYTES:
393 *(u_int *)data = sc->sc_stride;
394 return 0;
395
396 case WSDISPLAYIO_SMODE: {
397 int new_mode = *(int*)data;
398 if (new_mode != sc->sc_mode) {
399 sc->sc_mode = new_mode;
400 if(new_mode == WSDISPLAYIO_MODE_EMUL) {
401 r128fb_init(sc);
402 r128fb_restore_palette(sc);
403 glyphcache_wipe(&sc->sc_gc);
404 r128fb_rectfill(sc, 0, 0, sc->sc_width,
405 sc->sc_height, ms->scr_ri.ri_devcmap[
406 (ms->scr_defattr >> 16) & 0xff]);
407 vcons_redraw_screen(ms);
408 }
409 }
410 }
411 return 0;
412
413 case WSDISPLAYIO_GETPARAM:
414 param = (struct wsdisplay_param *)data;
415 if (sc->sc_have_backlight == 0)
416 return EPASSTHROUGH;
417 switch (param->param) {
418 case WSDISPLAYIO_PARAM_BRIGHTNESS:
419 param->min = 0;
420 param->max = 255;
421 param->curval = sc->sc_bl_level;
422 return 0;
423 case WSDISPLAYIO_PARAM_BACKLIGHT:
424 param->min = 0;
425 param->max = 1;
426 param->curval = sc->sc_bl_on;
427 return 0;
428 }
429 return EPASSTHROUGH;
430
431 case WSDISPLAYIO_SETPARAM:
432 param = (struct wsdisplay_param *)data;
433 if (sc->sc_have_backlight == 0)
434 return EPASSTHROUGH;
435 switch (param->param) {
436 case WSDISPLAYIO_PARAM_BRIGHTNESS:
437 r128fb_set_backlight(sc, param->curval);
438 return 0;
439 case WSDISPLAYIO_PARAM_BACKLIGHT:
440 r128fb_switch_backlight(sc, param->curval);
441 return 0;
442 }
443 return EPASSTHROUGH;
444 case WSDISPLAYIO_GET_EDID: {
445 struct wsdisplayio_edid_info *d = data;
446 return wsdisplayio_get_edid(sc->sc_dev, d);
447 }
448 }
449 return EPASSTHROUGH;
450 }
451
452 static paddr_t
453 r128fb_mmap(void *v, void *vs, off_t offset, int prot)
454 {
455 struct vcons_data *vd = v;
456 struct r128fb_softc *sc = vd->cookie;
457 paddr_t pa;
458
459 /* 'regular' framebuffer mmap()ing */
460 if (offset < sc->sc_fbsize) {
461 pa = bus_space_mmap(sc->sc_memt, sc->sc_fb + offset, 0, prot,
462 BUS_SPACE_MAP_LINEAR);
463 return pa;
464 }
465
466 /*
467 * restrict all other mappings to processes with superuser privileges
468 * or the kernel itself
469 */
470 if (kauth_authorize_machdep(kauth_cred_get(), KAUTH_MACHDEP_UNMANAGEDMEM,
471 NULL, NULL, NULL, NULL) != 0) {
472 aprint_normal("%s: mmap() rejected.\n",
473 device_xname(sc->sc_dev));
474 return -1;
475 }
476
477 if ((offset >= sc->sc_fb) && (offset < (sc->sc_fb + sc->sc_fbsize))) {
478 pa = bus_space_mmap(sc->sc_memt, offset, 0, prot,
479 BUS_SPACE_MAP_LINEAR);
480 return pa;
481 }
482
483 if ((offset >= sc->sc_reg) &&
484 (offset < (sc->sc_reg + sc->sc_regsize))) {
485 pa = bus_space_mmap(sc->sc_memt, offset, 0, prot,
486 BUS_SPACE_MAP_LINEAR);
487 return pa;
488 }
489
490 #ifdef PCI_MAGIC_IO_RANGE
491 /* allow mapping of IO space */
492 if ((offset >= PCI_MAGIC_IO_RANGE) &&
493 (offset < PCI_MAGIC_IO_RANGE + 0x10000)) {
494 pa = bus_space_mmap(sc->sc_iot, offset - PCI_MAGIC_IO_RANGE,
495 0, prot, BUS_SPACE_MAP_LINEAR);
496 return pa;
497 }
498 #endif
499
500 #ifdef OFB_ALLOW_OTHERS
501 if (offset >= 0x80000000) {
502 pa = bus_space_mmap(sc->sc_memt, offset, 0, prot,
503 BUS_SPACE_MAP_LINEAR);
504 return pa;
505 }
506 #endif
507 return -1;
508 }
509
510 static void
511 r128fb_init_screen(void *cookie, struct vcons_screen *scr,
512 int existing, long *defattr)
513 {
514 struct r128fb_softc *sc = cookie;
515 struct rasops_info *ri = &scr->scr_ri;
516
517 ri->ri_depth = sc->sc_depth;
518 ri->ri_width = sc->sc_width;
519 ri->ri_height = sc->sc_height;
520 ri->ri_stride = sc->sc_stride;
521 ri->ri_flg = RI_CENTER;
522 if (sc->sc_depth == 8)
523 ri->ri_flg |= RI_8BIT_IS_RGB | RI_ENABLE_ALPHA;
524
525 rasops_init(ri, 0, 0);
526 ri->ri_caps = WSSCREEN_WSCOLORS;
527 #ifdef VCONS_DRAW_INTR
528 scr->scr_flags |= VCONS_DONT_READ;
529 #endif
530
531 rasops_reconfig(ri, sc->sc_height / ri->ri_font->fontheight,
532 sc->sc_width / ri->ri_font->fontwidth);
533
534 ri->ri_hw = scr;
535 ri->ri_ops.copyrows = r128fb_copyrows;
536 ri->ri_ops.copycols = r128fb_copycols;
537 ri->ri_ops.eraserows = r128fb_eraserows;
538 ri->ri_ops.erasecols = r128fb_erasecols;
539 ri->ri_ops.cursor = r128fb_cursor;
540 if (FONT_IS_ALPHA(ri->ri_font)) {
541 ri->ri_ops.putchar = r128fb_putchar_aa;
542 ri->ri_ops.allocattr(ri, WS_DEFAULT_FG, WS_DEFAULT_BG,
543 0, &sc->sc_gc.gc_attr);
544 } else
545 ri->ri_ops.putchar = r128fb_putchar;
546 }
547
548 static int
549 r128fb_putcmap(struct r128fb_softc *sc, struct wsdisplay_cmap *cm)
550 {
551 u_char *r, *g, *b;
552 u_int index = cm->index;
553 u_int count = cm->count;
554 int i, error;
555 u_char rbuf[256], gbuf[256], bbuf[256];
556
557 #ifdef R128FB_DEBUG
558 aprint_debug("putcmap: %d %d\n",index, count);
559 #endif
560 if (cm->index >= 256 || cm->count > 256 ||
561 (cm->index + cm->count) > 256)
562 return EINVAL;
563 error = copyin(cm->red, &rbuf[index], count);
564 if (error)
565 return error;
566 error = copyin(cm->green, &gbuf[index], count);
567 if (error)
568 return error;
569 error = copyin(cm->blue, &bbuf[index], count);
570 if (error)
571 return error;
572
573 memcpy(&sc->sc_cmap_red[index], &rbuf[index], count);
574 memcpy(&sc->sc_cmap_green[index], &gbuf[index], count);
575 memcpy(&sc->sc_cmap_blue[index], &bbuf[index], count);
576
577 r = &sc->sc_cmap_red[index];
578 g = &sc->sc_cmap_green[index];
579 b = &sc->sc_cmap_blue[index];
580
581 for (i = 0; i < count; i++) {
582 r128fb_putpalreg(sc, index, *r, *g, *b);
583 index++;
584 r++, g++, b++;
585 }
586 return 0;
587 }
588
589 static int
590 r128fb_getcmap(struct r128fb_softc *sc, struct wsdisplay_cmap *cm)
591 {
592 u_int index = cm->index;
593 u_int count = cm->count;
594 int error;
595
596 if (index >= 255 || count > 256 || index + count > 256)
597 return EINVAL;
598
599 error = copyout(&sc->sc_cmap_red[index], cm->red, count);
600 if (error)
601 return error;
602 error = copyout(&sc->sc_cmap_green[index], cm->green, count);
603 if (error)
604 return error;
605 error = copyout(&sc->sc_cmap_blue[index], cm->blue, count);
606 if (error)
607 return error;
608
609 return 0;
610 }
611
612 static void
613 r128fb_restore_palette(struct r128fb_softc *sc)
614 {
615 int i;
616
617 for (i = 0; i < (1 << sc->sc_depth); i++) {
618 r128fb_putpalreg(sc, i, sc->sc_cmap_red[i],
619 sc->sc_cmap_green[i], sc->sc_cmap_blue[i]);
620 }
621 }
622
623 static int
624 r128fb_putpalreg(struct r128fb_softc *sc, uint8_t idx, uint8_t r, uint8_t g,
625 uint8_t b)
626 {
627 uint32_t reg;
628
629 /* whack the DAC */
630 reg = (r << 16) | (g << 8) | b;
631 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_PALETTE_INDEX, idx);
632 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_PALETTE_DATA, reg);
633 return 0;
634 }
635
636 static void
637 r128fb_init(struct r128fb_softc *sc)
638 {
639 uint32_t datatype, d, reg;
640
641 r128fb_flush_engine(sc);
642
643 r128fb_wait(sc, 9);
644 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_CRTC_OFFSET, 0);
645 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_DEFAULT_OFFSET, 0);
646 /* pitch is in units of 8 pixels */
647 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_DEFAULT_PITCH,
648 sc->sc_width >> 3);
649 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_AUX_SC_CNTL, 0);
650 bus_space_write_4(sc->sc_memt, sc->sc_regh,
651 R128_DEFAULT_SC_BOTTOM_RIGHT,
652 R128_DEFAULT_SC_RIGHT_MAX | R128_DEFAULT_SC_BOTTOM_MAX);
653 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_SC_TOP_LEFT, 0);
654 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_SC_BOTTOM_RIGHT,
655 R128_DEFAULT_SC_RIGHT_MAX | R128_DEFAULT_SC_BOTTOM_MAX);
656 bus_space_write_4(sc->sc_memt, sc->sc_regh,
657 R128_DEFAULT_SC_BOTTOM_RIGHT,
658 R128_DEFAULT_SC_RIGHT_MAX | R128_DEFAULT_SC_BOTTOM_MAX);
659
660 #if 0
661 #if BYTE_ORDER == BIG_ENDIAN
662 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_DP_DATATYPE,
663 R128_HOST_BIG_ENDIAN_EN);
664 #else
665 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_DP_DATATYPE, 0);
666 #endif
667 #endif
668 r128fb_wait(sc, 7);
669 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_SRC_PITCH,
670 sc->sc_width >> 3);
671 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_DST_PITCH,
672 sc->sc_width >> 3);
673 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_SRC_OFFSET, 0);
674 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_DST_OFFSET, 0);
675 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_DP_WRITE_MASK,
676 0xffffffff);
677
678 switch (sc->sc_depth) {
679 case 8:
680 datatype = R128_GMC_DST_8BPP_CI;
681 d = R128_CRTC_COLOR_8BIT;
682 break;
683 case 15:
684 datatype = R128_GMC_DST_15BPP;
685 d = R128_CRTC_COLOR_15BIT;
686 break;
687 case 16:
688 datatype = R128_GMC_DST_16BPP;
689 d = R128_CRTC_COLOR_16BIT;
690 break;
691 case 24:
692 datatype = R128_GMC_DST_24BPP;
693 d = R128_CRTC_COLOR_24BIT;
694 break;
695 case 32:
696 datatype = R128_GMC_DST_32BPP;
697 d = R128_CRTC_COLOR_32BIT;
698 break;
699 default:
700 aprint_error("%s: unsupported depth %d\n",
701 device_xname(sc->sc_dev), sc->sc_depth);
702 return;
703 }
704 sc->sc_master_cntl = R128_GMC_CLR_CMP_CNTL_DIS |
705 R128_GMC_AUX_CLIP_DIS | datatype;
706 reg = bus_space_read_4(sc->sc_memt, sc->sc_regh, R128_CRTC_GEN_CNTL);
707 DPRINTF("depth: %d\n", reg & R128_CRTC_PIX_WIDTH);
708 reg &= ~R128_CRTC_PIX_WIDTH;
709 reg |= d;
710 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_CRTC_GEN_CNTL, reg);
711 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_CRTC_PITCH, sc->sc_width >> 3);
712 r128fb_flush_engine(sc);
713 }
714
715 static void
716 r128fb_rectfill(struct r128fb_softc *sc, int x, int y, int wi, int he,
717 uint32_t colour)
718 {
719
720 r128fb_wait(sc, 5);
721 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_DP_GUI_MASTER_CNTL,
722 R128_GMC_BRUSH_SOLID_COLOR |
723 R128_GMC_SRC_DATATYPE_COLOR |
724 R128_ROP3_P |
725 sc->sc_master_cntl);
726
727 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_DP_BRUSH_FRGD_CLR,
728 colour);
729 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_DP_CNTL,
730 R128_DST_X_LEFT_TO_RIGHT | R128_DST_Y_TOP_TO_BOTTOM);
731 /* now feed it coordinates */
732 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_DST_X_Y,
733 (x << 16) | y);
734 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_DST_WIDTH_HEIGHT,
735 (wi << 16) | he);
736 }
737
738 static void
739 r128fb_bitblt(void *cookie, int xs, int ys, int xd, int yd,
740 int wi, int he, int rop)
741 {
742 struct r128fb_softc *sc = cookie;
743 uint32_t dp_cntl = 0;
744
745 r128fb_wait(sc, 5);
746 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_DP_GUI_MASTER_CNTL,
747 R128_GMC_BRUSH_SOLID_COLOR |
748 R128_GMC_SRC_DATATYPE_COLOR |
749 rop |
750 R128_DP_SRC_SOURCE_MEMORY |
751 sc->sc_master_cntl);
752
753 if (yd <= ys) {
754 dp_cntl = R128_DST_Y_TOP_TO_BOTTOM;
755 } else {
756 ys += he - 1;
757 yd += he - 1;
758 }
759 if (xd <= xs) {
760 dp_cntl |= R128_DST_X_LEFT_TO_RIGHT;
761 } else {
762 xs += wi - 1;
763 xd += wi - 1;
764 }
765 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_DP_CNTL, dp_cntl);
766
767 /* now feed it coordinates */
768 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_SRC_X_Y,
769 (xs << 16) | ys);
770 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_DST_X_Y,
771 (xd << 16) | yd);
772 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_DST_WIDTH_HEIGHT,
773 (wi << 16) | he);
774 }
775
776 static void
777 r128fb_cursor(void *cookie, int on, int row, int col)
778 {
779 struct rasops_info *ri = cookie;
780 struct vcons_screen *scr = ri->ri_hw;
781 struct r128fb_softc *sc = scr->scr_cookie;
782 int x, y, wi, he;
783
784 wi = ri->ri_font->fontwidth;
785 he = ri->ri_font->fontheight;
786
787 if (sc->sc_mode == WSDISPLAYIO_MODE_EMUL) {
788 x = ri->ri_ccol * wi + ri->ri_xorigin;
789 y = ri->ri_crow * he + ri->ri_yorigin;
790 if (ri->ri_flg & RI_CURSOR) {
791 r128fb_bitblt(sc, x, y, x, y, wi, he, R128_ROP3_Dn);
792 ri->ri_flg &= ~RI_CURSOR;
793 }
794 ri->ri_crow = row;
795 ri->ri_ccol = col;
796 if (on) {
797 x = ri->ri_ccol * wi + ri->ri_xorigin;
798 y = ri->ri_crow * he + ri->ri_yorigin;
799 r128fb_bitblt(sc, x, y, x, y, wi, he, R128_ROP3_Dn);
800 ri->ri_flg |= RI_CURSOR;
801 }
802 } else {
803 scr->scr_ri.ri_crow = row;
804 scr->scr_ri.ri_ccol = col;
805 scr->scr_ri.ri_flg &= ~RI_CURSOR;
806 }
807
808 }
809
810 static void
811 r128fb_putchar(void *cookie, int row, int col, u_int c, long attr)
812 {
813 struct rasops_info *ri = cookie;
814 struct wsdisplay_font *font = PICK_FONT(ri, c);
815 struct vcons_screen *scr = ri->ri_hw;
816 struct r128fb_softc *sc = scr->scr_cookie;
817 void *data;
818 uint32_t fg, bg;
819 int i, x, y, wi, he, offset;
820
821 if (sc->sc_mode != WSDISPLAYIO_MODE_EMUL)
822 return;
823
824 if (!CHAR_IN_FONT(c, font))
825 return;
826
827 wi = font->fontwidth;
828 he = font->fontheight;
829
830 bg = ri->ri_devcmap[(attr >> 16) & 0xf];
831 fg = ri->ri_devcmap[(attr >> 24) & 0xf];
832 x = ri->ri_xorigin + col * wi;
833 y = ri->ri_yorigin + row * he;
834
835 if (c == 0x20) {
836 r128fb_rectfill(sc, x, y, wi, he, bg);
837 return;
838 }
839
840 data = WSFONT_GLYPH(c, font);
841
842 r128fb_wait(sc, 8);
843
844 bus_space_write_4(sc->sc_memt, sc->sc_regh,
845 R128_DP_GUI_MASTER_CNTL,
846 R128_GMC_BRUSH_SOLID_COLOR |
847 R128_GMC_SRC_DATATYPE_MONO_FG_BG |
848 R128_ROP3_S |
849 R128_DP_SRC_SOURCE_HOST_DATA |
850 R128_GMC_DST_CLIPPING |
851 sc->sc_master_cntl);
852
853 bus_space_write_4(sc->sc_memt, sc->sc_regh,
854 R128_DP_CNTL,
855 R128_DST_Y_TOP_TO_BOTTOM |
856 R128_DST_X_LEFT_TO_RIGHT);
857
858 bus_space_write_4(sc->sc_memt, sc->sc_regh,
859 R128_DP_SRC_FRGD_CLR, fg);
860 bus_space_write_4(sc->sc_memt, sc->sc_regh,
861 R128_DP_SRC_BKGD_CLR, bg);
862
863 /*
864 * The Rage 128 doesn't have anything to skip pixels
865 * when colour expanding but all coordinates
866 * are signed so we just clip the leading bytes and
867 * trailing bits away
868 */
869 bus_space_write_4(sc->sc_memt, sc->sc_regh,
870 R128_SC_RIGHT, x + wi - 1);
871 bus_space_write_4(sc->sc_memt, sc->sc_regh,
872 R128_SC_LEFT, x);
873
874 /* needed? */
875 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_SRC_X_Y, 0);
876
877 offset = 32 - (font->stride << 3);
878 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_DST_X_Y,
879 ((x - offset) << 16) | y);
880 bus_space_write_4(sc->sc_memt, sc->sc_regh,
881 R128_DST_WIDTH_HEIGHT, (32 << 16) | he);
882
883 r128fb_wait(sc, he);
884 switch (font->stride) {
885 case 1: {
886 uint8_t *data8 = data;
887 uint32_t reg;
888 for (i = 0; i < he; i++) {
889 reg = *data8;
890 bus_space_write_stream_4(sc->sc_memt,
891 sc->sc_regh, R128_HOST_DATA0, reg);
892 data8++;
893 }
894 break;
895 }
896 case 2: {
897 uint16_t *data16 = data;
898 uint32_t reg;
899 for (i = 0; i < he; i++) {
900 reg = *data16;
901 bus_space_write_stream_4(sc->sc_memt,
902 sc->sc_regh, R128_HOST_DATA0, reg);
903 data16++;
904 }
905 break;
906 }
907 }
908 }
909
910 static void
911 r128fb_putchar_aa(void *cookie, int row, int col, u_int c, long attr)
912 {
913 struct rasops_info *ri = cookie;
914 struct wsdisplay_font *font = PICK_FONT(ri, c);
915 struct vcons_screen *scr = ri->ri_hw;
916 struct r128fb_softc *sc = scr->scr_cookie;
917 uint32_t bg, latch = 0, bg8, fg8, pixel;
918 int i, x, y, wi, he, r, g, b, aval;
919 int r1, g1, b1, r0, g0, b0, fgo, bgo;
920 uint8_t *data8;
921 int rv, cnt = 0;
922
923 if (sc->sc_mode != WSDISPLAYIO_MODE_EMUL)
924 return;
925
926 if (!CHAR_IN_FONT(c, font))
927 return;
928
929 wi = font->fontwidth;
930 he = font->fontheight;
931
932 bg = ri->ri_devcmap[(attr >> 16) & 0xf];
933 x = ri->ri_xorigin + col * wi;
934 y = ri->ri_yorigin + row * he;
935 if (c == 0x20) {
936 r128fb_rectfill(sc, x, y, wi, he, bg);
937 return;
938 }
939
940 rv = glyphcache_try(&sc->sc_gc, c, x, y, attr);
941 if (rv == GC_OK)
942 return;
943
944 data8 = WSFONT_GLYPH(c, font);
945
946 r128fb_wait(sc, 5);
947 bus_space_write_4(sc->sc_memt, sc->sc_regh,
948 R128_DP_GUI_MASTER_CNTL,
949 R128_GMC_BRUSH_SOLID_COLOR |
950 R128_GMC_SRC_DATATYPE_COLOR |
951 R128_ROP3_S |
952 R128_DP_SRC_SOURCE_HOST_DATA |
953 sc->sc_master_cntl);
954
955 bus_space_write_4(sc->sc_memt, sc->sc_regh,
956 R128_DP_CNTL,
957 R128_DST_Y_TOP_TO_BOTTOM |
958 R128_DST_X_LEFT_TO_RIGHT);
959
960 /* needed? */
961 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_SRC_X_Y, 0);
962 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_DST_X_Y,
963 (x << 16) | y);
964 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_DST_WIDTH_HEIGHT,
965 (wi << 16) | he);
966
967 /*
968 * we need the RGB colours here, so get offsets into rasops_cmap
969 */
970 fgo = ((attr >> 24) & 0xf) * 3;
971 bgo = ((attr >> 16) & 0xf) * 3;
972
973 r0 = rasops_cmap[bgo];
974 r1 = rasops_cmap[fgo];
975 g0 = rasops_cmap[bgo + 1];
976 g1 = rasops_cmap[fgo + 1];
977 b0 = rasops_cmap[bgo + 2];
978 b1 = rasops_cmap[fgo + 2];
979 #define R3G3B2(r, g, b) ((r & 0xe0) | ((g >> 3) & 0x1c) | (b >> 6))
980 bg8 = R3G3B2(r0, g0, b0);
981 fg8 = R3G3B2(r1, g1, b1);
982
983 r128fb_wait(sc, 16);
984
985 for (i = 0; i < ri->ri_fontscale; i++) {
986 aval = *data8;
987 if (aval == 0) {
988 pixel = bg8;
989 } else if (aval == 255) {
990 pixel = fg8;
991 } else {
992 r = aval * r1 + (255 - aval) * r0;
993 g = aval * g1 + (255 - aval) * g0;
994 b = aval * b1 + (255 - aval) * b0;
995 pixel = ((r & 0xe000) >> 8) |
996 ((g & 0xe000) >> 11) |
997 ((b & 0xc000) >> 14);
998 }
999 latch = (latch << 8) | pixel;
1000 /* write in 32bit chunks */
1001 if ((i & 3) == 3) {
1002 bus_space_write_stream_4(sc->sc_memt, sc->sc_regh,
1003 R128_HOST_DATA0, latch);
1004 /*
1005 * not strictly necessary, old data should be shifted
1006 * out
1007 */
1008 latch = 0;
1009 cnt++;
1010 if (cnt > 15) {
1011 r128fb_wait(sc, 16);
1012 cnt = 0;
1013 }
1014 }
1015 data8++;
1016 }
1017 /* if we have pixels left in latch write them out */
1018 if ((i & 3) != 0) {
1019 latch = latch << ((4 - (i & 3)) << 3);
1020 bus_space_write_stream_4(sc->sc_memt, sc->sc_regh,
1021 R128_HOST_DATA0, latch);
1022 }
1023 if (rv == GC_ADD) {
1024 glyphcache_add(&sc->sc_gc, c, x, y);
1025 }
1026 }
1027
1028 static void
1029 r128fb_copycols(void *cookie, int row, int srccol, int dstcol, int ncols)
1030 {
1031 struct rasops_info *ri = cookie;
1032 struct vcons_screen *scr = ri->ri_hw;
1033 struct r128fb_softc *sc = scr->scr_cookie;
1034 int32_t xs, xd, y, width, height;
1035
1036 if ((sc->sc_locked == 0) && (sc->sc_mode == WSDISPLAYIO_MODE_EMUL)) {
1037 xs = ri->ri_xorigin + ri->ri_font->fontwidth * srccol;
1038 xd = ri->ri_xorigin + ri->ri_font->fontwidth * dstcol;
1039 y = ri->ri_yorigin + ri->ri_font->fontheight * row;
1040 width = ri->ri_font->fontwidth * ncols;
1041 height = ri->ri_font->fontheight;
1042 r128fb_bitblt(sc, xs, y, xd, y, width, height, R128_ROP3_S);
1043 }
1044 }
1045
1046 static void
1047 r128fb_erasecols(void *cookie, int row, int startcol, int ncols, long fillattr)
1048 {
1049 struct rasops_info *ri = cookie;
1050 struct vcons_screen *scr = ri->ri_hw;
1051 struct r128fb_softc *sc = scr->scr_cookie;
1052 int32_t x, y, width, height, fg, bg, ul;
1053
1054 if ((sc->sc_locked == 0) && (sc->sc_mode == WSDISPLAYIO_MODE_EMUL)) {
1055 x = ri->ri_xorigin + ri->ri_font->fontwidth * startcol;
1056 y = ri->ri_yorigin + ri->ri_font->fontheight * row;
1057 width = ri->ri_font->fontwidth * ncols;
1058 height = ri->ri_font->fontheight;
1059 rasops_unpack_attr(fillattr, &fg, &bg, &ul);
1060
1061 r128fb_rectfill(sc, x, y, width, height, ri->ri_devcmap[bg]);
1062 }
1063 }
1064
1065 static void
1066 r128fb_copyrows(void *cookie, int srcrow, int dstrow, int nrows)
1067 {
1068 struct rasops_info *ri = cookie;
1069 struct vcons_screen *scr = ri->ri_hw;
1070 struct r128fb_softc *sc = scr->scr_cookie;
1071 int32_t x, ys, yd, width, height;
1072
1073 if ((sc->sc_locked == 0) && (sc->sc_mode == WSDISPLAYIO_MODE_EMUL)) {
1074 x = ri->ri_xorigin;
1075 ys = ri->ri_yorigin + ri->ri_font->fontheight * srcrow;
1076 yd = ri->ri_yorigin + ri->ri_font->fontheight * dstrow;
1077 width = ri->ri_emuwidth;
1078 height = ri->ri_font->fontheight * nrows;
1079 r128fb_bitblt(sc, x, ys, x, yd, width, height, R128_ROP3_S);
1080 }
1081 }
1082
1083 static void
1084 r128fb_eraserows(void *cookie, int row, int nrows, long fillattr)
1085 {
1086 struct rasops_info *ri = cookie;
1087 struct vcons_screen *scr = ri->ri_hw;
1088 struct r128fb_softc *sc = scr->scr_cookie;
1089 int32_t x, y, width, height, fg, bg, ul;
1090
1091 if ((sc->sc_locked == 0) && (sc->sc_mode == WSDISPLAYIO_MODE_EMUL)) {
1092 x = ri->ri_xorigin;
1093 y = ri->ri_yorigin + ri->ri_font->fontheight * row;
1094 width = ri->ri_emuwidth;
1095 height = ri->ri_font->fontheight * nrows;
1096 rasops_unpack_attr(fillattr, &fg, &bg, &ul);
1097
1098 r128fb_rectfill(sc, x, y, width, height, ri->ri_devcmap[bg]);
1099 }
1100 }
1101
1102 static void
1103 r128fb_set_backlight(struct r128fb_softc *sc, int level)
1104 {
1105 uint32_t reg;
1106
1107 /*
1108 * should we do nothing when backlight is off, should we just store the
1109 * level and use it when turning back on or should we just flip sc_bl_on
1110 * and turn the backlight on?
1111 * For now turn it on so a crashed screensaver can't get the user stuck
1112 * with a dark screen as long as hotkeys work
1113 */
1114 if (level > 255) level = 255;
1115 if (level < 0) level = 0;
1116 if (level == sc->sc_bl_level)
1117 return;
1118 sc->sc_bl_level = level;
1119 if (sc->sc_bl_on == 0)
1120 sc->sc_bl_on = 1;
1121 level = 255 - level;
1122 reg = bus_space_read_4(sc->sc_memt, sc->sc_regh, R128_LVDS_GEN_CNTL);
1123 reg &= ~R128_LEVEL_MASK;
1124 reg |= (level << R128_LEVEL_SHIFT);
1125 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_LVDS_GEN_CNTL, reg);
1126 DPRINTF("backlight level: %d reg %08x\n", level, reg);
1127 }
1128
1129 static void
1130 r128fb_switch_backlight(struct r128fb_softc *sc, int on)
1131 {
1132 uint32_t reg;
1133 int level;
1134
1135 if (on == sc->sc_bl_on)
1136 return;
1137 sc->sc_bl_on = on;
1138 reg = bus_space_read_4(sc->sc_memt, sc->sc_regh, R128_LVDS_GEN_CNTL);
1139 reg &= ~R128_LEVEL_MASK;
1140 level = on ? 255 - sc->sc_bl_level : 255;
1141 reg |= level << R128_LEVEL_SHIFT;
1142 bus_space_write_4(sc->sc_memt, sc->sc_regh, R128_LVDS_GEN_CNTL, reg);
1143 DPRINTF("backlight state: %d reg %08x\n", on, reg);
1144 }
1145
1146
1147 static void
1148 r128fb_brightness_up(device_t dev)
1149 {
1150 struct r128fb_softc *sc = device_private(dev);
1151
1152 r128fb_set_backlight(sc, sc->sc_bl_level + 8);
1153 }
1154
1155 static void
1156 r128fb_brightness_down(device_t dev)
1157 {
1158 struct r128fb_softc *sc = device_private(dev);
1159
1160 r128fb_set_backlight(sc, sc->sc_bl_level - 8);
1161 }
1162