Home | History | Annotate | Line # | Download | only in dev
mq200.c revision 1.6
      1  1.6      sato /*	$NetBSD: mq200.c,v 1.6 2001/01/05 09:09:48 sato Exp $	*/
      2  1.1  takemura 
      3  1.1  takemura /*-
      4  1.1  takemura  * Copyright (c) 2000 Takemura Shin
      5  1.1  takemura  * All rights reserved.
      6  1.1  takemura  *
      7  1.1  takemura  * Redistribution and use in source and binary forms, with or without
      8  1.1  takemura  * modification, are permitted provided that the following conditions
      9  1.1  takemura  * are met:
     10  1.1  takemura  * 1. Redistributions of source code must retain the above copyright
     11  1.1  takemura  *    notice, this list of conditions and the following disclaimer.
     12  1.1  takemura  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1  takemura  *    notice, this list of conditions and the following disclaimer in the
     14  1.1  takemura  *    documentation and/or other materials provided with the distribution.
     15  1.1  takemura  * 3. The name of the author may not be used to endorse or promote products
     16  1.1  takemura  *    derived from this software without specific prior written permission.
     17  1.1  takemura  *
     18  1.1  takemura  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     19  1.1  takemura  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     20  1.1  takemura  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     21  1.1  takemura  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     22  1.1  takemura  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     23  1.1  takemura  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     24  1.1  takemura  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     25  1.1  takemura  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     26  1.1  takemura  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     27  1.1  takemura  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     28  1.1  takemura  * SUCH DAMAGE.
     29  1.1  takemura  *
     30  1.1  takemura  */
     31  1.1  takemura 
     32  1.1  takemura #include <sys/param.h>
     33  1.1  takemura #include <sys/kernel.h>
     34  1.1  takemura #include <sys/device.h>
     35  1.1  takemura #include <sys/systm.h>
     36  1.2      sato #include <sys/reboot.h>
     37  1.1  takemura 
     38  1.1  takemura #include <uvm/uvm_extern.h>
     39  1.1  takemura 
     40  1.1  takemura #include <dev/wscons/wsconsio.h>
     41  1.1  takemura 
     42  1.1  takemura #include <machine/bootinfo.h>
     43  1.1  takemura #include <machine/bus.h>
     44  1.1  takemura #include <machine/autoconf.h>
     45  1.1  takemura #include <machine/config_hook.h>
     46  1.1  takemura #include <machine/platid.h>
     47  1.1  takemura #include <machine/platid_mask.h>
     48  1.1  takemura 
     49  1.1  takemura #include <hpcmips/dev/mq200reg.h>
     50  1.1  takemura #include <hpcmips/dev/mq200var.h>
     51  1.2      sato #include "bivideo.h"
     52  1.2      sato #if NBIVIDEO > 0
     53  1.2      sato #include <hpcmips/dev/bivideovar.h>
     54  1.2      sato #endif
     55  1.1  takemura 
     56  1.1  takemura #define MQ200DEBUG
     57  1.1  takemura #ifdef MQ200DEBUG
     58  1.1  takemura #ifndef MQ200DEBUG_CONF
     59  1.2      sato #define MQ200DEBUG_CONF 0
     60  1.1  takemura #endif
     61  1.1  takemura int	mq200_debug = MQ200DEBUG_CONF;
     62  1.1  takemura #define	DPRINTF(arg)     do { if (mq200_debug) printf arg; } while(0);
     63  1.1  takemura #define	DPRINTFN(n, arg) do { if (mq200_debug > (n)) printf arg; } while (0);
     64  1.2      sato #define	VPRINTF(arg)     do { if (bootverbose || mq200_debug) printf arg; } while(0);
     65  1.2      sato #define	VPRINTFN(n, arg) do { if (bootverbose || mq200_debug > (n)) printf arg; } while (0);
     66  1.1  takemura #else
     67  1.1  takemura #define	DPRINTF(arg)     do { } while (0);
     68  1.1  takemura #define DPRINTFN(n, arg) do { } while (0);
     69  1.2      sato #define	VPRINTF(arg)     do { if (bootverbose) printf arg; } while(0);
     70  1.2      sato #define	VPRINTFN(n, arg) do { if (bootverbose) printf arg; } while (0);
     71  1.1  takemura #endif
     72  1.1  takemura 
     73  1.1  takemura /*
     74  1.1  takemura  * function prototypes
     75  1.1  takemura  */
     76  1.1  takemura static void	mq200_power __P((int, void *));
     77  1.1  takemura static int	mq200_hardpower __P((void *, int, long, void *));
     78  1.1  takemura static int	mq200_fbinit __P((struct hpcfb_fbconf *));
     79  1.1  takemura static int	mq200_ioctl __P((void *, u_long, caddr_t, int, struct proc *));
     80  1.1  takemura static paddr_t	mq200_mmap __P((void *, off_t offset, int));
     81  1.1  takemura 
     82  1.1  takemura /*
     83  1.1  takemura  * static variables
     84  1.1  takemura  */
     85  1.1  takemura struct hpcfb_accessops mq200_ha = {
     86  1.1  takemura 	mq200_ioctl, mq200_mmap
     87  1.1  takemura };
     88  1.1  takemura 
     89  1.1  takemura int
     90  1.1  takemura mq200_probe(iot, ioh)
     91  1.1  takemura 	bus_space_tag_t iot;
     92  1.1  takemura 	bus_space_handle_t ioh;
     93  1.1  takemura {
     94  1.1  takemura 	unsigned long regval;
     95  1.1  takemura 
     96  1.2      sato #if NBIVIDEO > 0
     97  1.2      sato 	if (bivideo_dont_attach) /* some video driver already attached */
     98  1.2      sato 		return (0);
     99  1.2      sato #endif /* NBIVIDEO > 0 */
    100  1.2      sato 
    101  1.1  takemura 	regval = bus_space_read_4(iot, ioh, MQ200_PC00R);
    102  1.2      sato 	VPRINTF(("mq200 probe: vendor id=%04lx product id=%04lx\n",
    103  1.1  takemura 		 regval & 0xffff, (regval >> 16) & 0xffff));
    104  1.1  takemura 	if (regval != ((MQ200_PRODUCT_ID << 16) | MQ200_VENDOR_ID))
    105  1.1  takemura 		return (0);
    106  1.1  takemura 
    107  1.1  takemura 	return (1);
    108  1.1  takemura }
    109  1.1  takemura 
    110  1.1  takemura void
    111  1.1  takemura mq200_attach(sc)
    112  1.1  takemura 	struct mq200_softc *sc;
    113  1.1  takemura {
    114  1.1  takemura 	unsigned long regval;
    115  1.1  takemura 	struct hpcfb_attach_args ha;
    116  1.1  takemura 	int console = (bootinfo->bi_cnuse & BI_CNUSE_SERIAL) ? 0 : 1;
    117  1.1  takemura 
    118  1.1  takemura 	regval = bus_space_read_4(sc->sc_iot, sc->sc_ioh, MQ200_PC08R);
    119  1.1  takemura 	printf(": MQ200 Rev.%02lx video controller\n", regval & 0xff);
    120  1.1  takemura 
    121  1.1  takemura 	/* Add a power hook to power saving */
    122  1.1  takemura 	sc->sc_powerstate = MQ200_POWERSTATE_D0;
    123  1.1  takemura 	sc->sc_powerhook = powerhook_establish(mq200_power, sc);
    124  1.1  takemura 	if (sc->sc_powerhook == NULL)
    125  1.1  takemura 		printf("%s: WARNING: unable to establish power hook\n",
    126  1.1  takemura 			sc->sc_dev.dv_xname);
    127  1.1  takemura 
    128  1.1  takemura 	/* Add a hard power hook to power saving */
    129  1.1  takemura 	sc->sc_hardpowerhook = config_hook(CONFIG_HOOK_PMEVENT,
    130  1.1  takemura 					   CONFIG_HOOK_PMEVENT_HARDPOWER,
    131  1.1  takemura 					   CONFIG_HOOK_SHARE,
    132  1.1  takemura 					   mq200_hardpower, sc);
    133  1.1  takemura 	if (sc->sc_hardpowerhook == NULL)
    134  1.1  takemura 		printf("%s: WARNING: unable to establish hard power hook\n",
    135  1.1  takemura 			sc->sc_dev.dv_xname);
    136  1.1  takemura 
    137  1.1  takemura 	mq200_fbinit(&sc->sc_fbconf);
    138  1.4  takemura 	sc->sc_fbconf.hf_baseaddr = (u_long)bootinfo->fb_addr;
    139  1.5      sato 	sc->sc_fbconf.hf_offset	= (u_long)sc->sc_fbconf.hf_baseaddr -
    140  1.4  takemura 	    MIPS_PHYS_TO_KSEG1(mips_ptob(mips_btop(sc->sc_baseaddr)));
    141  1.3  takemura 	DPRINTF(("hf_baseaddr=%lx\n", sc->sc_fbconf.hf_baseaddr));
    142  1.3  takemura 	DPRINTF(("hf_offset=%lx\n", sc->sc_fbconf.hf_offset));
    143  1.1  takemura 
    144  1.1  takemura 	if (console && hpcfb_cnattach(&sc->sc_fbconf) != 0) {
    145  1.1  takemura 		panic("mq200_attach: can't init fb console");
    146  1.1  takemura 	}
    147  1.1  takemura 
    148  1.1  takemura 	ha.ha_console = console;
    149  1.1  takemura 	ha.ha_accessops = &mq200_ha;
    150  1.1  takemura 	ha.ha_accessctx = sc;
    151  1.1  takemura 	ha.ha_curfbconf = 0;
    152  1.1  takemura 	ha.ha_nfbconf = 1;
    153  1.1  takemura 	ha.ha_fbconflist = &sc->sc_fbconf;
    154  1.1  takemura 	ha.ha_curdspconf = 0;
    155  1.1  takemura 	ha.ha_ndspconf = 1;
    156  1.1  takemura 	ha.ha_dspconflist = &sc->sc_dspconf;
    157  1.1  takemura 
    158  1.1  takemura 	config_found(&sc->sc_dev, &ha, hpcfbprint);
    159  1.1  takemura 
    160  1.2      sato #if NBIVIDEO > 0
    161  1.1  takemura 	/*
    162  1.1  takemura 	 * bivideo is no longer need
    163  1.1  takemura 	 */
    164  1.1  takemura 	bivideo_dont_attach = 1;
    165  1.2      sato #endif /* NBIVIDEO > 0 */
    166  1.1  takemura }
    167  1.1  takemura 
    168  1.1  takemura static void
    169  1.1  takemura mq200_power(why, arg)
    170  1.1  takemura 	int why;
    171  1.1  takemura 	void *arg;
    172  1.1  takemura {
    173  1.1  takemura #if 0
    174  1.1  takemura 	struct mq200_softc *sc = arg;
    175  1.1  takemura 
    176  1.1  takemura 	switch (why) {
    177  1.1  takemura 	case PWR_SUSPEND:
    178  1.1  takemura 		sc->sc_powerstate = MQ200_POWERSTATE_D2;
    179  1.1  takemura 		break;
    180  1.1  takemura 	case PWR_STANDBY:
    181  1.1  takemura 		sc->sc_powerstate = MQ200_POWERSTATE_D3;
    182  1.1  takemura 		break;
    183  1.1  takemura 	case PWR_RESUME:
    184  1.1  takemura 		sc->sc_powerstate = MQ200_POWERSTATE_D0;
    185  1.1  takemura 		break;
    186  1.1  takemura 	}
    187  1.1  takemura 
    188  1.1  takemura 	printf("MQ200_PMCSR=%08x\n", sc->sc_powerstate);
    189  1.1  takemura 	bus_space_write_4(sc->sc_iot, sc->sc_ioh,
    190  1.1  takemura 			  MQ200_PMCSR, sc->sc_powerstate);
    191  1.1  takemura #endif
    192  1.1  takemura }
    193  1.1  takemura 
    194  1.1  takemura static int
    195  1.1  takemura mq200_hardpower(ctx, type, id, msg)
    196  1.1  takemura 	void *ctx;
    197  1.1  takemura 	int type;
    198  1.1  takemura 	long id;
    199  1.1  takemura 	void *msg;
    200  1.1  takemura {
    201  1.1  takemura 	struct mq200_softc *sc = ctx;
    202  1.1  takemura 	int why = (int)msg;
    203  1.1  takemura 
    204  1.1  takemura 	switch (why) {
    205  1.1  takemura 	case PWR_SUSPEND:
    206  1.1  takemura 		sc->sc_powerstate = MQ200_POWERSTATE_D2;
    207  1.1  takemura 		break;
    208  1.1  takemura 	case PWR_STANDBY:
    209  1.1  takemura 		sc->sc_powerstate = MQ200_POWERSTATE_D3;
    210  1.1  takemura 		break;
    211  1.1  takemura 	case PWR_RESUME:
    212  1.1  takemura 		sc->sc_powerstate = MQ200_POWERSTATE_D0;
    213  1.1  takemura 		break;
    214  1.1  takemura 	}
    215  1.1  takemura 
    216  1.1  takemura 	bus_space_write_4(sc->sc_iot, sc->sc_ioh,
    217  1.1  takemura 			  MQ200_PMCSR, sc->sc_powerstate);
    218  1.1  takemura 
    219  1.1  takemura 	/*
    220  1.1  takemura 	 * you should wait until the
    221  1.1  takemura 	 * power state transit sequence will end.
    222  1.1  takemura 	 */
    223  1.1  takemura 	{
    224  1.1  takemura 		unsigned long tmp;
    225  1.1  takemura 		do {
    226  1.1  takemura 			tmp = bus_space_read_4(sc->sc_iot, sc->sc_ioh,
    227  1.1  takemura 					       MQ200_PMCSR);
    228  1.1  takemura 		} while ((tmp & 0x3) != (sc->sc_powerstate & 0x3));
    229  1.1  takemura 		delay(100000); /* XXX */
    230  1.1  takemura 	}
    231  1.1  takemura 
    232  1.1  takemura 	return (0);
    233  1.1  takemura }
    234  1.1  takemura 
    235  1.1  takemura 
    236  1.1  takemura static int
    237  1.1  takemura mq200_fbinit(fb)
    238  1.1  takemura 	struct hpcfb_fbconf *fb;
    239  1.1  takemura {
    240  1.1  takemura 
    241  1.1  takemura 	/*
    242  1.1  takemura 	 * get fb settings from bootinfo
    243  1.1  takemura 	 */
    244  1.1  takemura 	if (bootinfo == NULL ||
    245  1.1  takemura 	    bootinfo->fb_addr == 0 ||
    246  1.1  takemura 	    bootinfo->fb_line_bytes == 0 ||
    247  1.1  takemura 	    bootinfo->fb_width == 0 ||
    248  1.1  takemura 	    bootinfo->fb_height == 0) {
    249  1.1  takemura 		printf("no frame buffer infomation.\n");
    250  1.1  takemura 		return (-1);
    251  1.1  takemura 	}
    252  1.1  takemura 
    253  1.1  takemura 	/* zero fill */
    254  1.1  takemura 	bzero(fb, sizeof(*fb));
    255  1.1  takemura 
    256  1.1  takemura 	fb->hf_conf_index	= 0;	/* configuration index		*/
    257  1.1  takemura 	fb->hf_nconfs		= 1;   	/* how many configurations	*/
    258  1.1  takemura 	strcpy(fb->hf_name, "built-in video");
    259  1.1  takemura 					/* frame buffer name		*/
    260  1.1  takemura 	strcpy(fb->hf_conf_name, "default");
    261  1.1  takemura 					/* configuration name		*/
    262  1.1  takemura 	fb->hf_height		= bootinfo->fb_height;
    263  1.1  takemura 	fb->hf_width		= bootinfo->fb_width;
    264  1.1  takemura 	fb->hf_baseaddr		= mips_ptob(mips_btop(bootinfo->fb_addr));
    265  1.1  takemura 	fb->hf_offset		= (u_long)bootinfo->fb_addr - fb->hf_baseaddr;
    266  1.1  takemura 					/* frame buffer start offset   	*/
    267  1.1  takemura 	fb->hf_bytes_per_line	= bootinfo->fb_line_bytes;
    268  1.1  takemura 	fb->hf_nplanes		= 1;
    269  1.1  takemura 	fb->hf_bytes_per_plane	= bootinfo->fb_height *
    270  1.1  takemura 					bootinfo->fb_line_bytes;
    271  1.1  takemura 
    272  1.1  takemura 	fb->hf_access_flags |= HPCFB_ACCESS_BYTE;
    273  1.1  takemura 	fb->hf_access_flags |= HPCFB_ACCESS_WORD;
    274  1.1  takemura 	fb->hf_access_flags |= HPCFB_ACCESS_DWORD;
    275  1.1  takemura 
    276  1.1  takemura 	switch (bootinfo->fb_type) {
    277  1.1  takemura 		/*
    278  1.1  takemura 		 * gray scale
    279  1.1  takemura 		 */
    280  1.1  takemura 	case BIFB_D2_M2L_3:
    281  1.1  takemura 	case BIFB_D2_M2L_3x2:
    282  1.1  takemura 		fb->hf_access_flags |= HPCFB_ACCESS_REVERSE;
    283  1.1  takemura 		/* fall through */
    284  1.1  takemura 	case BIFB_D2_M2L_0:
    285  1.1  takemura 	case BIFB_D2_M2L_0x2:
    286  1.1  takemura 		fb->hf_class = HPCFB_CLASS_GRAYSCALE;
    287  1.1  takemura 		fb->hf_access_flags |= HPCFB_ACCESS_STATIC;
    288  1.1  takemura 		fb->hf_pack_width = 8;
    289  1.1  takemura 		fb->hf_pixels_per_pack = 4;
    290  1.1  takemura 		fb->hf_pixel_width = 2;
    291  1.1  takemura 		fb->hf_class_data_length = sizeof(struct hf_gray_tag);
    292  1.1  takemura 		fb->hf_u.hf_gray.hf_flags = 0;	/* reserved for future use */
    293  1.1  takemura 		break;
    294  1.1  takemura 
    295  1.1  takemura 		/*
    296  1.1  takemura 		 * indexed color
    297  1.1  takemura 		 */
    298  1.1  takemura 	case BIFB_D8_FF:
    299  1.1  takemura 		fb->hf_access_flags |= HPCFB_ACCESS_REVERSE;
    300  1.1  takemura 		/* fall through */
    301  1.1  takemura 	case BIFB_D8_00:
    302  1.1  takemura 		fb->hf_class = HPCFB_CLASS_INDEXCOLOR;
    303  1.1  takemura 		fb->hf_access_flags |= HPCFB_ACCESS_STATIC;
    304  1.1  takemura 		fb->hf_pack_width = 8;
    305  1.1  takemura 		fb->hf_pixels_per_pack = 1;
    306  1.1  takemura 		fb->hf_pixel_width = 8;
    307  1.1  takemura 		fb->hf_class_data_length = sizeof(struct hf_indexed_tag);
    308  1.1  takemura 		fb->hf_u.hf_indexed.hf_flags = 0; /* reserved for future use */
    309  1.1  takemura 		break;
    310  1.1  takemura 
    311  1.1  takemura 		/*
    312  1.1  takemura 		 * RGB color
    313  1.1  takemura 		 */
    314  1.1  takemura 	case BIFB_D16_FFFF:
    315  1.1  takemura 		fb->hf_access_flags |= HPCFB_ACCESS_REVERSE;
    316  1.1  takemura 		/* fall through */
    317  1.1  takemura 	case BIFB_D16_0000:
    318  1.1  takemura 		fb->hf_class = HPCFB_CLASS_RGBCOLOR;
    319  1.1  takemura 		fb->hf_access_flags |= HPCFB_ACCESS_STATIC;
    320  1.1  takemura #if BYTE_ORDER == LITTLE_ENDIAN
    321  1.1  takemura 		fb->hf_swap_flags = HPCFB_SWAP_BYTE;
    322  1.1  takemura #endif
    323  1.1  takemura 		fb->hf_pack_width = 16;
    324  1.1  takemura 		fb->hf_pixels_per_pack = 1;
    325  1.1  takemura 		fb->hf_pixel_width = 16;
    326  1.1  takemura 
    327  1.1  takemura 		fb->hf_class_data_length = sizeof(struct hf_rgb_tag);
    328  1.1  takemura 		fb->hf_u.hf_rgb.hf_flags = 0;	/* reserved for future use */
    329  1.1  takemura 
    330  1.1  takemura 		fb->hf_u.hf_rgb.hf_red_width = 5;
    331  1.1  takemura 		fb->hf_u.hf_rgb.hf_red_shift = 11;
    332  1.1  takemura 		fb->hf_u.hf_rgb.hf_green_width = 6;
    333  1.1  takemura 		fb->hf_u.hf_rgb.hf_green_shift = 5;
    334  1.1  takemura 		fb->hf_u.hf_rgb.hf_blue_width = 5;
    335  1.1  takemura 		fb->hf_u.hf_rgb.hf_blue_shift = 0;
    336  1.1  takemura 		fb->hf_u.hf_rgb.hf_alpha_width = 0;
    337  1.1  takemura 		fb->hf_u.hf_rgb.hf_alpha_shift = 0;
    338  1.1  takemura 		break;
    339  1.1  takemura 
    340  1.1  takemura 	default:
    341  1.1  takemura 		printf("unknown type (=%d).\n", bootinfo->fb_type);
    342  1.1  takemura 		return (-1);
    343  1.1  takemura 		break;
    344  1.1  takemura 	}
    345  1.1  takemura 
    346  1.1  takemura 	return (0); /* no error */
    347  1.1  takemura }
    348  1.1  takemura 
    349  1.1  takemura int
    350  1.1  takemura mq200_ioctl(v, cmd, data, flag, p)
    351  1.1  takemura 	void *v;
    352  1.1  takemura 	u_long cmd;
    353  1.1  takemura 	caddr_t data;
    354  1.1  takemura 	int flag;
    355  1.1  takemura 	struct proc *p;
    356  1.1  takemura {
    357  1.1  takemura 	struct mq200_softc *sc = (struct mq200_softc *)v;
    358  1.1  takemura 	struct hpcfb_fbconf *fbconf;
    359  1.1  takemura 	struct hpcfb_dspconf *dspconf;
    360  1.1  takemura 	struct wsdisplay_cmap *cmap;
    361  1.6      sato 	struct wsdisplay_param *dispparam;
    362  1.1  takemura 
    363  1.1  takemura 	switch (cmd) {
    364  1.1  takemura 	case WSDISPLAYIO_GETCMAP:
    365  1.1  takemura 		cmap = (struct wsdisplay_cmap*)data;
    366  1.1  takemura 
    367  1.1  takemura 		if (sc->sc_fbconf.hf_class != HPCFB_CLASS_INDEXCOLOR ||
    368  1.1  takemura 		    sc->sc_fbconf.hf_pack_width != 8 ||
    369  1.1  takemura 		    256 <= cmap->index ||
    370  1.1  takemura 		    256 < (cmap->index + cmap->count))
    371  1.1  takemura 			return (EINVAL);
    372  1.1  takemura 
    373  1.1  takemura #if 0
    374  1.1  takemura 		if (!uvm_useracc(cmap->red, cmap->count, B_WRITE) ||
    375  1.1  takemura 		    !uvm_useracc(cmap->green, cmap->count, B_WRITE) ||
    376  1.1  takemura 		    !uvm_useracc(cmap->blue, cmap->count, B_WRITE))
    377  1.1  takemura 			return (EFAULT);
    378  1.1  takemura 
    379  1.1  takemura 		copyout(&bivideo_cmap_r[cmap->index], cmap->red, cmap->count);
    380  1.1  takemura 		copyout(&bivideo_cmap_g[cmap->index], cmap->green,cmap->count);
    381  1.1  takemura 		copyout(&bivideo_cmap_b[cmap->index], cmap->blue, cmap->count);
    382  1.1  takemura #endif
    383  1.1  takemura 
    384  1.1  takemura 		return (0);
    385  1.1  takemura 
    386  1.1  takemura 	case WSDISPLAYIO_PUTCMAP:
    387  1.1  takemura 		/*
    388  1.1  takemura 		 * This driver can't set color map.
    389  1.1  takemura 		 */
    390  1.1  takemura 		return (EINVAL);
    391  1.6      sato 
    392  1.6      sato 	case WSDISPLAYIO_GETPARAM:
    393  1.6      sato 		dispparam = (struct wsdisplay_param*)data;
    394  1.6      sato 		switch (dispparam->param) {
    395  1.6      sato 		case WSDISPLAYIO_PARAM_BACKLIGHT:
    396  1.6      sato 			VPRINTF(("mq200_ioctl: GETPARAM:BACKLIGHT\n"));
    397  1.6      sato 			return (EINVAL);
    398  1.6      sato 		case WSDISPLAYIO_PARAM_CONTRAST:
    399  1.6      sato 			VPRINTF(("mq200_ioctl: GETPARAM:CONTRAST\n"));
    400  1.6      sato 			return (EINVAL);
    401  1.6      sato 		case WSDISPLAYIO_PARAM_BRIGHTNESS:
    402  1.6      sato 			VPRINTF(("mq200_ioctl: GETPARAM:BRIGHTNESS\n"));
    403  1.6      sato 			return (EINVAL);
    404  1.6      sato 		default:
    405  1.6      sato 			return (EINVAL);
    406  1.6      sato 		}
    407  1.6      sato 		return (0);
    408  1.6      sato 
    409  1.6      sato 	case WSDISPLAYIO_SETPARAM:
    410  1.6      sato 		dispparam = (struct wsdisplay_param*)data;
    411  1.6      sato 		switch (dispparam->param) {
    412  1.6      sato 		case WSDISPLAYIO_PARAM_BACKLIGHT:
    413  1.6      sato 			VPRINTF(("mq200_ioctl: GETPARAM:BACKLIGHT\n"));
    414  1.6      sato 			return (EINVAL);
    415  1.6      sato 		case WSDISPLAYIO_PARAM_CONTRAST:
    416  1.6      sato 			VPRINTF(("mq200_ioctl: GETPARAM:CONTRAST\n"));
    417  1.6      sato 			return (EINVAL);
    418  1.6      sato 		case WSDISPLAYIO_PARAM_BRIGHTNESS:
    419  1.6      sato 			VPRINTF(("mq200_ioctl: GETPARAM:BRIGHTNESS\n"));
    420  1.6      sato 			return (EINVAL);
    421  1.6      sato 		default:
    422  1.6      sato 			return (EINVAL);
    423  1.6      sato 		}
    424  1.6      sato 		return (0);
    425  1.1  takemura 
    426  1.1  takemura 	case HPCFBIO_GCONF:
    427  1.1  takemura 		fbconf = (struct hpcfb_fbconf *)data;
    428  1.1  takemura 		if (fbconf->hf_conf_index != 0 &&
    429  1.1  takemura 		    fbconf->hf_conf_index != HPCFB_CURRENT_CONFIG) {
    430  1.1  takemura 			return (EINVAL);
    431  1.1  takemura 		}
    432  1.1  takemura 		*fbconf = sc->sc_fbconf;	/* structure assignment */
    433  1.1  takemura 		return (0);
    434  1.1  takemura 	case HPCFBIO_SCONF:
    435  1.1  takemura 		fbconf = (struct hpcfb_fbconf *)data;
    436  1.1  takemura 		if (fbconf->hf_conf_index != 0 &&
    437  1.1  takemura 		    fbconf->hf_conf_index != HPCFB_CURRENT_CONFIG) {
    438  1.1  takemura 			return (EINVAL);
    439  1.1  takemura 		}
    440  1.1  takemura 		/*
    441  1.1  takemura 		 * nothing to do because we have only one configration
    442  1.1  takemura 		 */
    443  1.1  takemura 		return (0);
    444  1.1  takemura 	case HPCFBIO_GDSPCONF:
    445  1.1  takemura 		dspconf = (struct hpcfb_dspconf *)data;
    446  1.1  takemura 		if ((dspconf->hd_unit_index != 0 &&
    447  1.1  takemura 		     dspconf->hd_unit_index != HPCFB_CURRENT_UNIT) ||
    448  1.1  takemura 		    (dspconf->hd_conf_index != 0 &&
    449  1.1  takemura 		     dspconf->hd_conf_index != HPCFB_CURRENT_CONFIG)) {
    450  1.1  takemura 			return (EINVAL);
    451  1.1  takemura 		}
    452  1.1  takemura 		*dspconf = sc->sc_dspconf;	/* structure assignment */
    453  1.1  takemura 		return (0);
    454  1.1  takemura 	case HPCFBIO_SDSPCONF:
    455  1.1  takemura 		dspconf = (struct hpcfb_dspconf *)data;
    456  1.1  takemura 		if ((dspconf->hd_unit_index != 0 &&
    457  1.1  takemura 		     dspconf->hd_unit_index != HPCFB_CURRENT_UNIT) ||
    458  1.1  takemura 		    (dspconf->hd_conf_index != 0 &&
    459  1.1  takemura 		     dspconf->hd_conf_index != HPCFB_CURRENT_CONFIG)) {
    460  1.1  takemura 			return (EINVAL);
    461  1.1  takemura 		}
    462  1.1  takemura 		/*
    463  1.1  takemura 		 * nothing to do
    464  1.1  takemura 		 * because we have only one unit and one configration
    465  1.1  takemura 		 */
    466  1.1  takemura 		return (0);
    467  1.1  takemura 	case HPCFBIO_GOP:
    468  1.1  takemura 	case HPCFBIO_SOP:
    469  1.1  takemura 		/*
    470  1.1  takemura 		 * curently not implemented...
    471  1.1  takemura 		 */
    472  1.1  takemura 		return (EINVAL);
    473  1.1  takemura 	}
    474  1.1  takemura 
    475  1.1  takemura 	return (ENOTTY);
    476  1.1  takemura }
    477  1.1  takemura 
    478  1.1  takemura paddr_t
    479  1.1  takemura mq200_mmap(ctx, offset, prot)
    480  1.1  takemura 	void *ctx;
    481  1.1  takemura 	off_t offset;
    482  1.1  takemura 	int prot;
    483  1.1  takemura {
    484  1.1  takemura 	struct mq200_softc *sc = (struct mq200_softc *)ctx;
    485  1.1  takemura 
    486  1.3  takemura 	if (offset < 0 || MQ200_MAPSIZE <= offset)
    487  1.1  takemura 		return -1;
    488  1.1  takemura 
    489  1.3  takemura 	return mips_btop(sc->sc_baseaddr + offset);
    490  1.1  takemura }
    491