Home | History | Annotate | Line # | Download | only in dev
wiifb.c revision 1.5.2.2 
      1  1.5.2.2  martin /* $NetBSD: wiifb.c,v 1.5.2.2 2024/02/03 11:47:04 martin Exp $ */
      2  1.5.2.2  martin 
      3  1.5.2.2  martin /*-
      4  1.5.2.2  martin  * Copyright (c) 2024 Jared McNeill <jmcneill (at) invisible.ca>
      5  1.5.2.2  martin  * All rights reserved.
      6  1.5.2.2  martin  *
      7  1.5.2.2  martin  * Redistribution and use in source and binary forms, with or without
      8  1.5.2.2  martin  * modification, are permitted provided that the following conditions
      9  1.5.2.2  martin  * are met:
     10  1.5.2.2  martin  * 1. Redistributions of source code must retain the above copyright
     11  1.5.2.2  martin  *    notice, this list of conditions and the following disclaimer.
     12  1.5.2.2  martin  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.5.2.2  martin  *    notice, this list of conditions and the following disclaimer in the
     14  1.5.2.2  martin  *    documentation and/or other materials provided with the distribution.
     15  1.5.2.2  martin  *
     16  1.5.2.2  martin  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     17  1.5.2.2  martin  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     18  1.5.2.2  martin  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     19  1.5.2.2  martin  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     20  1.5.2.2  martin  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
     21  1.5.2.2  martin  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     22  1.5.2.2  martin  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
     23  1.5.2.2  martin  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
     24  1.5.2.2  martin  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     25  1.5.2.2  martin  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     26  1.5.2.2  martin  * SUCH DAMAGE.
     27  1.5.2.2  martin  */
     28  1.5.2.2  martin 
     29  1.5.2.2  martin #include <sys/cdefs.h>
     30  1.5.2.2  martin __KERNEL_RCSID(0, "$NetBSD: wiifb.c,v 1.5.2.2 2024/02/03 11:47:04 martin Exp $");
     31  1.5.2.2  martin 
     32  1.5.2.2  martin #include <sys/param.h>
     33  1.5.2.2  martin #include <sys/bus.h>
     34  1.5.2.2  martin #include <sys/device.h>
     35  1.5.2.2  martin #include <sys/systm.h>
     36  1.5.2.2  martin 
     37  1.5.2.2  martin #include <machine/wii.h>
     38  1.5.2.2  martin 
     39  1.5.2.2  martin #include <dev/videomode/videomode.h>
     40  1.5.2.2  martin #include <dev/wsfb/genfbvar.h>
     41  1.5.2.2  martin 
     42  1.5.2.2  martin #include "mainbus.h"
     43  1.5.2.2  martin #include "vireg.h"
     44  1.5.2.2  martin #include "viio.h"
     45  1.5.2.2  martin 
     46  1.5.2.2  martin #define	WIIFB_ERROR_BLINK_INTERVAL	1000000
     47  1.5.2.2  martin 
     48  1.5.2.2  martin struct wiifb_mode {
     49  1.5.2.2  martin 	const char *		name;
     50  1.5.2.2  martin 	u_int			width;
     51  1.5.2.2  martin 	u_int			height;
     52  1.5.2.2  martin 	u_int			lines;
     53  1.5.2.2  martin };
     54  1.5.2.2  martin 
     55  1.5.2.2  martin static uint32_t wiifb_devcmap[16] = {
     56  1.5.2.2  martin 	0x00800080,	/* Black */
     57  1.5.2.2  martin 	0x1dff1d6b,	/* Blue */
     58  1.5.2.2  martin 	0x4b554b4a,	/* Green */
     59  1.5.2.2  martin 	0x80808080,	/* Cyan */
     60  1.5.2.2  martin 	0x4c544cff,	/* Red */
     61  1.5.2.2  martin 	0x3aaa34b5,	/* Magenta */
     62  1.5.2.2  martin 	0x7140718a,	/* Brown */
     63  1.5.2.2  martin 	0xff80ff80,	/* White */
     64  1.5.2.2  martin 	0x80808080,	/* Gray */
     65  1.5.2.2  martin 	0xc399c36a,	/* Bright Blue */
     66  1.5.2.2  martin 	0xd076d074,	/* Bright Green */
     67  1.5.2.2  martin 	0x80808080,	/* Bright Cyan */
     68  1.5.2.2  martin 	0x4c544cff,	/* Bright Red */
     69  1.5.2.2  martin 	0x3aaa34b5,	/* Bright Magenta */
     70  1.5.2.2  martin 	0xe100e194,	/* Bright Yellow */
     71  1.5.2.2  martin 	0xff80ff80	/* Bright White */
     72  1.5.2.2  martin };
     73  1.5.2.2  martin 
     74  1.5.2.2  martin #define WIIFB_MODE_INDEX(fmt, interlaced)	((fmt << 1) | interlaced)
     75  1.5.2.2  martin 
     76  1.5.2.2  martin static const struct wiifb_mode wiifb_modes[] = {
     77  1.5.2.2  martin 	[WIIFB_MODE_INDEX(VI_DCR_FMT_NTSC, 0)] = {
     78  1.5.2.2  martin 		.name = "NTSC 480p",
     79  1.5.2.2  martin 		.width = 640,
     80  1.5.2.2  martin 		.height = 480,
     81  1.5.2.2  martin 		.lines = 525,
     82  1.5.2.2  martin 	},
     83  1.5.2.2  martin 	[WIIFB_MODE_INDEX(VI_DCR_FMT_NTSC, 1)] = {
     84  1.5.2.2  martin 		.name = "NTSC 480i",
     85  1.5.2.2  martin 		.width = 640,
     86  1.5.2.2  martin 		.height = 480,
     87  1.5.2.2  martin 		.lines = 525,
     88  1.5.2.2  martin 	},
     89  1.5.2.2  martin 	[WIIFB_MODE_INDEX(VI_DCR_FMT_PAL, 1)] = {
     90  1.5.2.2  martin 		.name = "PAL 576i",
     91  1.5.2.2  martin 		.width = 640,
     92  1.5.2.2  martin 		.height = 574,
     93  1.5.2.2  martin 		.lines = 625,
     94  1.5.2.2  martin 	},
     95  1.5.2.2  martin 
     96  1.5.2.2  martin };
     97  1.5.2.2  martin #define WIIFB_NMODES	__arraycount(wiifb_modes)
     98  1.5.2.2  martin 
     99  1.5.2.2  martin struct wiifb_softc {
    100  1.5.2.2  martin 	struct genfb_softc	sc_gen;
    101  1.5.2.2  martin 
    102  1.5.2.2  martin 	bus_space_tag_t		sc_bst;
    103  1.5.2.2  martin 	bus_space_handle_t	sc_bsh;
    104  1.5.2.2  martin 
    105  1.5.2.2  martin 	void			*sc_bits;
    106  1.5.2.2  martin 
    107  1.5.2.2  martin 	uint8_t			sc_format;
    108  1.5.2.2  martin 	bool			sc_interlaced;
    109  1.5.2.2  martin 
    110  1.5.2.2  martin 	const struct wiifb_mode	*sc_curmode;
    111  1.5.2.2  martin };
    112  1.5.2.2  martin 
    113  1.5.2.2  martin #define	RD2(sc, reg)		\
    114  1.5.2.2  martin 	bus_space_read_2((sc)->sc_bst, (sc)->sc_bsh, (reg))
    115  1.5.2.2  martin #define	RD4(sc, reg)		\
    116  1.5.2.2  martin 	bus_space_read_4((sc)->sc_bst, (sc)->sc_bsh, (reg))
    117  1.5.2.2  martin #define	WR2(sc, reg, val)	\
    118  1.5.2.2  martin 	bus_space_write_2((sc)->sc_bst, (sc)->sc_bsh, (reg), (val))
    119  1.5.2.2  martin #define	WR4(sc, reg, val)	\
    120  1.5.2.2  martin 	bus_space_write_4((sc)->sc_bst, (sc)->sc_bsh, (reg), (val))
    121  1.5.2.2  martin 
    122  1.5.2.2  martin static int	wiifb_match(device_t, cfdata_t, void *);
    123  1.5.2.2  martin static void	wiifb_attach(device_t, device_t, void *);
    124  1.5.2.2  martin 
    125  1.5.2.2  martin static void	wiifb_init(struct wiifb_softc *);
    126  1.5.2.2  martin static void	wiifb_set_mode(struct wiifb_softc *, uint8_t, bool);
    127  1.5.2.2  martin static void	wiifb_set_fb(struct wiifb_softc *);
    128  1.5.2.2  martin 
    129  1.5.2.2  martin static int	wiifb_ioctl(void *, void *, u_long, void *, int, lwp_t *);
    130  1.5.2.2  martin static paddr_t	wiifb_mmap(void *, void *, off_t, int);
    131  1.5.2.2  martin 
    132  1.5.2.2  martin static struct genfb_ops wiifb_ops = {
    133  1.5.2.2  martin 	.genfb_ioctl = wiifb_ioctl,
    134  1.5.2.2  martin 	.genfb_mmap = wiifb_mmap,
    135  1.5.2.2  martin };
    136  1.5.2.2  martin 
    137  1.5.2.2  martin CFATTACH_DECL_NEW(wiifb, sizeof(struct wiifb_softc),
    138  1.5.2.2  martin 	wiifb_match, wiifb_attach, NULL, NULL);
    139  1.5.2.2  martin 
    140  1.5.2.2  martin static int
    141  1.5.2.2  martin wiifb_match(device_t parent, cfdata_t cf, void *aux)
    142  1.5.2.2  martin {
    143  1.5.2.2  martin 	struct mainbus_attach_args *maa = aux;
    144  1.5.2.2  martin 
    145  1.5.2.2  martin 	return strcmp(maa->maa_name, "genfb") == 0;
    146  1.5.2.2  martin }
    147  1.5.2.2  martin 
    148  1.5.2.2  martin static void
    149  1.5.2.2  martin wiifb_attach(device_t parent, device_t self, void *aux)
    150  1.5.2.2  martin {
    151  1.5.2.2  martin 	struct wiifb_softc *sc = device_private(self);
    152  1.5.2.2  martin 	prop_dictionary_t dict = device_properties(self);
    153  1.5.2.2  martin 	struct mainbus_attach_args *maa = aux;
    154  1.5.2.2  martin 	int error;
    155  1.5.2.2  martin 
    156  1.5.2.2  martin 	sc->sc_gen.sc_dev = self;
    157  1.5.2.2  martin 	sc->sc_bst = maa->maa_bst;
    158  1.5.2.2  martin 	error = bus_space_map(sc->sc_bst, maa->maa_addr, VI_SIZE, 0,
    159  1.5.2.2  martin 	    &sc->sc_bsh);
    160  1.5.2.2  martin 	if (error != 0) {
    161  1.5.2.2  martin 		panic("couldn't map registers");
    162  1.5.2.2  martin 	}
    163  1.5.2.2  martin 	sc->sc_bits = mapiodev(XFB_START, XFB_SIZE, true);
    164  1.5.2.2  martin 
    165  1.5.2.2  martin 	wiifb_init(sc);
    166  1.5.2.2  martin 	wiifb_set_mode(sc, sc->sc_format, sc->sc_interlaced);
    167  1.5.2.2  martin 
    168  1.5.2.2  martin 	prop_dictionary_set_uint32(dict, "width", sc->sc_curmode->width);
    169  1.5.2.2  martin 	prop_dictionary_set_uint32(dict, "height", sc->sc_curmode->height);
    170  1.5.2.2  martin 	prop_dictionary_set_uint8(dict, "depth", 16);
    171  1.5.2.2  martin 	prop_dictionary_set_uint32(dict, "address", XFB_START);
    172  1.5.2.2  martin 	prop_dictionary_set_uint32(dict, "virtual_address",
    173  1.5.2.2  martin 	    (uintptr_t)sc->sc_bits);
    174  1.5.2.2  martin 	prop_dictionary_set_uint64(dict, "devcmap", (uintptr_t)wiifb_devcmap);
    175  1.5.2.2  martin 
    176  1.5.2.2  martin 	genfb_init(&sc->sc_gen);
    177  1.5.2.2  martin 
    178  1.5.2.2  martin 	aprint_naive("\n");
    179  1.5.2.2  martin 	aprint_normal(": %s\n", sc->sc_curmode->name);
    180  1.5.2.2  martin 
    181  1.5.2.2  martin 	genfb_cnattach();
    182  1.5.2.2  martin 	prop_dictionary_set_bool(dict, "is_console", true);
    183  1.5.2.2  martin 	genfb_attach(&sc->sc_gen, &wiifb_ops);
    184  1.5.2.2  martin }
    185  1.5.2.2  martin 
    186  1.5.2.2  martin static void
    187  1.5.2.2  martin wiifb_init(struct wiifb_softc *sc)
    188  1.5.2.2  martin {
    189  1.5.2.2  martin 	uint16_t dcr;
    190  1.5.2.2  martin 	uint16_t visel;
    191  1.5.2.2  martin 
    192  1.5.2.2  martin 	/* Read current display format and interlaced settings. */
    193  1.5.2.2  martin 	dcr = RD2(sc, VI_DCR);
    194  1.5.2.2  martin 	if ((dcr & VI_DCR_ENB) != 0) {
    195  1.5.2.2  martin 		sc->sc_format = __SHIFTOUT(dcr, VI_DCR_FMT);
    196  1.5.2.2  martin 		sc->sc_interlaced = (dcr & VI_DCR_NIN) == 0;
    197  1.5.2.2  martin 	} else {
    198  1.5.2.2  martin 		visel = RD2(sc, VI_VISEL);
    199  1.5.2.2  martin 		sc->sc_format = VI_DCR_FMT_NTSC;
    200  1.5.2.2  martin 		sc->sc_interlaced = (visel & VI_VISEL_COMPONENT_CABLE) == 0;
    201  1.5.2.2  martin 	}
    202  1.5.2.2  martin 
    203  1.5.2.2  martin 	/* Reset video interface. */
    204  1.5.2.2  martin 	WR2(sc, VI_DCR, dcr | VI_DCR_RST);
    205  1.5.2.2  martin 	WR2(sc, VI_DCR, dcr & ~VI_DCR_RST);
    206  1.5.2.2  martin }
    207  1.5.2.2  martin 
    208  1.5.2.2  martin static void
    209  1.5.2.2  martin wiifb_set_mode(struct wiifb_softc *sc, uint8_t format, bool interlaced)
    210  1.5.2.2  martin {
    211  1.5.2.2  martin 	u_int modeidx;
    212  1.5.2.2  martin 	u_int strides, reads;
    213  1.5.2.2  martin 
    214  1.5.2.2  martin 	modeidx = WIIFB_MODE_INDEX(format, interlaced);
    215  1.5.2.2  martin 	if (modeidx >= WIIFB_NMODES || wiifb_modes[modeidx].name == NULL) {
    216  1.5.2.2  martin 		panic("Unsupported format (0x%x) / interlaced (%d) settings",
    217  1.5.2.2  martin 		    sc->sc_format, sc->sc_interlaced);
    218  1.5.2.2  martin 	}
    219  1.5.2.2  martin 	sc->sc_curmode = &wiifb_modes[modeidx];
    220  1.5.2.2  martin 
    221  1.5.2.2  martin 	if (modeidx == WIIFB_MODE_INDEX(VI_DCR_FMT_NTSC, 1)) {
    222  1.5.2.2  martin 		/* NTSC 480i Magic numbers from YAGCD. */
    223  1.5.2.2  martin 		WR2(sc, VI_VTR, 0x0f06);
    224  1.5.2.2  martin 		WR4(sc, VI_HTR0, 0x476901AD);
    225  1.5.2.2  martin 		WR4(sc, VI_HTR1, 0x02EA5140);
    226  1.5.2.2  martin 		WR4(sc, VI_VTO, 0x00030018);
    227  1.5.2.2  martin 		WR4(sc, VI_VTE, 0x00020019);
    228  1.5.2.2  martin 		WR4(sc, VI_BBOI, 0x410C410C);
    229  1.5.2.2  martin 		WR4(sc, VI_BBEI, 0x40ED40ED);
    230  1.5.2.2  martin 	} else if (modeidx == WIIFB_MODE_INDEX(VI_DCR_FMT_NTSC, 0)) {
    231  1.5.2.2  martin 		/* NTSC 480p */
    232  1.5.2.2  martin 		WR2(sc, VI_VTR, 0x1e0c);
    233  1.5.2.2  martin 		WR4(sc, VI_HTR0, 0x476901ad);
    234  1.5.2.2  martin 		WR4(sc, VI_HTR1, 0x030a4940);
    235  1.5.2.2  martin 		WR4(sc, VI_VTO, 0x00060030);
    236  1.5.2.2  martin 		WR4(sc, VI_VTE, 0x00060030);
    237  1.5.2.2  martin 		WR4(sc, VI_BBOI, 0x81d881d8);
    238  1.5.2.2  martin 		WR4(sc, VI_BBEI, 0x81d881d8);
    239  1.5.2.2  martin 	} else if (modeidx == WIIFB_MODE_INDEX(VI_DCR_FMT_PAL, 1)) {
    240  1.5.2.2  martin 		/* PAL 576i */
    241  1.5.2.2  martin 		WR2(sc, VI_VTR, 0x11f5);
    242  1.5.2.2  martin 		WR4(sc, VI_HTR0, 0x4b6a01b0);
    243  1.5.2.2  martin 		WR4(sc, VI_HTR1, 0x02f85640);
    244  1.5.2.2  martin 		WR4(sc, VI_VTO, 0x00010023);
    245  1.5.2.2  martin 		WR4(sc, VI_VTE, 0x00000024);
    246  1.5.2.2  martin 		WR4(sc, VI_BBOI, 0x4d2b4d6d);
    247  1.5.2.2  martin 		WR4(sc, VI_BBEI, 0x4d8a4d4c);
    248  1.5.2.2  martin 	} else {
    249  1.5.2.2  martin 		/*
    250  1.5.2.2  martin 		 * Display mode is not supported. Blink the slot LED to
    251  1.5.2.2  martin 		 * indicate failure.
    252  1.5.2.2  martin 		 */
    253  1.5.2.2  martin 		wii_slot_led_blink(WIIFB_ERROR_BLINK_INTERVAL);
    254  1.5.2.2  martin 	}
    255  1.5.2.2  martin 
    256  1.5.2.2  martin 	/* Picture configuration */
    257  1.5.2.2  martin 	strides = (sc->sc_curmode->width * 2) / (interlaced ? 16 : 32);
    258  1.5.2.2  martin 	reads = (sc->sc_curmode->width * 2) / 32;
    259  1.5.2.2  martin 	WR2(sc, VI_PICCONF,
    260  1.5.2.2  martin 	    __SHIFTIN(strides, VI_PICCONF_STRIDES) |
    261  1.5.2.2  martin 	    __SHIFTIN(reads, VI_PICCONF_READS));
    262  1.5.2.2  martin 
    263  1.5.2.2  martin 	/* Horizontal scaler configuration */
    264  1.5.2.2  martin 	if (interlaced) {
    265  1.5.2.2  martin 		WR2(sc, VI_HSR, __SHIFTIN(256, VI_HSR_STP));
    266  1.5.2.2  martin 	} else {
    267  1.5.2.2  martin 		WR2(sc, VI_HSR, __SHIFTIN(244, VI_HSR_STP) | VI_HSR_HS_EN);
    268  1.5.2.2  martin 	}
    269  1.5.2.2  martin 
    270  1.5.2.2  martin 	/* Video clock configuration */
    271  1.5.2.2  martin 	WR2(sc, VI_VICLK,
    272  1.5.2.2  martin 	    interlaced ? VI_VICLK_SEL_27MHZ : VI_VICLK_SEL_54MHZ);
    273  1.5.2.2  martin 
    274  1.5.2.2  martin 	/* Horizontal scaling width */
    275  1.5.2.2  martin 	WR2(sc, VI_HSCALINGW, sc->sc_curmode->width);
    276  1.5.2.2  martin 
    277  1.5.2.2  martin 	/* Set framebuffer address */
    278  1.5.2.2  martin 	wiifb_set_fb(sc);
    279  1.5.2.2  martin }
    280  1.5.2.2  martin 
    281  1.5.2.2  martin static void
    282  1.5.2.2  martin wiifb_set_fb(struct wiifb_softc *sc)
    283  1.5.2.2  martin {
    284  1.5.2.2  martin 	uint32_t taddr = XFB_START;
    285  1.5.2.2  martin 	uint32_t baddr = taddr + (sc->sc_interlaced ?
    286  1.5.2.2  martin 				  sc->sc_curmode->width * 2 : 0);
    287  1.5.2.2  martin 
    288  1.5.2.2  martin 	WR4(sc, VI_TFBL,
    289  1.5.2.2  martin 	    VI_TFBL_PGOFF |
    290  1.5.2.2  martin 	    __SHIFTIN((taddr >> 5), VI_TFBL_FBB) |
    291  1.5.2.2  martin 	    __SHIFTIN((taddr / 2) & 0xf, VI_TFBL_XOF));
    292  1.5.2.2  martin 	WR4(sc, VI_TFBR, 0);
    293  1.5.2.2  martin 
    294  1.5.2.2  martin 	WR4(sc, VI_BFBL,
    295  1.5.2.2  martin 	    VI_BFBL_PGOFF |
    296  1.5.2.2  martin 	    __SHIFTIN((baddr >> 5), VI_BFBL_FBB) |
    297  1.5.2.2  martin 	    __SHIFTIN((baddr / 2) & 0xf, VI_BFBL_XOF));
    298  1.5.2.2  martin 	WR4(sc, VI_BFBR, 0);
    299  1.5.2.2  martin }
    300  1.5.2.2  martin 
    301  1.5.2.2  martin static int
    302  1.5.2.2  martin wiifb_ioctl(void *v, void *vs, u_long cmd, void *data, int flag, lwp_t *l)
    303  1.5.2.2  martin {
    304  1.5.2.2  martin 	struct wiifb_softc *sc = v;
    305  1.5.2.2  martin 	struct wsdisplayio_bus_id *busid;
    306  1.5.2.2  martin 	struct wsdisplayio_fbinfo *fbi;
    307  1.5.2.2  martin 	struct vi_regs *vr;
    308  1.5.2.2  martin 	u_int video;
    309  1.5.2.2  martin 
    310  1.5.2.2  martin 	switch (cmd) {
    311  1.5.2.2  martin 	case WSDISPLAYIO_GTYPE:
    312  1.5.2.2  martin 		*(u_int *)data = WSDISPLAY_TYPE_HOLLYWOOD;
    313  1.5.2.2  martin 		return 0;
    314  1.5.2.2  martin 	case WSDISPLAYIO_GET_BUSID:
    315  1.5.2.2  martin 		busid = data;
    316  1.5.2.2  martin 		busid->bus_type = WSDISPLAYIO_BUS_SOC;
    317  1.5.2.2  martin 		return 0;
    318  1.5.2.2  martin 	case WSDISPLAYIO_GET_FBINFO:
    319  1.5.2.2  martin 		fbi = data;
    320  1.5.2.2  martin 		/*
    321  1.5.2.2  martin 		 * rasops info does not match the pixel encoding due to our
    322  1.5.2.2  martin 		 * devcmap, so fill out fbinfo manually instead of relying
    323  1.5.2.2  martin 		 * on wsdisplayio_get_fbinfo.
    324  1.5.2.2  martin 		 */
    325  1.5.2.2  martin 		fbi->fbi_fbsize = XFB_SIZE;
    326  1.5.2.2  martin 		fbi->fbi_fboffset = 0;
    327  1.5.2.2  martin 		fbi->fbi_width = sc->sc_curmode->width;
    328  1.5.2.2  martin 		fbi->fbi_height = sc->sc_curmode->height;
    329  1.5.2.2  martin 		fbi->fbi_stride = fbi->fbi_width * 2;
    330  1.5.2.2  martin 		fbi->fbi_bitsperpixel = 16;
    331  1.5.2.2  martin 		fbi->fbi_pixeltype = WSFB_YUY2;
    332  1.5.2.2  martin 		fbi->fbi_flags = WSFB_VRAM_IS_RAM;
    333  1.5.2.2  martin 		return 0;
    334  1.5.2.2  martin 
    335  1.5.2.2  martin 	case WSDISPLAYIO_SVIDEO:
    336  1.5.2.2  martin 		video = *(u_int *)data;
    337  1.5.2.2  martin 		switch (video) {
    338  1.5.2.2  martin 		case WSDISPLAYIO_VIDEO_OFF:
    339  1.5.2.2  martin 			out32(HW_VIDIM, __SHIFTIN(7, VIDIM_Y) |
    340  1.5.2.2  martin 					__SHIFTIN(7, VIDIM_C) |
    341  1.5.2.2  martin 					VIDIM_E);
    342  1.5.2.2  martin 			return 0;
    343  1.5.2.2  martin 		case WSDISPLAYIO_VIDEO_ON:
    344  1.5.2.2  martin 			out32(HW_VIDIM, 0);
    345  1.5.2.2  martin 			return 0;
    346  1.5.2.2  martin 		default:
    347  1.5.2.2  martin 			return EINVAL;
    348  1.5.2.2  martin 		}
    349  1.5.2.2  martin 
    350  1.5.2.2  martin 	case VIIO_GETREGS:
    351  1.5.2.2  martin 	case VIIO_SETREGS:
    352  1.5.2.2  martin 		vr = data;
    353  1.5.2.2  martin 		switch (vr->bits) {
    354  1.5.2.2  martin 		case 16:
    355  1.5.2.2  martin 			if ((vr->reg & 1) != 0) {
    356  1.5.2.2  martin 				return EINVAL;
    357  1.5.2.2  martin 			}
    358  1.5.2.2  martin 			if (cmd == VIIO_GETREGS) {
    359  1.5.2.2  martin 				vr->val16 = RD2(sc, vr->reg);
    360  1.5.2.2  martin 			} else {
    361  1.5.2.2  martin 				WR2(sc, vr->reg, vr->val16);
    362  1.5.2.2  martin 			}
    363  1.5.2.2  martin 			return 0;
    364  1.5.2.2  martin 		case 32:
    365  1.5.2.2  martin 			if ((vr->reg & 3) != 0) {
    366  1.5.2.2  martin 				return EINVAL;
    367  1.5.2.2  martin 			}
    368  1.5.2.2  martin 			if (cmd == VIIO_GETREGS) {
    369  1.5.2.2  martin 				vr->val32 = RD4(sc, vr->reg);
    370  1.5.2.2  martin 			} else {
    371  1.5.2.2  martin 				WR4(sc, vr->reg, vr->val32);
    372  1.5.2.2  martin 			}
    373  1.5.2.2  martin 			return 0;
    374  1.5.2.2  martin 		default:
    375  1.5.2.2  martin 			return EINVAL;
    376  1.5.2.2  martin 		}
    377  1.5.2.2  martin 		return 0;
    378  1.5.2.2  martin 	}
    379  1.5.2.2  martin 
    380  1.5.2.2  martin 	return EPASSTHROUGH;
    381  1.5.2.2  martin }
    382  1.5.2.2  martin 
    383  1.5.2.2  martin static paddr_t
    384  1.5.2.2  martin wiifb_mmap(void *v, void *vs, off_t off, int prot)
    385  1.5.2.2  martin {
    386  1.5.2.2  martin 	struct wiifb_softc *sc = v;
    387  1.5.2.2  martin 
    388  1.5.2.2  martin 	if (off < 0 || off >= XFB_SIZE) {
    389  1.5.2.2  martin 		return -1;
    390  1.5.2.2  martin 	}
    391  1.5.2.2  martin 
    392  1.5.2.2  martin 	return bus_space_mmap(sc->sc_bst, XFB_START, off, prot,
    393  1.5.2.2  martin 	    BUS_SPACE_MAP_LINEAR | BUS_SPACE_MAP_PREFETCHABLE);
    394  1.5.2.2  martin }
    395