/* $NetBSD: bivideo.c,v 1.35 2021/04/24 23:36:54 thorpej Exp $ */ /*- * Copyright (c) 1999-2001 * Shin Takemura and PocketBSD Project. All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. All advertising materials mentioning features or use of this software * must display the following acknowledgement: * This product includes software developed by the PocketBSD project * and its contributors. * 4. Neither the name of the project nor the names of its contributors * may be used to endorse or promote products derived from this software * without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. * */ #include __KERNEL_RCSID(0, "$NetBSD: bivideo.c,v 1.35 2021/04/24 23:36:54 thorpej Exp $"); #ifdef _KERNEL_OPT #include "opt_hpcfb.h" #endif #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #ifdef FBDEBUG #define VPRINTF(arg) do { if (bootverbose) printf arg; } while (0) #else #define VPRINTF(arg) /* nothing */ #endif /* * global variables */ int bivideo_dont_attach = 0; /* * function prototypes */ int bivideomatch(device_t, cfdata_t, void *); void bivideoattach(device_t, device_t, void *); int bivideo_ioctl(void *, u_long, void *, int, struct lwp *); paddr_t bivideo_mmap(void *, off_t, int); struct bivideo_softc { struct hpcfb_fbconf sc_fbconf; struct hpcfb_dspconf sc_dspconf; int sc_powerstate; #define PWRSTAT_SUSPEND (1<<0) #define PWRSTAT_VIDEOOFF (1<<1) #define PWRSTAT_LCD (1<<2) #define PWRSTAT_BACKLIGHT (1<<3) #define PWRSTAT_ALL (0xffffffff) int sc_lcd_inited; #define BACKLIGHT_INITED (1<<0) #define BRIGHTNESS_INITED (1<<1) #define CONTRAST_INITED (1<<2) int sc_brightness; int sc_brightness_save; int sc_max_brightness; int sc_contrast; int sc_max_contrast; }; static int bivideo_init(struct hpcfb_fbconf *); static void bivideo_power(int, void *); static void bivideo_update_powerstate(struct bivideo_softc *, int); static bool bivideo_suspend(device_t, const pmf_qual_t *); static bool bivideo_resume(device_t, const pmf_qual_t *); void bivideo_init_backlight(struct bivideo_softc *, int); void bivideo_init_brightness(struct bivideo_softc *, int); void bivideo_init_contrast(struct bivideo_softc *, int); void bivideo_set_brightness(struct bivideo_softc *, int); void bivideo_set_contrast(struct bivideo_softc *, int); #if defined __mips__ || defined __sh__ || defined __arm__ #define __BTOP(x) ((paddr_t)(x) >> PGSHIFT) #define __PTOB(x) ((paddr_t)(x) << PGSHIFT) #else #error "define btop, ptob." #endif /* * static variables */ CFATTACH_DECL_NEW(bivideo, sizeof(struct bivideo_softc), bivideomatch, bivideoattach, NULL, NULL); struct hpcfb_accessops bivideo_ha = { bivideo_ioctl, bivideo_mmap }; static int console_flag = 0; static int attach_flag = 0; /* * function bodies */ int bivideomatch(device_t parent, cfdata_t match, void *aux) { struct mainbus_attach_args *ma = aux; if (bivideo_dont_attach || strcmp(ma->ma_name, match->cf_name)) return 0; return (1); } void bivideoattach(device_t parent, device_t self, void *aux) { struct bivideo_softc *sc = device_private(self); struct hpcfb_attach_args ha; if (attach_flag) { panic("%s(%d): bivideo attached twice", __FILE__, __LINE__); } attach_flag = 1; printf(": "); if (bivideo_init(&sc->sc_fbconf) != 0) { /* just return so that hpcfb will not be attached */ return; } printf("pseudo video controller"); if (console_flag) { printf(", console"); } printf("\n"); printf("%s: framebuffer address: 0x%08lx\n", device_xname(self), (u_long)bootinfo->fb_addr); /* Add a suspend hook to power saving */ sc->sc_powerstate = 0; if (!pmf_device_register(self, bivideo_suspend, bivideo_resume)) aprint_error_dev(self, "unable to establish power handler\n"); /* initialize backlight brightness and lcd contrast */ sc->sc_lcd_inited = 0; bivideo_init_brightness(sc, 1); bivideo_init_contrast(sc, 1); bivideo_init_backlight(sc, 1); ha.ha_console = console_flag; ha.ha_accessops = &bivideo_ha; ha.ha_accessctx = sc; ha.ha_curfbconf = 0; ha.ha_nfbconf = 1; ha.ha_fbconflist = &sc->sc_fbconf; ha.ha_curdspconf = 0; ha.ha_ndspconf = 1; ha.ha_dspconflist = &sc->sc_dspconf; config_found(self, &ha, hpcfbprint, CFARG_EOL); } int bivideo_getcnfb(struct hpcfb_fbconf *fb) { console_flag = 1; return bivideo_init(fb); } static int bivideo_init(struct hpcfb_fbconf *fb) { /* * get fb settings from bootinfo */ if (bootinfo == NULL || bootinfo->fb_addr == 0 || bootinfo->fb_line_bytes == 0 || bootinfo->fb_width == 0 || bootinfo->fb_height == 0) { printf("no frame buffer information.\n"); return (-1); } /* zero fill */ memset(fb, 0, sizeof(*fb)); fb->hf_conf_index = 0; /* configuration index */ fb->hf_nconfs = 1; /* how many configurations */ strcpy(fb->hf_name, "built-in video"); /* frame buffer name */ strcpy(fb->hf_conf_name, "default"); /* configuration name */ fb->hf_height = bootinfo->fb_height; fb->hf_width = bootinfo->fb_width; fb->hf_baseaddr = (u_long)bootinfo->fb_addr; fb->hf_offset = (u_long)bootinfo->fb_addr - __PTOB(__BTOP(bootinfo->fb_addr)); /* frame buffer start offset */ fb->hf_bytes_per_line = bootinfo->fb_line_bytes; fb->hf_nplanes = 1; fb->hf_bytes_per_plane = bootinfo->fb_height * bootinfo->fb_line_bytes; fb->hf_access_flags |= HPCFB_ACCESS_BYTE; fb->hf_access_flags |= HPCFB_ACCESS_WORD; fb->hf_access_flags |= HPCFB_ACCESS_DWORD; switch (bootinfo->fb_type) { /* * gray scale */ case BIFB_D2_M2L_3: case BIFB_D2_M2L_3x2: fb->hf_access_flags |= HPCFB_ACCESS_REVERSE; /* fall through */ case BIFB_D2_M2L_0: case BIFB_D2_M2L_0x2: fb->hf_class = HPCFB_CLASS_GRAYSCALE; fb->hf_access_flags |= HPCFB_ACCESS_STATIC; fb->hf_pack_width = 8; fb->hf_pixels_per_pack = 4; fb->hf_pixel_width = 2; fb->hf_class_data_length = sizeof(struct hf_gray_tag); fb->hf_u.hf_gray.hf_flags = 0; /* reserved for future use */ break; case BIFB_D4_M2L_F: case BIFB_D4_M2L_Fx2: fb->hf_access_flags |= HPCFB_ACCESS_REVERSE; /* fall through */ case BIFB_D4_M2L_0: case BIFB_D4_M2L_0x2: fb->hf_class = HPCFB_CLASS_GRAYSCALE; fb->hf_access_flags |= HPCFB_ACCESS_STATIC; fb->hf_pack_width = 8; fb->hf_pixels_per_pack = 2; fb->hf_pixel_width = 4; fb->hf_class_data_length = sizeof(struct hf_gray_tag); fb->hf_u.hf_gray.hf_flags = 0; /* reserved for future use */ break; /* * indexed color */ case BIFB_D8_FF: fb->hf_access_flags |= HPCFB_ACCESS_REVERSE; /* fall through */ case BIFB_D8_00: fb->hf_class = HPCFB_CLASS_INDEXCOLOR; fb->hf_access_flags |= HPCFB_ACCESS_STATIC; fb->hf_pack_width = 8; fb->hf_pixels_per_pack = 1; fb->hf_pixel_width = 8; fb->hf_class_data_length = sizeof(struct hf_indexed_tag); fb->hf_u.hf_indexed.hf_flags = 0; /* reserved for future use */ break; /* * RGB color */ case BIFB_D16_FFFF: fb->hf_access_flags |= HPCFB_ACCESS_REVERSE; /* fall through */ case BIFB_D16_0000: fb->hf_class = HPCFB_CLASS_RGBCOLOR; fb->hf_access_flags |= HPCFB_ACCESS_STATIC; #if BYTE_ORDER == LITTLE_ENDIAN fb->hf_order_flags = HPCFB_REVORDER_BYTE; #endif fb->hf_pack_width = 16; fb->hf_pixels_per_pack = 1; fb->hf_pixel_width = 16; fb->hf_class_data_length = sizeof(struct hf_rgb_tag); fb->hf_u.hf_rgb.hf_flags = 0; /* reserved for future use */ fb->hf_u.hf_rgb.hf_red_width = 5; fb->hf_u.hf_rgb.hf_red_shift = 11; fb->hf_u.hf_rgb.hf_green_width = 6; fb->hf_u.hf_rgb.hf_green_shift = 5; fb->hf_u.hf_rgb.hf_blue_width = 5; fb->hf_u.hf_rgb.hf_blue_shift = 0; fb->hf_u.hf_rgb.hf_alpha_width = 0; fb->hf_u.hf_rgb.hf_alpha_shift = 0; break; default: printf("unsupported type %d.\n", bootinfo->fb_type); return (-1); break; } return (0); /* no error */ } static void bivideo_power(int why, void *arg) { struct bivideo_softc *sc = arg; switch (why) { case PWR_SUSPEND: case PWR_STANDBY: sc->sc_powerstate |= PWRSTAT_SUSPEND; bivideo_update_powerstate(sc, PWRSTAT_ALL); break; case PWR_RESUME: sc->sc_powerstate &= ~PWRSTAT_SUSPEND; bivideo_update_powerstate(sc, PWRSTAT_ALL); break; } } static void bivideo_update_powerstate(struct bivideo_softc *sc, int updates) { if (updates & PWRSTAT_LCD) config_hook_call(CONFIG_HOOK_POWERCONTROL, CONFIG_HOOK_POWERCONTROL_LCD, (void*)!(sc->sc_powerstate & (PWRSTAT_VIDEOOFF|PWRSTAT_SUSPEND))); if (updates & PWRSTAT_BACKLIGHT) config_hook_call(CONFIG_HOOK_POWERCONTROL, CONFIG_HOOK_POWERCONTROL_LCDLIGHT, (void*)(!(sc->sc_powerstate & (PWRSTAT_VIDEOOFF|PWRSTAT_SUSPEND)) && (sc->sc_powerstate & PWRSTAT_BACKLIGHT))); } static bool bivideo_suspend(device_t self, const pmf_qual_t *qual) { struct bivideo_softc *sc = device_private(self); bivideo_power(PWR_SUSPEND, sc); return true; } static bool bivideo_resume(device_t self, const pmf_qual_t *qual) { struct bivideo_softc *sc = device_private(self); bivideo_power(PWR_RESUME, sc); return true; } int bivideo_ioctl(void *v, u_long cmd, void *data, int flag, struct lwp *l) { struct bivideo_softc *sc = (struct bivideo_softc *)v; struct hpcfb_fbconf *fbconf; struct hpcfb_dspconf *dspconf; struct wsdisplay_cmap *cmap; struct wsdisplay_param *dispparam; int error; switch (cmd) { case WSDISPLAYIO_GETCMAP: cmap = (struct wsdisplay_cmap *)data; if (sc->sc_fbconf.hf_class != HPCFB_CLASS_INDEXCOLOR || sc->sc_fbconf.hf_pack_width != 8 || cmap->index >= 256 || cmap->count > 256 - cmap->index) return (EINVAL); error = copyout(&bivideo_cmap_r[cmap->index], cmap->red, cmap->count); if (error) return error; error = copyout(&bivideo_cmap_g[cmap->index], cmap->green, cmap->count); if (error) return error; error = copyout(&bivideo_cmap_b[cmap->index], cmap->blue, cmap->count); return error; case WSDISPLAYIO_PUTCMAP: /* * This driver can't set color map. */ return (EINVAL); case WSDISPLAYIO_SVIDEO: if (*(int *)data == WSDISPLAYIO_VIDEO_OFF) sc->sc_powerstate |= PWRSTAT_VIDEOOFF; else sc->sc_powerstate &= ~PWRSTAT_VIDEOOFF; bivideo_update_powerstate(sc, PWRSTAT_ALL); return 0; case WSDISPLAYIO_GVIDEO: *(int *)data = (sc->sc_powerstate&PWRSTAT_VIDEOOFF) ? WSDISPLAYIO_VIDEO_OFF:WSDISPLAYIO_VIDEO_ON; return 0; case WSDISPLAYIO_GETPARAM: dispparam = (struct wsdisplay_param*)data; switch (dispparam->param) { case WSDISPLAYIO_PARAM_BACKLIGHT: VPRINTF(("bivideo_ioctl: GET:BACKLIGHT\n")); bivideo_init_brightness(sc, 0); bivideo_init_backlight(sc, 0); VPRINTF(("bivideo_ioctl: GET:(real)BACKLIGHT %d\n", (sc->sc_powerstate&PWRSTAT_BACKLIGHT)? 1: 0)); dispparam->min = 0; dispparam->max = 1; if (sc->sc_max_brightness > 0) dispparam->curval = sc->sc_brightness > 0? 1: 0; else dispparam->curval = (sc->sc_powerstate&PWRSTAT_BACKLIGHT) ? 1: 0; VPRINTF(("bivideo_ioctl: GET:BACKLIGHT:%d(%s)\n", dispparam->curval, sc->sc_max_brightness > 0? "brightness": "light")); return 0; break; case WSDISPLAYIO_PARAM_CONTRAST: VPRINTF(("bivideo_ioctl: GET:CONTRAST\n")); bivideo_init_contrast(sc, 0); if (sc->sc_max_contrast > 0) { dispparam->min = 0; dispparam->max = sc->sc_max_contrast; dispparam->curval = sc->sc_contrast; VPRINTF(("bivideo_ioctl: GET:CONTRAST max=%d, current=%d\n", sc->sc_max_contrast, sc->sc_contrast)); return 0; } else { VPRINTF(("bivideo_ioctl: GET:CONTRAST EINVAL\n")); return (EINVAL); } break; case WSDISPLAYIO_PARAM_BRIGHTNESS: VPRINTF(("bivideo_ioctl: GET:BRIGHTNESS\n")); bivideo_init_brightness(sc, 0); if (sc->sc_max_brightness > 0) { dispparam->min = 0; dispparam->max = sc->sc_max_brightness; dispparam->curval = sc->sc_brightness; VPRINTF(("bivideo_ioctl: GET:BRIGHTNESS max=%d, current=%d\n", sc->sc_max_brightness, sc->sc_brightness)); return 0; } else { VPRINTF(("bivideo_ioctl: GET:BRIGHTNESS EINVAL\n")); return (EINVAL); } return (EINVAL); default: return (EINVAL); } return (0); case WSDISPLAYIO_SETPARAM: dispparam = (struct wsdisplay_param*)data; switch (dispparam->param) { case WSDISPLAYIO_PARAM_BACKLIGHT: VPRINTF(("bivideo_ioctl: SET:BACKLIGHT\n")); if (dispparam->curval < 0 || 1 < dispparam->curval) return (EINVAL); bivideo_init_brightness(sc, 0); VPRINTF(("bivideo_ioctl: SET:max brightness=%d\n", sc->sc_max_brightness)); if (sc->sc_max_brightness > 0) { /* dimmer */ if (dispparam->curval == 0){ sc->sc_brightness_save = sc->sc_brightness; bivideo_set_brightness(sc, 0); /* min */ } else { if (sc->sc_brightness_save == 0) sc->sc_brightness_save = sc->sc_max_brightness; bivideo_set_brightness(sc, sc->sc_brightness_save); } VPRINTF(("bivideo_ioctl: SET:BACKLIGHT:brightness=%d\n", sc->sc_brightness)); } else { /* off */ if (dispparam->curval == 0) sc->sc_powerstate &= ~PWRSTAT_BACKLIGHT; else sc->sc_powerstate |= PWRSTAT_BACKLIGHT; VPRINTF(("bivideo_ioctl: SET:BACKLIGHT:powerstate %d\n", (sc->sc_powerstate & PWRSTAT_BACKLIGHT)?1:0)); bivideo_update_powerstate(sc, PWRSTAT_BACKLIGHT); VPRINTF(("bivideo_ioctl: SET:BACKLIGHT:%d\n", (sc->sc_powerstate & PWRSTAT_BACKLIGHT)?1:0)); } return 0; break; case WSDISPLAYIO_PARAM_CONTRAST: VPRINTF(("bivideo_ioctl: SET:CONTRAST\n")); bivideo_init_contrast(sc, 0); if (dispparam->curval < 0 || sc->sc_max_contrast < dispparam->curval) return (EINVAL); if (sc->sc_max_contrast > 0) { #ifdef FBDEBUG int org = sc->sc_contrast; #endif bivideo_set_contrast(sc, dispparam->curval); VPRINTF(("bivideo_ioctl: SET:CONTRAST org=%d, current=%d\n", org, sc->sc_contrast)); return 0; } else { VPRINTF(("bivideo_ioctl: SET:CONTRAST EINVAL\n")); return (EINVAL); } break; case WSDISPLAYIO_PARAM_BRIGHTNESS: VPRINTF(("bivideo_ioctl: SET:BRIGHTNESS\n")); bivideo_init_brightness(sc, 0); if (dispparam->curval < 0 || sc->sc_max_brightness < dispparam->curval) return (EINVAL); if (sc->sc_max_brightness > 0) { #ifdef FBDEBUG int org = sc->sc_brightness; #endif bivideo_set_brightness(sc, dispparam->curval); VPRINTF(("bivideo_ioctl: SET:BRIGHTNESS org=%d, current=%d\n", org, sc->sc_brightness)); return 0; } else { VPRINTF(("bivideo_ioctl: SET:BRIGHTNESS EINVAL\n")); return (EINVAL); } break; default: return (EINVAL); } return (0); case HPCFBIO_GCONF: fbconf = (struct hpcfb_fbconf *)data; if (fbconf->hf_conf_index != 0 && fbconf->hf_conf_index != HPCFB_CURRENT_CONFIG) { return (EINVAL); } *fbconf = sc->sc_fbconf; /* structure assignment */ return (0); case HPCFBIO_SCONF: fbconf = (struct hpcfb_fbconf *)data; if (fbconf->hf_conf_index != 0 && fbconf->hf_conf_index != HPCFB_CURRENT_CONFIG) { return (EINVAL); } /* * nothing to do because we have only one configuration */ return (0); case HPCFBIO_GDSPCONF: dspconf = (struct hpcfb_dspconf *)data; if ((dspconf->hd_unit_index != 0 && dspconf->hd_unit_index != HPCFB_CURRENT_UNIT) || (dspconf->hd_conf_index != 0 && dspconf->hd_conf_index != HPCFB_CURRENT_CONFIG)) { return (EINVAL); } *dspconf = sc->sc_dspconf; /* structure assignment */ return (0); case HPCFBIO_SDSPCONF: dspconf = (struct hpcfb_dspconf *)data; if ((dspconf->hd_unit_index != 0 && dspconf->hd_unit_index != HPCFB_CURRENT_UNIT) || (dspconf->hd_conf_index != 0 && dspconf->hd_conf_index != HPCFB_CURRENT_CONFIG)) { return (EINVAL); } /* * nothing to do * because we have only one unit and one configuration */ return (0); case HPCFBIO_GOP: case HPCFBIO_SOP: /* * curently not implemented... */ return (EINVAL); } return (EPASSTHROUGH); } paddr_t bivideo_mmap(void *ctx, off_t offset, int prot) { struct bivideo_softc *sc = (struct bivideo_softc *)ctx; if (offset < 0 || (sc->sc_fbconf.hf_bytes_per_plane + sc->sc_fbconf.hf_offset) < offset) return -1; return __BTOP((u_long)bootinfo->fb_addr + offset); } void bivideo_init_backlight(struct bivideo_softc *sc, int inattach) { int val = -1; if (sc->sc_lcd_inited&BACKLIGHT_INITED) return; if (config_hook_call(CONFIG_HOOK_GET, CONFIG_HOOK_POWER_LCDLIGHT, &val) != -1) { /* we can get real light state */ VPRINTF(("bivideo_init_backlight: real backlight=%d\n", val)); if (val == 0) sc->sc_powerstate &= ~PWRSTAT_BACKLIGHT; else sc->sc_powerstate |= PWRSTAT_BACKLIGHT; sc->sc_lcd_inited |= BACKLIGHT_INITED; } else if (inattach) { /* we cannot get real light state in attach time because light device not yet attached. we will retry in !inattach. temporary assume light is on. */ sc->sc_powerstate |= PWRSTAT_BACKLIGHT; } else { /* we cannot get real light state, so work by myself state */ sc->sc_lcd_inited |= BACKLIGHT_INITED; } } void bivideo_init_brightness(struct bivideo_softc *sc, int inattach) { int val = -1; if (sc->sc_lcd_inited&BRIGHTNESS_INITED) return; VPRINTF(("bivideo_init_brightness\n")); if (config_hook_call(CONFIG_HOOK_GET, CONFIG_HOOK_BRIGHTNESS_MAX, &val) != -1) { /* we can get real brightness max */ VPRINTF(("bivideo_init_brightness: real brightness max=%d\n", val)); sc->sc_max_brightness = val; val = -1; if (config_hook_call(CONFIG_HOOK_GET, CONFIG_HOOK_BRIGHTNESS, &val) != -1) { /* we can get real brightness */ VPRINTF(("bivideo_init_brightness: real brightness=%d\n", val)); sc->sc_brightness_save = sc->sc_brightness = val; } else { sc->sc_brightness_save = sc->sc_brightness = sc->sc_max_brightness; } sc->sc_lcd_inited |= BRIGHTNESS_INITED; } else if (inattach) { /* we cannot get real brightness in attach time because brightness device not yet attached. we will retry in !inattach. */ sc->sc_max_brightness = -1; sc->sc_brightness = -1; sc->sc_brightness_save = -1; } else { /* we cannot get real brightness */ sc->sc_lcd_inited |= BRIGHTNESS_INITED; } return; } void bivideo_init_contrast(struct bivideo_softc *sc, int inattach) { int val = -1; if (sc->sc_lcd_inited&CONTRAST_INITED) return; VPRINTF(("bivideo_init_contrast\n")); if (config_hook_call(CONFIG_HOOK_GET, CONFIG_HOOK_CONTRAST_MAX, &val) != -1) { /* we can get real contrast max */ VPRINTF(("bivideo_init_contrast: real contrast max=%d\n", val)); sc->sc_max_contrast = val; val = -1; if (config_hook_call(CONFIG_HOOK_GET, CONFIG_HOOK_CONTRAST, &val) != -1) { /* we can get real contrast */ VPRINTF(("bivideo_init_contrast: real contrast=%d\n", val)); sc->sc_contrast = val; } else { sc->sc_contrast = sc->sc_max_contrast; } sc->sc_lcd_inited |= CONTRAST_INITED; } else if (inattach) { /* we cannot get real contrast in attach time because contrast device not yet attached. we will retry in !inattach. */ sc->sc_max_contrast = -1; sc->sc_contrast = -1; } else { /* we cannot get real contrast */ sc->sc_lcd_inited |= CONTRAST_INITED; } return; } void bivideo_set_brightness(struct bivideo_softc *sc, int val) { sc->sc_brightness = val; config_hook_call(CONFIG_HOOK_SET, CONFIG_HOOK_BRIGHTNESS, &val); if (config_hook_call(CONFIG_HOOK_GET, CONFIG_HOOK_BRIGHTNESS, &val) != -1) { sc->sc_brightness = val; } } void bivideo_set_contrast(struct bivideo_softc *sc, int val) { sc->sc_contrast = val; config_hook_call(CONFIG_HOOK_SET, CONFIG_HOOK_CONTRAST, &val); if (config_hook_call(CONFIG_HOOK_GET, CONFIG_HOOK_CONTRAST, &val) != -1) { sc->sc_contrast = val; } }