Home | History | Annotate | Line # | Download | only in hpc
bivideo.c revision 1.9
      1  1.9  toshii /*	$NetBSD: bivideo.c,v 1.9 2001/07/07 09:19:39 toshii Exp $	*/
      2  1.1     uch 
      3  1.1     uch /*-
      4  1.2     uch  * Copyright (c) 1999-2001
      5  1.1     uch  *         Shin Takemura and PocketBSD Project. All rights reserved.
      6  1.1     uch  *
      7  1.1     uch  * Redistribution and use in source and binary forms, with or without
      8  1.1     uch  * modification, are permitted provided that the following conditions
      9  1.1     uch  * are met:
     10  1.1     uch  * 1. Redistributions of source code must retain the above copyright
     11  1.1     uch  *    notice, this list of conditions and the following disclaimer.
     12  1.1     uch  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1     uch  *    notice, this list of conditions and the following disclaimer in the
     14  1.1     uch  *    documentation and/or other materials provided with the distribution.
     15  1.1     uch  * 3. All advertising materials mentioning features or use of this software
     16  1.1     uch  *    must display the following acknowledgement:
     17  1.1     uch  *	This product includes software developed by the PocketBSD project
     18  1.1     uch  *	and its contributors.
     19  1.1     uch  * 4. Neither the name of the project nor the names of its contributors
     20  1.1     uch  *    may be used to endorse or promote products derived from this software
     21  1.1     uch  *    without specific prior written permission.
     22  1.1     uch  *
     23  1.1     uch  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     24  1.1     uch  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     25  1.1     uch  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     26  1.1     uch  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     27  1.1     uch  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     28  1.1     uch  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     29  1.1     uch  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     30  1.1     uch  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     31  1.1     uch  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     32  1.1     uch  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     33  1.1     uch  * SUCH DAMAGE.
     34  1.1     uch  *
     35  1.1     uch  */
     36  1.1     uch #define FBDEBUG
     37  1.1     uch static const char _copyright[] __attribute__ ((unused)) =
     38  1.1     uch     "Copyright (c) 1999 Shin Takemura.  All rights reserved.";
     39  1.1     uch static const char _rcsid[] __attribute__ ((unused)) =
     40  1.9  toshii     "$NetBSD: bivideo.c,v 1.9 2001/07/07 09:19:39 toshii Exp $";
     41  1.1     uch 
     42  1.1     uch #include <sys/param.h>
     43  1.1     uch #include <sys/systm.h>
     44  1.1     uch #include <sys/device.h>
     45  1.1     uch #include <sys/buf.h>
     46  1.1     uch #include <sys/ioctl.h>
     47  1.1     uch #include <sys/reboot.h>
     48  1.1     uch 
     49  1.1     uch #include <uvm/uvm_extern.h>
     50  1.1     uch 
     51  1.1     uch #include <machine/bus.h>
     52  1.1     uch #include <machine/autoconf.h>
     53  1.1     uch #include <machine/bootinfo.h>
     54  1.1     uch #include <machine/config_hook.h>
     55  1.1     uch 
     56  1.1     uch #include <dev/wscons/wsconsio.h>
     57  1.1     uch #include <dev/wscons/wsdisplayvar.h>
     58  1.1     uch 
     59  1.1     uch #include <dev/rasops/rasops.h>
     60  1.1     uch 
     61  1.1     uch #include <dev/hpc/hpcfbvar.h>
     62  1.1     uch #include <dev/hpc/hpcfbio.h>
     63  1.1     uch #include <dev/hpc/bivideovar.h>
     64  1.1     uch #include <dev/hpc/hpccmapvar.h>
     65  1.1     uch 
     66  1.1     uch #define VPRINTF(arg)	do { if (bootverbose) printf arg; } while(0);
     67  1.1     uch 
     68  1.1     uch /*
     69  1.1     uch  *  global variables
     70  1.1     uch  */
     71  1.1     uch int bivideo_dont_attach = 0;
     72  1.1     uch 
     73  1.1     uch /*
     74  1.1     uch  *  function prototypes
     75  1.1     uch  */
     76  1.2     uch int	bivideomatch(struct device *, struct cfdata *, void *);
     77  1.2     uch void	bivideoattach(struct device *, struct device *, void *);
     78  1.2     uch int	bivideo_ioctl(void *, u_long, caddr_t, int, struct proc *);
     79  1.2     uch paddr_t	bivideo_mmap(void *, off_t, int);
     80  1.1     uch 
     81  1.1     uch struct bivideo_softc {
     82  1.1     uch 	struct device		sc_dev;
     83  1.1     uch 	struct hpcfb_fbconf	sc_fbconf;
     84  1.1     uch 	struct hpcfb_dspconf	sc_dspconf;
     85  1.1     uch 	void			*sc_powerhook;	/* power management hook */
     86  1.1     uch 	int			sc_powerstate;
     87  1.1     uch #define PWRSTAT_SUSPEND		(1<<0)
     88  1.4    sato #define PWRSTAT_VIDEOOFF	(1<<1)
     89  1.4    sato #define PWRSTAT_LCD		(1<<2)
     90  1.4    sato #define PWRSTAT_BACKLIGHT	(1<<3)
     91  1.1     uch #define PWRSTAT_ALL		(0xffffffff)
     92  1.6    sato 	int			sc_lcd_inited;
     93  1.6    sato #define BACKLIGHT_INITED	(1<<0)
     94  1.6    sato #define BRIGHTNESS_INITED	(1<<1)
     95  1.6    sato #define CONTRAST_INITED		(1<<2)
     96  1.3    sato 	int			sc_brightness;
     97  1.3    sato 	int			sc_brightness_save;
     98  1.3    sato 	int			sc_max_brightness;
     99  1.3    sato 	int			sc_contrast;
    100  1.3    sato 	int			sc_max_contrast;
    101  1.3    sato 
    102  1.1     uch };
    103  1.3    sato 
    104  1.2     uch static int bivideo_init(struct hpcfb_fbconf *);
    105  1.2     uch static void bivideo_power(int, void *);
    106  1.2     uch static void bivideo_update_powerstate(struct bivideo_softc *, int);
    107  1.6    sato void	bivideo_init_backlight(struct bivideo_softc *, int);
    108  1.6    sato void	bivideo_init_brightness(struct bivideo_softc *, int);
    109  1.6    sato void	bivideo_init_contrast(struct bivideo_softc *, int);
    110  1.3    sato void	bivideo_set_brightness(struct bivideo_softc *, int);
    111  1.3    sato void	bivideo_set_contrast(struct bivideo_softc *, int);
    112  1.2     uch 
    113  1.2     uch #if defined __mips__ || defined __sh__ || defined __arm__
    114  1.2     uch #define __BTOP(x)		((paddr_t)(x) >> PGSHIFT)
    115  1.2     uch #define __PTOB(x)		((paddr_t)(x) << PGSHIFT)
    116  1.2     uch #else
    117  1.2     uch #error "define btop, ptob."
    118  1.2     uch #endif
    119  1.1     uch 
    120  1.1     uch /*
    121  1.1     uch  *  static variables
    122  1.1     uch  */
    123  1.1     uch struct cfattach bivideo_ca = {
    124  1.1     uch 	sizeof(struct bivideo_softc), bivideomatch, bivideoattach,
    125  1.1     uch };
    126  1.1     uch struct hpcfb_accessops bivideo_ha = {
    127  1.1     uch 	bivideo_ioctl, bivideo_mmap
    128  1.1     uch };
    129  1.1     uch 
    130  1.1     uch static int console_flag = 0;
    131  1.1     uch static int attach_flag = 0;
    132  1.1     uch 
    133  1.1     uch /*
    134  1.1     uch  *  function bodies
    135  1.1     uch  */
    136  1.1     uch int
    137  1.2     uch bivideomatch(struct device *parent, struct cfdata *match, void *aux)
    138  1.1     uch {
    139  1.1     uch 	struct mainbus_attach_args *ma = aux;
    140  1.1     uch 
    141  1.1     uch 	if (bivideo_dont_attach ||
    142  1.1     uch 	    strcmp(ma->ma_name, match->cf_driver->cd_name))
    143  1.1     uch 		return 0;
    144  1.1     uch 
    145  1.1     uch 	return (1);
    146  1.1     uch }
    147  1.1     uch 
    148  1.1     uch void
    149  1.2     uch bivideoattach(struct device *parent, struct device *self, void *aux)
    150  1.1     uch {
    151  1.1     uch 	struct bivideo_softc *sc = (struct bivideo_softc *)self;
    152  1.1     uch 	struct hpcfb_attach_args ha;
    153  1.1     uch 
    154  1.1     uch 	if (attach_flag) {
    155  1.1     uch 		panic("%s(%d): bivideo attached twice", __FILE__, __LINE__);
    156  1.1     uch 	}
    157  1.1     uch 	attach_flag = 1;
    158  1.1     uch 
    159  1.1     uch 	printf(": ");
    160  1.1     uch 	if (bivideo_init(&sc->sc_fbconf) != 0) {
    161  1.1     uch 		/* just return so that hpcfb will not be attached */
    162  1.1     uch 		return;
    163  1.1     uch 	}
    164  1.1     uch 
    165  1.1     uch 	printf("pseudo video controller");
    166  1.1     uch 	if (console_flag) {
    167  1.1     uch 		printf(", console");
    168  1.1     uch 	}
    169  1.1     uch 	printf("\n");
    170  1.1     uch 	printf("%s: framebuffer address: 0x%08lx\n",
    171  1.1     uch 		sc->sc_dev.dv_xname, (u_long)bootinfo->fb_addr);
    172  1.1     uch 
    173  1.1     uch 	/* Add a suspend hook to power saving */
    174  1.1     uch 	sc->sc_powerstate = 0;
    175  1.1     uch 	sc->sc_powerhook = powerhook_establish(bivideo_power, sc);
    176  1.1     uch 	if (sc->sc_powerhook == NULL)
    177  1.1     uch 		printf("%s: WARNING: unable to establish power hook\n",
    178  1.1     uch 			sc->sc_dev.dv_xname);
    179  1.1     uch 
    180  1.3    sato 	/* initialize backlight brightness and lcd contrast */
    181  1.6    sato 	sc->sc_lcd_inited = 0;
    182  1.6    sato 	bivideo_init_brightness(sc, 1);
    183  1.6    sato 	bivideo_init_contrast(sc, 1);
    184  1.6    sato 	bivideo_init_backlight(sc, 1);
    185  1.3    sato 
    186  1.1     uch 	ha.ha_console = console_flag;
    187  1.1     uch 	ha.ha_accessops = &bivideo_ha;
    188  1.1     uch 	ha.ha_accessctx = sc;
    189  1.1     uch 	ha.ha_curfbconf = 0;
    190  1.1     uch 	ha.ha_nfbconf = 1;
    191  1.1     uch 	ha.ha_fbconflist = &sc->sc_fbconf;
    192  1.1     uch 	ha.ha_curdspconf = 0;
    193  1.1     uch 	ha.ha_ndspconf = 1;
    194  1.1     uch 	ha.ha_dspconflist = &sc->sc_dspconf;
    195  1.1     uch 
    196  1.1     uch 	config_found(self, &ha, hpcfbprint);
    197  1.1     uch }
    198  1.1     uch 
    199  1.1     uch int
    200  1.2     uch bivideo_getcnfb(struct hpcfb_fbconf *fb)
    201  1.1     uch {
    202  1.1     uch 	console_flag = 1;
    203  1.1     uch 
    204  1.1     uch 	return bivideo_init(fb);
    205  1.1     uch }
    206  1.1     uch 
    207  1.1     uch static int
    208  1.2     uch bivideo_init(struct hpcfb_fbconf *fb)
    209  1.1     uch {
    210  1.1     uch 	/*
    211  1.1     uch 	 * get fb settings from bootinfo
    212  1.1     uch 	 */
    213  1.1     uch 	if (bootinfo == NULL ||
    214  1.1     uch 	    bootinfo->fb_addr == 0 ||
    215  1.1     uch 	    bootinfo->fb_line_bytes == 0 ||
    216  1.1     uch 	    bootinfo->fb_width == 0 ||
    217  1.1     uch 	    bootinfo->fb_height == 0) {
    218  1.1     uch 		printf("no frame buffer infomation.\n");
    219  1.1     uch 		return (-1);
    220  1.1     uch 	}
    221  1.1     uch 
    222  1.1     uch 	/* zero fill */
    223  1.9  toshii 	memset(fb, 0, sizeof(*fb));
    224  1.1     uch 
    225  1.1     uch 	fb->hf_conf_index	= 0;	/* configuration index		*/
    226  1.1     uch 	fb->hf_nconfs		= 1;   	/* how many configurations	*/
    227  1.1     uch 	strcpy(fb->hf_name, "built-in video");
    228  1.1     uch 					/* frame buffer name		*/
    229  1.1     uch 	strcpy(fb->hf_conf_name, "default");
    230  1.1     uch 					/* configuration name		*/
    231  1.1     uch 	fb->hf_height		= bootinfo->fb_height;
    232  1.1     uch 	fb->hf_width		= bootinfo->fb_width;
    233  1.1     uch 	fb->hf_baseaddr		= (u_long)bootinfo->fb_addr;
    234  1.1     uch 	fb->hf_offset		= (u_long)bootinfo->fb_addr -
    235  1.2     uch 				      __PTOB(__BTOP(bootinfo->fb_addr));
    236  1.1     uch 					/* frame buffer start offset   	*/
    237  1.1     uch 	fb->hf_bytes_per_line	= bootinfo->fb_line_bytes;
    238  1.1     uch 	fb->hf_nplanes		= 1;
    239  1.1     uch 	fb->hf_bytes_per_plane	= bootinfo->fb_height *
    240  1.1     uch 					bootinfo->fb_line_bytes;
    241  1.1     uch 
    242  1.1     uch 	fb->hf_access_flags |= HPCFB_ACCESS_BYTE;
    243  1.1     uch 	fb->hf_access_flags |= HPCFB_ACCESS_WORD;
    244  1.1     uch 	fb->hf_access_flags |= HPCFB_ACCESS_DWORD;
    245  1.1     uch 
    246  1.1     uch 	switch (bootinfo->fb_type) {
    247  1.1     uch 		/*
    248  1.1     uch 		 * gray scale
    249  1.1     uch 		 */
    250  1.1     uch 	case BIFB_D2_M2L_3:
    251  1.1     uch 	case BIFB_D2_M2L_3x2:
    252  1.1     uch 		fb->hf_access_flags |= HPCFB_ACCESS_REVERSE;
    253  1.1     uch 		/* fall through */
    254  1.1     uch 	case BIFB_D2_M2L_0:
    255  1.1     uch 	case BIFB_D2_M2L_0x2:
    256  1.1     uch 		fb->hf_class = HPCFB_CLASS_GRAYSCALE;
    257  1.1     uch 		fb->hf_access_flags |= HPCFB_ACCESS_STATIC;
    258  1.1     uch 		fb->hf_pack_width = 8;
    259  1.1     uch 		fb->hf_pixels_per_pack = 4;
    260  1.1     uch 		fb->hf_pixel_width = 2;
    261  1.1     uch 		fb->hf_class_data_length = sizeof(struct hf_gray_tag);
    262  1.1     uch 		fb->hf_u.hf_gray.hf_flags = 0;	/* reserved for future use */
    263  1.1     uch 		break;
    264  1.1     uch 
    265  1.1     uch 	case BIFB_D4_M2L_F:
    266  1.1     uch 	case BIFB_D4_M2L_Fx2:
    267  1.1     uch 		fb->hf_access_flags |= HPCFB_ACCESS_REVERSE;
    268  1.1     uch 		/* fall through */
    269  1.1     uch 	case BIFB_D4_M2L_0:
    270  1.1     uch 	case BIFB_D4_M2L_0x2:
    271  1.1     uch 		fb->hf_class = HPCFB_CLASS_GRAYSCALE;
    272  1.1     uch 		fb->hf_access_flags |= HPCFB_ACCESS_STATIC;
    273  1.1     uch 		fb->hf_pack_width = 8;
    274  1.1     uch 		fb->hf_pixels_per_pack = 2;
    275  1.1     uch 		fb->hf_pixel_width = 4;
    276  1.1     uch 		fb->hf_class_data_length = sizeof(struct hf_gray_tag);
    277  1.1     uch 		fb->hf_u.hf_gray.hf_flags = 0;	/* reserved for future use */
    278  1.1     uch 		break;
    279  1.1     uch 
    280  1.1     uch 		/*
    281  1.1     uch 		 * indexed color
    282  1.1     uch 		 */
    283  1.1     uch 	case BIFB_D8_FF:
    284  1.1     uch 		fb->hf_access_flags |= HPCFB_ACCESS_REVERSE;
    285  1.1     uch 		/* fall through */
    286  1.1     uch 	case BIFB_D8_00:
    287  1.1     uch 		fb->hf_class = HPCFB_CLASS_INDEXCOLOR;
    288  1.1     uch 		fb->hf_access_flags |= HPCFB_ACCESS_STATIC;
    289  1.1     uch 		fb->hf_pack_width = 8;
    290  1.1     uch 		fb->hf_pixels_per_pack = 1;
    291  1.1     uch 		fb->hf_pixel_width = 8;
    292  1.1     uch 		fb->hf_class_data_length = sizeof(struct hf_indexed_tag);
    293  1.1     uch 		fb->hf_u.hf_indexed.hf_flags = 0; /* reserved for future use */
    294  1.1     uch 		break;
    295  1.1     uch 
    296  1.1     uch 		/*
    297  1.1     uch 		 * RGB color
    298  1.1     uch 		 */
    299  1.1     uch 	case BIFB_D16_FFFF:
    300  1.1     uch 		fb->hf_access_flags |= HPCFB_ACCESS_REVERSE;
    301  1.1     uch 		/* fall through */
    302  1.1     uch 	case BIFB_D16_0000:
    303  1.1     uch 		fb->hf_class = HPCFB_CLASS_RGBCOLOR;
    304  1.1     uch 		fb->hf_access_flags |= HPCFB_ACCESS_STATIC;
    305  1.8    sato #if BYTE_ORDER == BIG_ENDIAN /* XXXX */
    306  1.1     uch 		fb->hf_swap_flags = HPCFB_SWAP_BYTE;
    307  1.1     uch #endif
    308  1.1     uch 		fb->hf_pack_width = 16;
    309  1.1     uch 		fb->hf_pixels_per_pack = 1;
    310  1.1     uch 		fb->hf_pixel_width = 16;
    311  1.1     uch 
    312  1.1     uch 		fb->hf_class_data_length = sizeof(struct hf_rgb_tag);
    313  1.1     uch 		fb->hf_u.hf_rgb.hf_flags = 0;	/* reserved for future use */
    314  1.1     uch 
    315  1.1     uch 		fb->hf_u.hf_rgb.hf_red_width = 5;
    316  1.1     uch 		fb->hf_u.hf_rgb.hf_red_shift = 11;
    317  1.1     uch 		fb->hf_u.hf_rgb.hf_green_width = 6;
    318  1.1     uch 		fb->hf_u.hf_rgb.hf_green_shift = 5;
    319  1.1     uch 		fb->hf_u.hf_rgb.hf_blue_width = 5;
    320  1.1     uch 		fb->hf_u.hf_rgb.hf_blue_shift = 0;
    321  1.1     uch 		fb->hf_u.hf_rgb.hf_alpha_width = 0;
    322  1.1     uch 		fb->hf_u.hf_rgb.hf_alpha_shift = 0;
    323  1.1     uch 		break;
    324  1.1     uch 
    325  1.1     uch 	default:
    326  1.1     uch 		printf("unsupported type %d.\n", bootinfo->fb_type);
    327  1.1     uch 		return (-1);
    328  1.1     uch 		break;
    329  1.1     uch 	}
    330  1.1     uch 
    331  1.1     uch 	return (0); /* no error */
    332  1.1     uch }
    333  1.1     uch 
    334  1.1     uch static void
    335  1.2     uch bivideo_power(int why, void *arg)
    336  1.1     uch {
    337  1.1     uch 	struct bivideo_softc *sc = arg;
    338  1.1     uch 
    339  1.1     uch 	switch (why) {
    340  1.1     uch 	case PWR_SUSPEND:
    341  1.1     uch 	case PWR_STANDBY:
    342  1.1     uch 		sc->sc_powerstate |= PWRSTAT_SUSPEND;
    343  1.1     uch 		bivideo_update_powerstate(sc, PWRSTAT_ALL);
    344  1.1     uch 		break;
    345  1.1     uch 	case PWR_RESUME:
    346  1.1     uch 		sc->sc_powerstate &= ~PWRSTAT_SUSPEND;
    347  1.1     uch 		bivideo_update_powerstate(sc, PWRSTAT_ALL);
    348  1.1     uch 		break;
    349  1.1     uch 	}
    350  1.1     uch }
    351  1.1     uch 
    352  1.1     uch static void
    353  1.2     uch bivideo_update_powerstate(struct bivideo_softc *sc, int updates)
    354  1.1     uch {
    355  1.1     uch 	if (updates & PWRSTAT_LCD)
    356  1.1     uch 		config_hook_call(CONFIG_HOOK_POWERCONTROL,
    357  1.1     uch 		    CONFIG_HOOK_POWERCONTROL_LCD,
    358  1.4    sato 		    (void*)!(sc->sc_powerstate &
    359  1.4    sato 				(PWRSTAT_VIDEOOFF|PWRSTAT_SUSPEND)));
    360  1.1     uch 
    361  1.1     uch 	if (updates & PWRSTAT_BACKLIGHT)
    362  1.1     uch 		config_hook_call(CONFIG_HOOK_POWERCONTROL,
    363  1.1     uch 		    CONFIG_HOOK_POWERCONTROL_LCDLIGHT,
    364  1.4    sato 		    (void*)(!(sc->sc_powerstate &
    365  1.4    sato 				(PWRSTAT_VIDEOOFF|PWRSTAT_SUSPEND)) &&
    366  1.1     uch 			     (sc->sc_powerstate & PWRSTAT_BACKLIGHT)));
    367  1.1     uch }
    368  1.1     uch 
    369  1.1     uch int
    370  1.2     uch bivideo_ioctl(void *v, u_long cmd, caddr_t data, int flag, struct proc *p)
    371  1.1     uch {
    372  1.1     uch 	struct bivideo_softc *sc = (struct bivideo_softc *)v;
    373  1.1     uch 	struct hpcfb_fbconf *fbconf;
    374  1.1     uch 	struct hpcfb_dspconf *dspconf;
    375  1.1     uch 	struct wsdisplay_cmap *cmap;
    376  1.1     uch 	struct wsdisplay_param *dispparam;
    377  1.1     uch 
    378  1.1     uch 	switch (cmd) {
    379  1.1     uch 	case WSDISPLAYIO_GETCMAP:
    380  1.1     uch 		cmap = (struct wsdisplay_cmap*)data;
    381  1.1     uch 
    382  1.1     uch 		if (sc->sc_fbconf.hf_class != HPCFB_CLASS_INDEXCOLOR ||
    383  1.1     uch 		    sc->sc_fbconf.hf_pack_width != 8 ||
    384  1.1     uch 		    256 <= cmap->index ||
    385  1.1     uch 		    256 < (cmap->index + cmap->count))
    386  1.1     uch 			return (EINVAL);
    387  1.1     uch 
    388  1.1     uch 		if (!uvm_useracc(cmap->red, cmap->count, B_WRITE) ||
    389  1.1     uch 		    !uvm_useracc(cmap->green, cmap->count, B_WRITE) ||
    390  1.1     uch 		    !uvm_useracc(cmap->blue, cmap->count, B_WRITE))
    391  1.1     uch 			return (EFAULT);
    392  1.1     uch 
    393  1.1     uch 		copyout(&bivideo_cmap_r[cmap->index], cmap->red, cmap->count);
    394  1.1     uch 		copyout(&bivideo_cmap_g[cmap->index], cmap->green,cmap->count);
    395  1.1     uch 		copyout(&bivideo_cmap_b[cmap->index], cmap->blue, cmap->count);
    396  1.1     uch 
    397  1.1     uch 		return (0);
    398  1.1     uch 
    399  1.1     uch 	case WSDISPLAYIO_PUTCMAP:
    400  1.1     uch 		/*
    401  1.1     uch 		 * This driver can't set color map.
    402  1.1     uch 		 */
    403  1.1     uch 		return (EINVAL);
    404  1.4    sato 
    405  1.4    sato 	case WSDISPLAYIO_SVIDEO:
    406  1.4    sato 		if (*(int *)data == WSDISPLAYIO_VIDEO_OFF)
    407  1.4    sato 			sc->sc_powerstate |= PWRSTAT_VIDEOOFF;
    408  1.4    sato 		else
    409  1.4    sato 			sc->sc_powerstate &= ~PWRSTAT_VIDEOOFF;
    410  1.4    sato 		bivideo_update_powerstate(sc, PWRSTAT_ALL);
    411  1.4    sato 		return 0;
    412  1.4    sato 
    413  1.4    sato 	case WSDISPLAYIO_GVIDEO:
    414  1.4    sato 		*(int *)data = (sc->sc_powerstate&PWRSTAT_VIDEOOFF) ?
    415  1.4    sato 				WSDISPLAYIO_VIDEO_OFF:WSDISPLAYIO_VIDEO_ON;
    416  1.4    sato 		return 0;
    417  1.1     uch 
    418  1.3    sato 
    419  1.1     uch 	case WSDISPLAYIO_GETPARAM:
    420  1.1     uch 		dispparam = (struct wsdisplay_param*)data;
    421  1.1     uch 		switch (dispparam->param) {
    422  1.1     uch 		case WSDISPLAYIO_PARAM_BACKLIGHT:
    423  1.6    sato 			VPRINTF(("bivideo_ioctl: GET:BACKLIGHT\n"));
    424  1.6    sato 			bivideo_init_brightness(sc, 0);
    425  1.6    sato 			bivideo_init_backlight(sc, 0);
    426  1.6    sato 			VPRINTF(("bivideo_ioctl: GET:(real)BACKLIGHT %d\n",
    427  1.6    sato 				 (sc->sc_powerstate&PWRSTAT_BACKLIGHT)? 1: 0));
    428  1.1     uch 			dispparam->min = 0;
    429  1.1     uch 			dispparam->max = 1;
    430  1.3    sato 			if (sc->sc_max_brightness > 0)
    431  1.3    sato 				dispparam->curval = sc->sc_brightness > 0? 1: 0;
    432  1.3    sato 			else
    433  1.3    sato 				dispparam->curval =
    434  1.6    sato 				    (sc->sc_powerstate&PWRSTAT_BACKLIGHT) ? 1: 0;
    435  1.6    sato 			VPRINTF(("bivideo_ioctl: GET:BACKLIGHT:%d(%s)\n",
    436  1.6    sato 				dispparam->curval,
    437  1.6    sato 				sc->sc_max_brightness > 0? "brightness": "light"));
    438  1.3    sato 			return 0;
    439  1.1     uch 			break;
    440  1.1     uch 		case WSDISPLAYIO_PARAM_CONTRAST:
    441  1.6    sato 			VPRINTF(("bivideo_ioctl: GET:CONTRAST\n"));
    442  1.6    sato 			bivideo_init_contrast(sc, 0);
    443  1.3    sato 			if (sc->sc_max_contrast > 0) {
    444  1.3    sato 				dispparam->min = 0;
    445  1.3    sato 				dispparam->max = sc->sc_max_contrast;
    446  1.3    sato 				dispparam->curval = sc->sc_contrast;
    447  1.6    sato 				VPRINTF(("bivideo_ioctl: GET:CONTRAST max=%d, current=%d\n", sc->sc_max_contrast, sc->sc_contrast));
    448  1.3    sato 				return 0;
    449  1.3    sato 			} else {
    450  1.6    sato 				VPRINTF(("bivideo_ioctl: GET:CONTRAST EINVAL\n"));
    451  1.3    sato 				return (EINVAL);
    452  1.3    sato 			}
    453  1.3    sato 			break;
    454  1.1     uch 		case WSDISPLAYIO_PARAM_BRIGHTNESS:
    455  1.6    sato 			VPRINTF(("bivideo_ioctl: GET:BRIGHTNESS\n"));
    456  1.6    sato 			bivideo_init_brightness(sc, 0);
    457  1.3    sato 			if (sc->sc_max_brightness > 0) {
    458  1.3    sato 				dispparam->min = 0;
    459  1.3    sato 				dispparam->max = sc->sc_max_brightness;
    460  1.3    sato 				dispparam->curval = sc->sc_brightness;
    461  1.6    sato 				VPRINTF(("bivideo_ioctl: GET:BRIGHTNESS max=%d, current=%d\n", sc->sc_max_brightness, sc->sc_brightness));
    462  1.3    sato 				return 0;
    463  1.3    sato 			} else {
    464  1.6    sato 				VPRINTF(("bivideo_ioctl: GET:BRIGHTNESS EINVAL\n"));
    465  1.3    sato 				return (EINVAL);
    466  1.3    sato 			}
    467  1.1     uch 			return (EINVAL);
    468  1.1     uch 		default:
    469  1.1     uch 			return (EINVAL);
    470  1.1     uch 		}
    471  1.1     uch 		return (0);
    472  1.1     uch 
    473  1.1     uch 	case WSDISPLAYIO_SETPARAM:
    474  1.1     uch 		dispparam = (struct wsdisplay_param*)data;
    475  1.1     uch 		switch (dispparam->param) {
    476  1.1     uch 		case WSDISPLAYIO_PARAM_BACKLIGHT:
    477  1.6    sato 			VPRINTF(("bivideo_ioctl: SET:BACKLIGHT\n"));
    478  1.1     uch 			if (dispparam->curval < 0 ||
    479  1.1     uch 			    1 < dispparam->curval)
    480  1.1     uch 				return (EINVAL);
    481  1.6    sato 			bivideo_init_brightness(sc, 0);
    482  1.6    sato 			VPRINTF(("bivideo_ioctl: SET:max brightness=%d\n", sc->sc_max_brightness));
    483  1.3    sato 			if (sc->sc_max_brightness > 0) { /* dimmer */
    484  1.3    sato 				if (dispparam->curval == 0){
    485  1.3    sato 					sc->sc_brightness_save = sc->sc_brightness;
    486  1.3    sato 					bivideo_set_brightness(sc, 0);	/* min */
    487  1.3    sato 				} else {
    488  1.3    sato 					if (sc->sc_brightness_save == 0)
    489  1.3    sato 						sc->sc_brightness_save = sc->sc_max_brightness;
    490  1.3    sato 					bivideo_set_brightness(sc, sc->sc_brightness_save);
    491  1.3    sato 				}
    492  1.6    sato 				VPRINTF(("bivideo_ioctl: SET:BACKLIGHT:brightness=%d\n", sc->sc_brightness));
    493  1.3    sato 			} else { /* off */
    494  1.3    sato 				if (dispparam->curval == 0)
    495  1.3    sato 					sc->sc_powerstate &= ~PWRSTAT_BACKLIGHT;
    496  1.3    sato 				else
    497  1.3    sato 					sc->sc_powerstate |= PWRSTAT_BACKLIGHT;
    498  1.6    sato 				VPRINTF(("bivideo_ioctl: SET:BACKLIGHT:powerstate %d\n",
    499  1.3    sato 						(sc->sc_powerstate & PWRSTAT_BACKLIGHT)?1:0));
    500  1.3    sato 				bivideo_update_powerstate(sc, PWRSTAT_BACKLIGHT);
    501  1.6    sato 				VPRINTF(("bivideo_ioctl: SET:BACKLIGHT:%d\n",
    502  1.3    sato 					(sc->sc_powerstate & PWRSTAT_BACKLIGHT)?1:0));
    503  1.3    sato 			}
    504  1.3    sato 			return 0;
    505  1.1     uch 			break;
    506  1.1     uch 		case WSDISPLAYIO_PARAM_CONTRAST:
    507  1.6    sato 			VPRINTF(("bivideo_ioctl: SET:CONTRAST\n"));
    508  1.6    sato 			bivideo_init_contrast(sc, 0);
    509  1.3    sato 			if (dispparam->curval < 0 ||
    510  1.3    sato 			    sc->sc_max_contrast < dispparam->curval)
    511  1.3    sato 				return (EINVAL);
    512  1.3    sato 			if (sc->sc_max_contrast > 0) {
    513  1.3    sato 				int org = sc->sc_contrast;
    514  1.3    sato 				bivideo_set_contrast(sc, dispparam->curval);
    515  1.6    sato 				VPRINTF(("bivideo_ioctl: SET:CONTRAST org=%d, current=%d\n", org, sc->sc_contrast));
    516  1.3    sato 				return 0;
    517  1.3    sato 			} else {
    518  1.6    sato 				VPRINTF(("bivideo_ioctl: SET:CONTRAST EINVAL\n"));
    519  1.3    sato 				return (EINVAL);
    520  1.3    sato 			}
    521  1.3    sato 			break;
    522  1.1     uch 		case WSDISPLAYIO_PARAM_BRIGHTNESS:
    523  1.6    sato 			VPRINTF(("bivideo_ioctl: SET:BRIGHTNESS\n"));
    524  1.6    sato 			bivideo_init_brightness(sc, 0);
    525  1.3    sato 			if (dispparam->curval < 0 ||
    526  1.3    sato 			    sc->sc_max_brightness < dispparam->curval)
    527  1.3    sato 				return (EINVAL);
    528  1.3    sato 			if (sc->sc_max_brightness > 0) {
    529  1.3    sato 				int org = sc->sc_brightness;
    530  1.3    sato 				bivideo_set_brightness(sc, dispparam->curval);
    531  1.6    sato 				VPRINTF(("bivideo_ioctl: SET:BRIGHTNESS org=%d, current=%d\n", org, sc->sc_brightness));
    532  1.3    sato 				return 0;
    533  1.3    sato 			} else {
    534  1.6    sato 				VPRINTF(("bivideo_ioctl: SET:BRIGHTNESS EINVAL\n"));
    535  1.3    sato 				return (EINVAL);
    536  1.3    sato 			}
    537  1.3    sato 			break;
    538  1.1     uch 		default:
    539  1.1     uch 			return (EINVAL);
    540  1.1     uch 		}
    541  1.1     uch 		return (0);
    542  1.1     uch 
    543  1.1     uch 	case HPCFBIO_GCONF:
    544  1.1     uch 		fbconf = (struct hpcfb_fbconf *)data;
    545  1.1     uch 		if (fbconf->hf_conf_index != 0 &&
    546  1.1     uch 		    fbconf->hf_conf_index != HPCFB_CURRENT_CONFIG) {
    547  1.1     uch 			return (EINVAL);
    548  1.1     uch 		}
    549  1.1     uch 		*fbconf = sc->sc_fbconf;	/* structure assignment */
    550  1.1     uch 		return (0);
    551  1.1     uch 	case HPCFBIO_SCONF:
    552  1.1     uch 		fbconf = (struct hpcfb_fbconf *)data;
    553  1.1     uch 		if (fbconf->hf_conf_index != 0 &&
    554  1.1     uch 		    fbconf->hf_conf_index != HPCFB_CURRENT_CONFIG) {
    555  1.1     uch 			return (EINVAL);
    556  1.1     uch 		}
    557  1.1     uch 		/*
    558  1.1     uch 		 * nothing to do because we have only one configration
    559  1.1     uch 		 */
    560  1.1     uch 		return (0);
    561  1.1     uch 	case HPCFBIO_GDSPCONF:
    562  1.1     uch 		dspconf = (struct hpcfb_dspconf *)data;
    563  1.1     uch 		if ((dspconf->hd_unit_index != 0 &&
    564  1.1     uch 		     dspconf->hd_unit_index != HPCFB_CURRENT_UNIT) ||
    565  1.1     uch 		    (dspconf->hd_conf_index != 0 &&
    566  1.1     uch 		     dspconf->hd_conf_index != HPCFB_CURRENT_CONFIG)) {
    567  1.1     uch 			return (EINVAL);
    568  1.1     uch 		}
    569  1.1     uch 		*dspconf = sc->sc_dspconf;	/* structure assignment */
    570  1.1     uch 		return (0);
    571  1.1     uch 	case HPCFBIO_SDSPCONF:
    572  1.1     uch 		dspconf = (struct hpcfb_dspconf *)data;
    573  1.1     uch 		if ((dspconf->hd_unit_index != 0 &&
    574  1.1     uch 		     dspconf->hd_unit_index != HPCFB_CURRENT_UNIT) ||
    575  1.1     uch 		    (dspconf->hd_conf_index != 0 &&
    576  1.1     uch 		     dspconf->hd_conf_index != HPCFB_CURRENT_CONFIG)) {
    577  1.1     uch 			return (EINVAL);
    578  1.1     uch 		}
    579  1.1     uch 		/*
    580  1.1     uch 		 * nothing to do
    581  1.1     uch 		 * because we have only one unit and one configration
    582  1.1     uch 		 */
    583  1.1     uch 		return (0);
    584  1.1     uch 	case HPCFBIO_GOP:
    585  1.1     uch 	case HPCFBIO_SOP:
    586  1.1     uch 		/*
    587  1.1     uch 		 * curently not implemented...
    588  1.1     uch 		 */
    589  1.1     uch 		return (EINVAL);
    590  1.1     uch 	}
    591  1.1     uch 
    592  1.1     uch 	return (ENOTTY);
    593  1.1     uch }
    594  1.1     uch 
    595  1.1     uch paddr_t
    596  1.2     uch bivideo_mmap(void *ctx, off_t offset, int prot)
    597  1.1     uch {
    598  1.1     uch 	struct bivideo_softc *sc = (struct bivideo_softc *)ctx;
    599  1.1     uch 
    600  1.1     uch 	if (offset < 0 ||
    601  1.1     uch 	    (sc->sc_fbconf.hf_bytes_per_plane +
    602  1.1     uch 		sc->sc_fbconf.hf_offset) <  offset)
    603  1.1     uch 		return -1;
    604  1.1     uch 
    605  1.2     uch 	return __BTOP((u_long)bootinfo->fb_addr + offset);
    606  1.3    sato }
    607  1.3    sato 
    608  1.6    sato 
    609  1.3    sato void
    610  1.6    sato bivideo_init_backlight(struct bivideo_softc *sc, int inattach)
    611  1.3    sato {
    612  1.3    sato 	int val = -1;
    613  1.3    sato 
    614  1.6    sato 	if (sc->sc_lcd_inited&BACKLIGHT_INITED)
    615  1.6    sato 		return;
    616  1.6    sato 
    617  1.5    sato 	if (config_hook_call(CONFIG_HOOK_GET,
    618  1.5    sato 	     CONFIG_HOOK_POWER_LCDLIGHT, &val) != -1) {
    619  1.6    sato 		/* we can get real light state */
    620  1.6    sato 		VPRINTF(("bivideo_init_backlight: real backlight=%d\n", val));
    621  1.5    sato 		if (val == 0)
    622  1.5    sato 			sc->sc_powerstate &= ~PWRSTAT_BACKLIGHT;
    623  1.5    sato 		else
    624  1.5    sato 			sc->sc_powerstate |= PWRSTAT_BACKLIGHT;
    625  1.6    sato 		sc->sc_lcd_inited |= BACKLIGHT_INITED;
    626  1.6    sato 	} else if (inattach) {
    627  1.6    sato 		/*
    628  1.6    sato 		   we cannot get real light state in attach time
    629  1.6    sato 		   because light device not yet attached.
    630  1.6    sato 		   we will retry in !inattach.
    631  1.6    sato 		   temporary assume light is on.
    632  1.6    sato 		 */
    633  1.5    sato 		sc->sc_powerstate |= PWRSTAT_BACKLIGHT;
    634  1.6    sato 	} else {
    635  1.6    sato 		/* we cannot get real light state, so work by myself state */
    636  1.6    sato 		sc->sc_lcd_inited |= BACKLIGHT_INITED;
    637  1.6    sato 	}
    638  1.3    sato }
    639  1.3    sato 
    640  1.3    sato void
    641  1.6    sato bivideo_init_brightness(struct bivideo_softc *sc, int inattach)
    642  1.3    sato {
    643  1.3    sato 	int val = -1;
    644  1.3    sato 
    645  1.6    sato 	if (sc->sc_lcd_inited&BRIGHTNESS_INITED)
    646  1.6    sato 		return;
    647  1.6    sato 
    648  1.6    sato 	VPRINTF(("bivideo_init_brightness\n"));
    649  1.3    sato 	if (config_hook_call(CONFIG_HOOK_GET,
    650  1.3    sato 	     CONFIG_HOOK_BRIGHTNESS_MAX, &val) != -1) {
    651  1.6    sato 		/* we can get real brightness max */
    652  1.6    sato 		VPRINTF(("bivideo_init_brightness: real brightness max=%d\n", val));
    653  1.3    sato 		sc->sc_max_brightness = val;
    654  1.6    sato 		val = -1;
    655  1.6    sato 		if (config_hook_call(CONFIG_HOOK_GET,
    656  1.6    sato 		     CONFIG_HOOK_BRIGHTNESS, &val) != -1) {
    657  1.6    sato 			/* we can get real brightness */
    658  1.6    sato 			VPRINTF(("bivideo_init_brightness: real brightness=%d\n", val));
    659  1.6    sato 			sc->sc_brightness_save = sc->sc_brightness = val;
    660  1.6    sato 		} else {
    661  1.6    sato 			sc->sc_brightness_save =
    662  1.6    sato 			sc->sc_brightness = sc->sc_max_brightness;
    663  1.6    sato 		}
    664  1.6    sato 		sc->sc_lcd_inited |= BRIGHTNESS_INITED;
    665  1.6    sato 	} else if (inattach) {
    666  1.6    sato 		/*
    667  1.6    sato 		   we cannot get real brightness in attach time
    668  1.6    sato 		   because brightness device not yet attached.
    669  1.6    sato 		   we will retry in !inattach.
    670  1.6    sato 		 */
    671  1.6    sato 		sc->sc_max_brightness = -1;
    672  1.6    sato 		sc->sc_brightness = -1;
    673  1.6    sato 		sc->sc_brightness_save = -1;
    674  1.6    sato 	} else {
    675  1.6    sato 		/* we cannot get real brightness */
    676  1.6    sato 		sc->sc_lcd_inited |= BRIGHTNESS_INITED;
    677  1.3    sato 	}
    678  1.6    sato 
    679  1.3    sato 	return;
    680  1.3    sato }
    681  1.3    sato 
    682  1.3    sato void
    683  1.6    sato bivideo_init_contrast(struct bivideo_softc *sc, int inattach)
    684  1.3    sato {
    685  1.3    sato 	int val = -1;
    686  1.3    sato 
    687  1.6    sato 	if (sc->sc_lcd_inited&CONTRAST_INITED)
    688  1.6    sato 		return;
    689  1.6    sato 
    690  1.6    sato 	VPRINTF(("bivideo_init_contrast\n"));
    691  1.3    sato 	if (config_hook_call(CONFIG_HOOK_GET,
    692  1.3    sato 	     CONFIG_HOOK_CONTRAST_MAX, &val) != -1) {
    693  1.6    sato 		/* we can get real contrast max */
    694  1.6    sato 		VPRINTF(("bivideo_init_contrast: real contrast max=%d\n", val));
    695  1.3    sato 		sc->sc_max_contrast = val;
    696  1.6    sato 		val = -1;
    697  1.6    sato 		if (config_hook_call(CONFIG_HOOK_GET,
    698  1.6    sato 		     CONFIG_HOOK_CONTRAST, &val) != -1) {
    699  1.6    sato 			/* we can get real contrast */
    700  1.6    sato 			VPRINTF(("bivideo_init_contrast: real contrast=%d\n", val));
    701  1.6    sato 			sc->sc_contrast = val;
    702  1.6    sato 		} else {
    703  1.6    sato 			sc->sc_contrast = sc->sc_max_contrast;
    704  1.6    sato 		}
    705  1.6    sato 		sc->sc_lcd_inited |= CONTRAST_INITED;
    706  1.6    sato 	} else if (inattach) {
    707  1.6    sato 		/*
    708  1.6    sato 		   we cannot get real contrast in attach time
    709  1.6    sato 		   because contrast device not yet attached.
    710  1.6    sato 		   we will retry in !inattach.
    711  1.6    sato 		 */
    712  1.6    sato 		sc->sc_max_contrast = -1;
    713  1.6    sato 		sc->sc_contrast = -1;
    714  1.6    sato 	} else {
    715  1.6    sato 		/* we cannot get real contrast */
    716  1.6    sato 		sc->sc_lcd_inited |= CONTRAST_INITED;
    717  1.3    sato 	}
    718  1.6    sato 
    719  1.3    sato 	return;
    720  1.3    sato }
    721  1.3    sato 
    722  1.3    sato void
    723  1.3    sato bivideo_set_brightness(struct bivideo_softc *sc, int val)
    724  1.3    sato {
    725  1.3    sato 	sc->sc_brightness = val;
    726  1.3    sato 
    727  1.3    sato 	config_hook_call(CONFIG_HOOK_SET, CONFIG_HOOK_BRIGHTNESS, &val);
    728  1.3    sato 	if (config_hook_call(CONFIG_HOOK_GET,
    729  1.3    sato 	     CONFIG_HOOK_BRIGHTNESS, &val) != -1) {
    730  1.3    sato 		sc->sc_brightness = val;
    731  1.3    sato 	}
    732  1.3    sato }
    733  1.3    sato 
    734  1.3    sato void
    735  1.3    sato bivideo_set_contrast(struct bivideo_softc *sc, int val)
    736  1.3    sato {
    737  1.3    sato 	sc->sc_contrast = val;
    738  1.3    sato 
    739  1.3    sato 	config_hook_call(CONFIG_HOOK_SET, CONFIG_HOOK_CONTRAST, &val);
    740  1.3    sato 	if (config_hook_call(CONFIG_HOOK_GET,
    741  1.3    sato 	     CONFIG_HOOK_CONTRAST, &val) != -1) {
    742  1.3    sato 		sc->sc_contrast = val;
    743  1.3    sato 	}
    744  1.1     uch }
    745