genfb.c revision 1.34 1 /* $NetBSD: genfb.c,v 1.34 2011/02/08 10:52:56 jmcneill 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 NETBSD FOUNDATION, INC. AND CONTRIBUTORS
17 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
18 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
19 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
20 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
23 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
24 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
25 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
26 * POSSIBILITY OF SUCH DAMAGE.
27 */
28
29 #include <sys/cdefs.h>
30 __KERNEL_RCSID(0, "$NetBSD: genfb.c,v 1.34 2011/02/08 10:52:56 jmcneill Exp $");
31
32 #include <sys/param.h>
33 #include <sys/systm.h>
34 #include <sys/kernel.h>
35 #include <sys/device.h>
36 #include <sys/proc.h>
37 #include <sys/mutex.h>
38 #include <sys/ioctl.h>
39 #include <sys/kernel.h>
40 #include <sys/systm.h>
41 #include <sys/kmem.h>
42
43 #include <dev/wscons/wsconsio.h>
44 #include <dev/wscons/wsdisplayvar.h>
45 #include <dev/rasops/rasops.h>
46 #include <dev/wsfont/wsfont.h>
47
48 #include <dev/wscons/wsdisplay_vconsvar.h>
49
50 #include <dev/wsfb/genfbvar.h>
51
52 #ifdef GENFB_DISABLE_TEXT
53 #include <sys/reboot.h>
54 #define DISABLESPLASH (boothowto & (RB_SINGLE | RB_USERCONF | RB_ASKNAME | \
55 AB_VERBOSE | AB_DEBUG) )
56 #endif
57
58 #include "opt_genfb.h"
59 #include "opt_wsfb.h"
60
61 #ifdef GENFB_DEBUG
62 #define GPRINTF panic
63 #else
64 #define GPRINTF aprint_verbose
65 #endif
66
67 static int genfb_ioctl(void *, void *, u_long, void *, int, struct lwp *);
68 static paddr_t genfb_mmap(void *, void *, off_t, int);
69 static void genfb_init_screen(void *, struct vcons_screen *, int, long *);
70
71 static int genfb_putcmap(struct genfb_softc *, struct wsdisplay_cmap *);
72 static int genfb_getcmap(struct genfb_softc *, struct wsdisplay_cmap *);
73 static int genfb_putpalreg(struct genfb_softc *, uint8_t, uint8_t,
74 uint8_t, uint8_t);
75
76 static void genfb_brightness_up(device_t);
77 static void genfb_brightness_down(device_t);
78 /* set backlight level */
79 static void genfb_set_backlight(struct genfb_softc *, int);
80 /* turn backlight on and off without messing with the level */
81 static void genfb_switch_backlight(struct genfb_softc *, int);
82
83 extern const u_char rasops_cmap[768];
84
85 static int genfb_cnattach_called = 0;
86 static int genfb_enabled = 1;
87
88 struct wsdisplay_accessops genfb_accessops = {
89 genfb_ioctl,
90 genfb_mmap,
91 NULL, /* alloc_screen */
92 NULL, /* free_screen */
93 NULL, /* show_screen */
94 NULL, /* load_font */
95 NULL, /* pollc */
96 NULL /* scroll */
97 };
98
99 static struct genfb_softc *genfb_softc = NULL;
100
101 void
102 genfb_init(struct genfb_softc *sc)
103 {
104 prop_dictionary_t dict;
105 uint64_t cmap_cb, pmf_cb, mode_cb, bl_cb;
106 uint32_t fboffset;
107 bool console;
108
109 dict = device_properties(sc->sc_dev);
110 #ifdef GENFB_DEBUG
111 printf(prop_dictionary_externalize(dict));
112 #endif
113 prop_dictionary_get_bool(dict, "is_console", &console);
114
115 if (!prop_dictionary_get_uint32(dict, "width", &sc->sc_width)) {
116 GPRINTF("no width property\n");
117 return;
118 }
119 if (!prop_dictionary_get_uint32(dict, "height", &sc->sc_height)) {
120 GPRINTF("no height property\n");
121 return;
122 }
123 if (!prop_dictionary_get_uint32(dict, "depth", &sc->sc_depth)) {
124 GPRINTF("no depth property\n");
125 return;
126 }
127
128 /* XXX should be a 64bit value */
129 if (!prop_dictionary_get_uint32(dict, "address", &fboffset)) {
130 GPRINTF("no address property\n");
131 return;
132 }
133
134 sc->sc_fboffset = fboffset;
135
136 if (!prop_dictionary_get_uint32(dict, "linebytes", &sc->sc_stride))
137 sc->sc_stride = (sc->sc_width * sc->sc_depth) >> 3;
138
139 /*
140 * deal with a bug in the Raptor firmware which always sets
141 * stride = width even when depth != 8
142 */
143 if (sc->sc_stride < sc->sc_width * (sc->sc_depth >> 3))
144 sc->sc_stride = sc->sc_width * (sc->sc_depth >> 3);
145
146 sc->sc_fbsize = sc->sc_height * sc->sc_stride;
147
148 /* optional colour map callback */
149 sc->sc_cmcb = NULL;
150 if (prop_dictionary_get_uint64(dict, "cmap_callback", &cmap_cb)) {
151 if (cmap_cb != 0)
152 sc->sc_cmcb = (void *)(vaddr_t)cmap_cb;
153 }
154
155 /* optional pmf callback */
156 sc->sc_pmfcb = NULL;
157 if (prop_dictionary_get_uint64(dict, "pmf_callback", &pmf_cb)) {
158 if (pmf_cb != 0)
159 sc->sc_pmfcb = (void *)(vaddr_t)pmf_cb;
160 }
161
162 /* optional mode callback */
163 sc->sc_modecb = NULL;
164 if (prop_dictionary_get_uint64(dict, "mode_callback", &mode_cb)) {
165 if (mode_cb != 0)
166 sc->sc_modecb = (void *)(vaddr_t)mode_cb;
167 }
168
169 /* optional backlight control callback */
170 sc->sc_backlight = NULL;
171 if (prop_dictionary_get_uint64(dict, "backlight_callback", &bl_cb)) {
172 if (bl_cb != 0) {
173 sc->sc_backlight = (void *)(vaddr_t)bl_cb;
174 sc->sc_backlight_on = 1;
175 aprint_naive_dev(sc->sc_dev,
176 "enabling backlight control\n");
177 sc->sc_backlight_level =
178 sc->sc_backlight->gpc_get_parameter(
179 sc->sc_backlight->gpc_cookie);
180 if (console) {
181 pmf_event_register(sc->sc_dev,
182 PMFE_DISPLAY_BRIGHTNESS_UP,
183 genfb_brightness_up, TRUE);
184 pmf_event_register(sc->sc_dev,
185 PMFE_DISPLAY_BRIGHTNESS_DOWN,
186 genfb_brightness_down, TRUE);
187 }
188 }
189 }
190 }
191
192 int
193 genfb_attach(struct genfb_softc *sc, struct genfb_ops *ops)
194 {
195 struct wsemuldisplaydev_attach_args aa;
196 prop_dictionary_t dict;
197 struct rasops_info *ri;
198 uint16_t crow;
199 long defattr;
200 int i, j;
201 bool console;
202 #ifdef SPLASHSCREEN
203 int error = ENXIO;
204 #endif
205
206 dict = device_properties(sc->sc_dev);
207 prop_dictionary_get_bool(dict, "is_console", &console);
208
209 if (prop_dictionary_get_uint16(dict, "cursor-row", &crow) == false)
210 crow = 0;
211 if (prop_dictionary_get_bool(dict, "clear-screen", &sc->sc_want_clear)
212 == false)
213 sc->sc_want_clear = true;
214
215 /* do not attach when we're not console */
216 if (!console) {
217 aprint_normal_dev(sc->sc_dev, "no console, unable to continue\n");
218 return -1;
219 }
220
221 aprint_verbose_dev(sc->sc_dev, "framebuffer at %p, size %dx%d, depth %d, "
222 "stride %d\n",
223 sc->sc_fboffset ? (void *)(intptr_t)sc->sc_fboffset : sc->sc_fbaddr,
224 sc->sc_width, sc->sc_height, sc->sc_depth, sc->sc_stride);
225
226 sc->sc_defaultscreen_descr = (struct wsscreen_descr){
227 "default",
228 0, 0,
229 NULL,
230 8, 16,
231 WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
232 NULL
233 };
234 sc->sc_screens[0] = &sc->sc_defaultscreen_descr;
235 sc->sc_screenlist = (struct wsscreen_list){1, sc->sc_screens};
236 memcpy(&sc->sc_ops, ops, sizeof(struct genfb_ops));
237 sc->sc_mode = WSDISPLAYIO_MODE_EMUL;
238 if (sc->sc_modecb->gmc_setmode)
239 sc->sc_modecb->gmc_setmode(sc, sc->sc_mode);
240
241 #ifdef GENFB_SHADOWFB
242 sc->sc_shadowfb = kmem_alloc(sc->sc_fbsize, KM_SLEEP);
243 if (sc->sc_want_clear == false && sc->sc_shadowfb != NULL)
244 memcpy(sc->sc_shadowfb, sc->sc_fbaddr, sc->sc_fbsize);
245 #endif
246
247 vcons_init(&sc->vd, sc, &sc->sc_defaultscreen_descr,
248 &genfb_accessops);
249 sc->vd.init_screen = genfb_init_screen;
250
251 /* Do not print anything between this point and the screen
252 * clear operation below. Otherwise it will be lost. */
253
254 ri = &sc->sc_console_screen.scr_ri;
255
256 vcons_init_screen(&sc->vd, &sc->sc_console_screen, 1,
257 &defattr);
258 sc->sc_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC;
259
260 #ifdef SPLASHSCREEN
261 /*
262 * If system isn't going to go multiuser, or user has requested to see
263 * boot text, don't render splash screen immediately
264 */
265 if (DISABLESPLASH)
266 #endif
267 vcons_redraw_screen(&sc->sc_console_screen);
268
269 sc->sc_defaultscreen_descr.textops = &ri->ri_ops;
270 sc->sc_defaultscreen_descr.capabilities = ri->ri_caps;
271 sc->sc_defaultscreen_descr.nrows = ri->ri_rows;
272 sc->sc_defaultscreen_descr.ncols = ri->ri_cols;
273 wsdisplay_cnattach(&sc->sc_defaultscreen_descr, ri, 0, crow,
274 defattr);
275
276 /* Clear the whole screen to bring it to a known state. */
277 if (sc->sc_want_clear)
278 (*ri->ri_ops.eraserows)(ri, 0, ri->ri_rows, defattr);
279
280 j = 0;
281 for (i = 0; i < min(1 << sc->sc_depth, 256); i++) {
282 #ifndef SPLASHSCREEN
283 sc->sc_cmap_red[i] = rasops_cmap[j];
284 sc->sc_cmap_green[i] = rasops_cmap[j + 1];
285 sc->sc_cmap_blue[i] = rasops_cmap[j + 2];
286 j += 3;
287 #else
288 if (i >= SPLASH_CMAP_OFFSET &&
289 i < SPLASH_CMAP_OFFSET + SPLASH_CMAP_SIZE) {
290 splash_get_cmap(i,
291 &sc->sc_cmap_red[i],
292 &sc->sc_cmap_green[i],
293 &sc->sc_cmap_blue[i]);
294 } else {
295 sc->sc_cmap_red[i] = rasops_cmap[j];
296 sc->sc_cmap_green[i] = rasops_cmap[j + 1];
297 sc->sc_cmap_blue[i] = rasops_cmap[j + 2];
298 }
299 j += 3;
300 #endif
301 }
302 genfb_restore_palette(sc);
303
304 #ifdef SPLASHSCREEN
305 sc->sc_splash.si_depth = sc->sc_depth;
306 sc->sc_splash.si_bits = sc->sc_console_screen.scr_ri.ri_bits;
307 sc->sc_splash.si_hwbits = sc->sc_fbaddr;
308 sc->sc_splash.si_width = sc->sc_width;
309 sc->sc_splash.si_height = sc->sc_height;
310 sc->sc_splash.si_stride = sc->sc_stride;
311 sc->sc_splash.si_fillrect = NULL;
312 if (!DISABLESPLASH) {
313 error = splash_render(&sc->sc_splash,
314 SPLASH_F_CENTER|SPLASH_F_FILL);
315 if (error) {
316 SCREEN_ENABLE_DRAWING(&sc->sc_console_screen);
317 vcons_replay_msgbuf(&sc->sc_console_screen);
318 }
319 }
320 #else
321 vcons_replay_msgbuf(&sc->sc_console_screen);
322 #endif
323
324 if (genfb_softc == NULL)
325 genfb_softc = sc;
326
327 aa.console = console;
328 aa.scrdata = &sc->sc_screenlist;
329 aa.accessops = &genfb_accessops;
330 aa.accesscookie = &sc->vd;
331
332 #ifdef GENFB_DISABLE_TEXT
333 if (!DISABLESPLASH && error == 0)
334 SCREEN_DISABLE_DRAWING(&sc->sc_console_screen);
335 #endif
336
337 config_found(sc->sc_dev, &aa, wsemuldisplaydevprint);
338
339 return 0;
340 }
341
342 static int
343 genfb_ioctl(void *v, void *vs, u_long cmd, void *data, int flag,
344 struct lwp *l)
345 {
346 struct vcons_data *vd = v;
347 struct genfb_softc *sc = vd->cookie;
348 struct wsdisplay_fbinfo *wdf;
349 struct vcons_screen *ms = vd->active;
350 struct wsdisplay_param *param;
351 int new_mode, error;
352
353 switch (cmd) {
354 case WSDISPLAYIO_GINFO:
355 if (ms == NULL)
356 return ENODEV;
357 wdf = (void *)data;
358 wdf->height = ms->scr_ri.ri_height;
359 wdf->width = ms->scr_ri.ri_width;
360 wdf->depth = ms->scr_ri.ri_depth;
361 wdf->cmsize = 256;
362 return 0;
363
364 case WSDISPLAYIO_GETCMAP:
365 return genfb_getcmap(sc,
366 (struct wsdisplay_cmap *)data);
367
368 case WSDISPLAYIO_PUTCMAP:
369 return genfb_putcmap(sc,
370 (struct wsdisplay_cmap *)data);
371
372 case WSDISPLAYIO_LINEBYTES:
373 *(u_int *)data = sc->sc_stride;
374 return 0;
375
376 case WSDISPLAYIO_SMODE:
377 new_mode = *(int *)data;
378
379 /* notify the bus backend */
380 error = 0;
381 if (sc->sc_ops.genfb_ioctl)
382 error = sc->sc_ops.genfb_ioctl(sc, vs,
383 cmd, data, flag, l);
384 if (error)
385 return error;
386
387 if (new_mode != sc->sc_mode) {
388 sc->sc_mode = new_mode;
389 if (sc->sc_modecb->gmc_setmode)
390 sc->sc_modecb->gmc_setmode(sc,
391 sc->sc_mode);
392 if (new_mode == WSDISPLAYIO_MODE_EMUL) {
393 genfb_restore_palette(sc);
394 vcons_redraw_screen(ms);
395 }
396 }
397 return 0;
398 case WSDISPLAYIO_SSPLASH:
399 #if defined(SPLASHSCREEN)
400 if(*(int *)data == 1) {
401 SCREEN_DISABLE_DRAWING(&sc->sc_console_screen);
402 splash_render(&sc->sc_splash,
403 SPLASH_F_CENTER|SPLASH_F_FILL);
404 } else {
405 SCREEN_ENABLE_DRAWING(&sc->sc_console_screen);
406 }
407 vcons_redraw_screen(ms);
408 return 0;
409 #else
410 return ENODEV;
411 #endif
412 case WSDISPLAYIO_GETPARAM:
413 param = (struct wsdisplay_param *)data;
414 if (sc->sc_backlight == NULL)
415 return EPASSTHROUGH;
416 switch (param->param) {
417 case WSDISPLAYIO_PARAM_BRIGHTNESS:
418 param->min = 0;
419 param->max = 255;
420 param->curval = sc->sc_backlight_level;
421 return 0;
422 case WSDISPLAYIO_PARAM_BACKLIGHT:
423 param->min = 0;
424 param->max = 1;
425 param->curval = sc->sc_backlight_on;
426 return 0;
427 }
428 return EPASSTHROUGH;
429
430 case WSDISPLAYIO_SETPARAM:
431 param = (struct wsdisplay_param *)data;
432 if (sc->sc_backlight == NULL)
433 return EPASSTHROUGH;
434 switch (param->param) {
435 case WSDISPLAYIO_PARAM_BRIGHTNESS:
436 genfb_set_backlight(sc, param->curval);
437 return 0;
438 case WSDISPLAYIO_PARAM_BACKLIGHT:
439 genfb_switch_backlight(sc, param->curval);
440 return 0;
441 }
442 return EPASSTHROUGH;
443 default:
444 if (sc->sc_ops.genfb_ioctl)
445 return sc->sc_ops.genfb_ioctl(sc, vs, cmd,
446 data, flag, l);
447 }
448 return EPASSTHROUGH;
449 }
450
451 static paddr_t
452 genfb_mmap(void *v, void *vs, off_t offset, int prot)
453 {
454 struct vcons_data *vd = v;
455 struct genfb_softc *sc = vd->cookie;
456
457 if (sc->sc_ops.genfb_mmap)
458 return sc->sc_ops.genfb_mmap(sc, vs, offset, prot);
459
460 return -1;
461 }
462
463 static void
464 genfb_init_screen(void *cookie, struct vcons_screen *scr,
465 int existing, long *defattr)
466 {
467 struct genfb_softc *sc = cookie;
468 struct rasops_info *ri = &scr->scr_ri;
469
470 ri->ri_depth = sc->sc_depth;
471 ri->ri_width = sc->sc_width;
472 ri->ri_height = sc->sc_height;
473 ri->ri_stride = sc->sc_stride;
474 ri->ri_flg = RI_CENTER;
475 if (sc->sc_want_clear)
476 ri->ri_flg |= RI_FULLCLEAR;
477
478 #ifdef GENFB_SHADOWFB
479 if (sc->sc_shadowfb != NULL) {
480
481 ri->ri_hwbits = (char *)sc->sc_fbaddr;
482 ri->ri_bits = (char *)sc->sc_shadowfb;
483 } else
484 #endif
485 {
486 ri->ri_bits = (char *)sc->sc_fbaddr;
487 scr->scr_flags |= VCONS_DONT_READ;
488 }
489
490 if (existing && sc->sc_want_clear) {
491 ri->ri_flg |= RI_CLEAR;
492 }
493
494 rasops_init(ri, sc->sc_height / 8, sc->sc_width / 8);
495 ri->ri_caps = WSSCREEN_WSCOLORS;
496
497 rasops_reconfig(ri, sc->sc_height / ri->ri_font->fontheight,
498 sc->sc_width / ri->ri_font->fontwidth);
499
500 /* TODO: actually center output */
501 ri->ri_hw = scr;
502
503 #ifdef GENFB_DISABLE_TEXT
504 if (scr == &sc->sc_console_screen && !DISABLESPLASH)
505 SCREEN_DISABLE_DRAWING(&sc->sc_console_screen);
506 #endif
507 }
508
509 static int
510 genfb_putcmap(struct genfb_softc *sc, struct wsdisplay_cmap *cm)
511 {
512 u_char *r, *g, *b;
513 u_int index = cm->index;
514 u_int count = cm->count;
515 int i, error;
516 u_char rbuf[256], gbuf[256], bbuf[256];
517
518 #ifdef GENFB_DEBUG
519 aprint_debug("putcmap: %d %d\n",index, count);
520 #endif
521 if (cm->index >= 256 || cm->count > 256 ||
522 (cm->index + cm->count) > 256)
523 return EINVAL;
524 error = copyin(cm->red, &rbuf[index], count);
525 if (error)
526 return error;
527 error = copyin(cm->green, &gbuf[index], count);
528 if (error)
529 return error;
530 error = copyin(cm->blue, &bbuf[index], count);
531 if (error)
532 return error;
533
534 memcpy(&sc->sc_cmap_red[index], &rbuf[index], count);
535 memcpy(&sc->sc_cmap_green[index], &gbuf[index], count);
536 memcpy(&sc->sc_cmap_blue[index], &bbuf[index], count);
537
538 r = &sc->sc_cmap_red[index];
539 g = &sc->sc_cmap_green[index];
540 b = &sc->sc_cmap_blue[index];
541
542 for (i = 0; i < count; i++) {
543 genfb_putpalreg(sc, index, *r, *g, *b);
544 index++;
545 r++, g++, b++;
546 }
547 return 0;
548 }
549
550 static int
551 genfb_getcmap(struct genfb_softc *sc, struct wsdisplay_cmap *cm)
552 {
553 u_int index = cm->index;
554 u_int count = cm->count;
555 int error;
556
557 if (index >= 255 || count > 256 || index + count > 256)
558 return EINVAL;
559
560 error = copyout(&sc->sc_cmap_red[index], cm->red, count);
561 if (error)
562 return error;
563 error = copyout(&sc->sc_cmap_green[index], cm->green, count);
564 if (error)
565 return error;
566 error = copyout(&sc->sc_cmap_blue[index], cm->blue, count);
567 if (error)
568 return error;
569
570 return 0;
571 }
572
573 void
574 genfb_restore_palette(struct genfb_softc *sc)
575 {
576 int i;
577
578 if (sc->sc_depth <= 8) {
579 for (i = 0; i < (1 << sc->sc_depth); i++) {
580 genfb_putpalreg(sc, i, sc->sc_cmap_red[i],
581 sc->sc_cmap_green[i], sc->sc_cmap_blue[i]);
582 }
583 }
584 }
585
586 static int
587 genfb_putpalreg(struct genfb_softc *sc, uint8_t idx, uint8_t r, uint8_t g,
588 uint8_t b)
589 {
590
591 if (sc->sc_cmcb) {
592
593 sc->sc_cmcb->gcc_set_mapreg(sc->sc_cmcb->gcc_cookie,
594 idx, r, g, b);
595 }
596 return 0;
597 }
598
599 void
600 genfb_cnattach(void)
601 {
602 genfb_cnattach_called = 1;
603 }
604
605 void
606 genfb_disable(void)
607 {
608 genfb_enabled = 0;
609 }
610
611 int
612 genfb_is_console(void)
613 {
614 return genfb_cnattach_called;
615 }
616
617 int
618 genfb_is_enabled(void)
619 {
620 return genfb_enabled;
621 }
622
623 int
624 genfb_borrow(bus_addr_t addr, bus_space_handle_t *hdlp)
625 {
626 struct genfb_softc *sc = genfb_softc;
627
628 if (sc && sc->sc_ops.genfb_borrow)
629 return sc->sc_ops.genfb_borrow(sc, addr, hdlp);
630 return 0;
631 }
632
633 static void
634 genfb_set_backlight(struct genfb_softc *sc, int level)
635 {
636
637 KASSERT(sc->sc_backlight != NULL);
638
639 /*
640 * should we do nothing when backlight is off, should we just store the
641 * level and use it when turning back on or should we just flip sc_bl_on
642 * and turn the backlight on?
643 * For now turn it on so a crashed screensaver can't get the user stuck
644 * with a dark screen as long as hotkeys work
645 */
646 if (level > 255) level = 255;
647 if (level < 0) level = 0;
648 if (level == sc->sc_backlight_level)
649 return;
650 sc->sc_backlight_level = level;
651 if (sc->sc_backlight_on == 0)
652 sc->sc_backlight_on = 1;
653 sc->sc_backlight->gpc_set_parameter(
654 sc->sc_backlight->gpc_cookie, level);
655 }
656
657 static void
658 genfb_switch_backlight(struct genfb_softc *sc, int on)
659 {
660 int level;
661
662 KASSERT(sc->sc_backlight != NULL);
663
664 if (on == sc->sc_backlight_on)
665 return;
666 sc->sc_backlight_on = on;
667 level = on ? sc->sc_backlight_level : 0;
668 sc->sc_backlight->gpc_set_parameter(
669 sc->sc_backlight->gpc_cookie, level);
670 }
671
672
673 static void
674 genfb_brightness_up(device_t dev)
675 {
676 struct genfb_softc *sc = device_private(dev);
677
678 genfb_set_backlight(sc, sc->sc_backlight_level + 8);
679 }
680
681 static void
682 genfb_brightness_down(device_t dev)
683 {
684 struct genfb_softc *sc = device_private(dev);
685
686 genfb_set_backlight(sc, sc->sc_backlight_level - 8);
687 }
688