/* $NetBSD: mq200.c,v 1.36 2022/05/28 15:57:18 andvar Exp $ */ /*- * Copyright (c) 2000, 2001 TAKEMURA Shin * 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. The name of the author may not 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: mq200.c,v 1.36 2022/05/28 15:57:18 andvar Exp $"); #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "opt_mq200.h" #include #include #include #include "bivideo.h" #if NBIVIDEO > 0 #include #endif /* * function prototypes */ static void mq200_power(int, void *); static int mq200_hardpower(void *, int, long, void *); static int mq200_fbinit(struct hpcfb_fbconf *); static int mq200_ioctl(void *, u_long, void *, int, struct lwp *); static paddr_t mq200_mmap(void *, off_t offset, int); static void mq200_update_powerstate(struct mq200_softc *, int); void mq200_init_backlight(struct mq200_softc *, int); void mq200_init_brightness(struct mq200_softc *, int); void mq200_init_contrast(struct mq200_softc *, int); void mq200_set_brightness(struct mq200_softc *, int); void mq200_set_contrast(struct mq200_softc *, int); /* * static variables */ struct hpcfb_accessops mq200_ha = { mq200_ioctl, mq200_mmap }; #ifdef MQ200_DEBUG int mq200_debug = MQ200DEBUG_CONF; #endif int mq200_probe(bus_space_tag_t iot, bus_space_handle_t ioh) { unsigned long regval; #if NBIVIDEO > 0 if (bivideo_dont_attach) /* some video driver already attached */ return (0); #endif /* NBIVIDEO > 0 */ regval = bus_space_read_4(iot, ioh, MQ200_PC00R); VPRINTF("probe: vendor id=%04lx product id=%04lx\n", regval & 0xffff, (regval >> 16) & 0xffff); if (regval != ((MQ200_PRODUCT_ID << 16) | MQ200_VENDOR_ID)) return (0); return (1); } void mq200_attach(struct mq200_softc *sc) { unsigned long regval; struct hpcfb_attach_args ha; int console = (bootinfo->bi_cnuse & BI_CNUSE_SERIAL) ? 0 : 1; printf(": "); if (mq200_fbinit(&sc->sc_fbconf) != 0) { /* just return so that hpcfb will not be attached */ return; } sc->sc_fbconf.hf_baseaddr = (u_long)bootinfo->fb_addr; sc->sc_fbconf.hf_offset = (u_long)sc->sc_fbconf.hf_baseaddr - MIPS_PHYS_TO_KSEG1(mips_ptob(mips_btop(sc->sc_baseaddr))); DPRINTF("hf_baseaddr=%lx\n", sc->sc_fbconf.hf_baseaddr); DPRINTF("hf_offset=%lx\n", sc->sc_fbconf.hf_offset); regval = mq200_read(sc, MQ200_PC08R); printf("MQ200 Rev.%02lx video controller", regval & 0xff); if (console) { printf(", console"); } printf("\n"); printf("%s: framebuffer address: 0x%08lx\n", device_xname(sc->sc_dev), (u_long)bootinfo->fb_addr); /* * setup registers */ sc->sc_flags = 0; sc->sc_baseclock = 12288; /* 12.288 MHz */ #ifdef MQ200_DEBUG if (bootverbose) { /* dump current setting */ mq200_dump_all(sc); mq200_dump_pll(sc); } #endif mq200_setup_regctx(sc); mq200_mdsetup(sc); if (sc->sc_md) { int mode; switch (sc->sc_fbconf.hf_pixel_width) { case 1: mode = MQ200_GCC_1BPP; break; case 2: mode = MQ200_GCC_2BPP; break; case 4: mode = MQ200_GCC_4BPP; break; case 8: mode = MQ200_GCC_8BPP; break; case 16: mode = MQ200_GCC_16BPP_DIRECT; break; default: printf("%s: %dbpp isn't supported\n", device_xname(sc->sc_dev), sc->sc_fbconf.hf_pixel_width); return; } if (sc->sc_md->md_flags & MQ200_MD_HAVEFP) { sc->sc_flags |= MQ200_SC_GC2_ENABLE; /* FP */ } #if MQ200_USECRT if (sc->sc_md->md_flags & MQ200_MD_HAVECRT) { int i; sc->sc_flags |= MQ200_SC_GC1_ENABLE; /* CRT */ for (i = 0; i < mq200_crt_nparams; i++) { sc->sc_crt = &mq200_crt_params[i]; if (sc->sc_md->md_fp_width <= mq200_crt_params[i].width && sc->sc_md->md_fp_height <= mq200_crt_params[i].height) break; } } #endif mq200_setup(sc); if (sc->sc_flags & MQ200_SC_GC2_ENABLE) /* FP */ mq200_win_enable(sc, MQ200_GC2, mode, sc->sc_fbconf.hf_baseaddr, sc->sc_fbconf.hf_width, sc->sc_fbconf.hf_height, sc->sc_fbconf.hf_bytes_per_plane); if (sc->sc_flags & MQ200_SC_GC1_ENABLE) /* CRT */ mq200_win_enable(sc, MQ200_GC1, mode, sc->sc_fbconf.hf_baseaddr, sc->sc_fbconf.hf_width, sc->sc_fbconf.hf_height, sc->sc_fbconf.hf_bytes_per_plane); } #ifdef MQ200_DEBUG if (sc->sc_md == NULL || bootverbose) { mq200_dump_pll(sc); } #endif /* Add a power hook to power saving */ sc->sc_mq200pwstate = MQ200_POWERSTATE_D0; sc->sc_powerhook = powerhook_establish(device_xname(sc->sc_dev), mq200_power, sc); if (sc->sc_powerhook == NULL) printf("%s: WARNING: unable to establish power hook\n", device_xname(sc->sc_dev)); /* Add a hard power hook to power saving */ sc->sc_hardpowerhook = config_hook(CONFIG_HOOK_PMEVENT, CONFIG_HOOK_PMEVENT_HARDPOWER, CONFIG_HOOK_SHARE, mq200_hardpower, sc); if (sc->sc_hardpowerhook == NULL) printf("%s: WARNING: unable to establish hard power hook\n", device_xname(sc->sc_dev)); /* initialize backlight brightness and lcd contrast */ sc->sc_lcd_inited = 0; mq200_init_brightness(sc, 1); mq200_init_contrast(sc, 1); mq200_init_backlight(sc, 1); if (console && hpcfb_cnattach(&sc->sc_fbconf) != 0) { panic("mq200_attach: can't init fb console"); } ha.ha_console = console; ha.ha_accessops = &mq200_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(sc->sc_dev, &ha, hpcfbprint, CFARGS_NONE); #if NBIVIDEO > 0 /* * bivideo is no longer need */ bivideo_dont_attach = 1; #endif /* NBIVIDEO > 0 */ } static void mq200_update_powerstate(struct mq200_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 void mq200_power(int why, void *arg) { struct mq200_softc *sc = arg; switch (why) { case PWR_SUSPEND: sc->sc_powerstate |= PWRSTAT_SUSPEND; mq200_update_powerstate(sc, PWRSTAT_ALL); break; case PWR_STANDBY: sc->sc_powerstate |= PWRSTAT_SUSPEND; mq200_update_powerstate(sc, PWRSTAT_ALL); break; case PWR_RESUME: sc->sc_powerstate &= ~PWRSTAT_SUSPEND; mq200_update_powerstate(sc, PWRSTAT_ALL); break; } } static int mq200_hardpower(void *ctx, int type, long id, void *msg) { struct mq200_softc *sc = ctx; int why = (int)msg; switch (why) { case PWR_SUSPEND: sc->sc_mq200pwstate = MQ200_POWERSTATE_D2; break; case PWR_STANDBY: sc->sc_mq200pwstate = MQ200_POWERSTATE_D3; break; case PWR_RESUME: sc->sc_mq200pwstate = MQ200_POWERSTATE_D0; break; } bus_space_write_4(sc->sc_iot, sc->sc_ioh, MQ200_PMCSR, sc->sc_mq200pwstate); /* * you should wait until the * power state transit sequence will end. */ { unsigned long tmp; do { tmp = bus_space_read_4(sc->sc_iot, sc->sc_ioh, MQ200_PMCSR); } while ((tmp & 0x3) != (sc->sc_mq200pwstate & 0x3)); delay(100000); /* XXX */ } return (0); } static int mq200_fbinit(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 = mips_ptob(mips_btop(bootinfo->fb_addr)); fb->hf_offset = (u_long)bootinfo->fb_addr - fb->hf_baseaddr; /* 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) { /* * monochrome */ case BIFB_D1_M2L_1: fb->hf_access_flags |= HPCFB_ACCESS_REVERSE; /* fall through */ case BIFB_D1_M2L_0: fb->hf_class = HPCFB_CLASS_GRAYSCALE; fb->hf_access_flags |= HPCFB_ACCESS_STATIC; fb->hf_pack_width = 8; fb->hf_pixels_per_pack = 8; fb->hf_pixel_width = 1; fb->hf_class_data_length = sizeof(struct hf_gray_tag); fb->hf_u.hf_gray.hf_flags = 0; /* reserved for future use */ break; /* * 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; fb->hf_order_flags = HPCFB_REVORDER_BYTE; 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("unknown type (=%d).\n", bootinfo->fb_type); return (-1); break; } return (0); /* no error */ } int mq200_ioctl(void *v, u_long cmd, void *data, int flag, struct lwp *l) { struct mq200_softc *sc = (struct mq200_softc *)v; struct hpcfb_fbconf *fbconf; struct hpcfb_dspconf *dspconf; struct wsdisplay_cmap *cmap; struct wsdisplay_param *dispparam; 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 || 256 <= cmap->index || 256 - cmap->index < cmap->count) return (EINVAL); /* * This driver can't get color map. */ return (EINVAL); 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; mq200_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("ioctl: GET:BACKLIGHT\n"); mq200_init_brightness(sc, 0); mq200_init_backlight(sc, 0); VPRINTF("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("ioctl: GET:BACKLIGHT:%d(%s)\n", dispparam->curval, sc->sc_max_brightness > 0? "brightness": "light"); return 0; break; case WSDISPLAYIO_PARAM_CONTRAST: VPRINTF("ioctl: GET:CONTRAST\n"); mq200_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("ioctl: GET:CONTRAST" " max=%d, current=%d\n", sc->sc_max_contrast, sc->sc_contrast); return 0; } else { VPRINTF("ioctl: GET:CONTRAST EINVAL\n"); return (EINVAL); } break; case WSDISPLAYIO_PARAM_BRIGHTNESS: VPRINTF("ioctl: GET:BRIGHTNESS\n"); mq200_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("ioctl: GET:BRIGHTNESS" " max=%d, current=%d\n", sc->sc_max_brightness, sc->sc_brightness); return 0; } else { VPRINTF("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("ioctl: SET:BACKLIGHT\n"); if (dispparam->curval < 0 || 1 < dispparam->curval) return (EINVAL); mq200_init_brightness(sc, 0); VPRINTF("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; mq200_set_brightness(sc, 0); /* min */ } else { if (sc->sc_brightness_save == 0) sc->sc_brightness_save = sc->sc_max_brightness; mq200_set_brightness(sc, sc->sc_brightness_save); } VPRINTF("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("ioctl: SET:BACKLIGHT:" " powerstate %d\n", (sc->sc_powerstate & PWRSTAT_BACKLIGHT) ? 1 : 0); mq200_update_powerstate(sc, PWRSTAT_BACKLIGHT); VPRINTF("ioctl: SET:BACKLIGHT:%d\n", (sc->sc_powerstate & PWRSTAT_BACKLIGHT) ? 1 : 0); } return 0; break; case WSDISPLAYIO_PARAM_CONTRAST: VPRINTF("ioctl: SET:CONTRAST\n"); mq200_init_contrast(sc, 0); if (dispparam->curval < 0 || sc->sc_max_contrast < dispparam->curval) return (EINVAL); if (sc->sc_max_contrast > 0) { int org = sc->sc_contrast; mq200_set_contrast(sc, dispparam->curval); VPRINTF("ioctl: SET:CONTRAST" " org=%d, current=%d\n", org, sc->sc_contrast); VPRINTF("ioctl: SETPARAM:" " CONTRAST org=%d, current=%d\n", org, sc->sc_contrast); return 0; } else { VPRINTF("ioctl: SET:CONTRAST EINVAL\n"); return (EINVAL); } break; case WSDISPLAYIO_PARAM_BRIGHTNESS: VPRINTF("ioctl: SET:BRIGHTNESS\n"); mq200_init_brightness(sc, 0); if (dispparam->curval < 0 || sc->sc_max_brightness < dispparam->curval) return (EINVAL); if (sc->sc_max_brightness > 0) { int org = sc->sc_brightness; mq200_set_brightness(sc, dispparam->curval); VPRINTF("ioctl: SET:BRIGHTNESS" " org=%d, current=%d\n", org, sc->sc_brightness); return 0; } else { VPRINTF("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: /* * currently not implemented... */ return (EINVAL); } return (EPASSTHROUGH); } paddr_t mq200_mmap(void *ctx, off_t offset, int prot) { struct mq200_softc *sc = (struct mq200_softc *)ctx; if (offset < 0 || MQ200_MAPSIZE <= offset) return -1; return mips_btop(sc->sc_baseaddr + offset); } void mq200_init_backlight(struct mq200_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("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 mq200_init_brightness(struct mq200_softc *sc, int inattach) { int val = -1; if (sc->sc_lcd_inited&BRIGHTNESS_INITED) return; VPRINTF("init_brightness\n"); if (config_hook_call(CONFIG_HOOK_GET, CONFIG_HOOK_BRIGHTNESS_MAX, &val) != -1) { /* we can get real brightness max */ VPRINTF("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("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 mq200_init_contrast(struct mq200_softc *sc, int inattach) { int val = -1; if (sc->sc_lcd_inited&CONTRAST_INITED) return; VPRINTF("init_contrast\n"); if (config_hook_call(CONFIG_HOOK_GET, CONFIG_HOOK_CONTRAST_MAX, &val) != -1) { /* we can get real contrast max */ VPRINTF("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("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 mq200_set_brightness(struct mq200_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 mq200_set_contrast(struct mq200_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; } }