Home | History | Annotate | Line # | Download | only in dev
wiifb.c revision 1.5.2.3 
      1  1.5.2.3  martin /* $NetBSD: wiifb.c,v 1.5.2.3 2024/02/06 12:33:17 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.3  martin __KERNEL_RCSID(0, "$NetBSD: wiifb.c,v 1.5.2.3 2024/02/06 12:33:17 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.3  martin #define WIIFB_ERROR_BLINK_INTERVAL	1000000
     47  1.5.2.3  martin 
     48  1.5.2.3  martin #define WIIFB_TOP_BOTTOM_BORDER		16
     49  1.5.2.3  martin #define WIIFB_EFFECTIVE_START(p, w)	\
     50  1.5.2.3  martin 	((uintptr_t)(p) + WIIFB_TOP_BOTTOM_BORDER * (w) * 2)
     51  1.5.2.3  martin #define WIIFB_EFFECTIVE_HEIGHT(h)	\
     52  1.5.2.3  martin 	((h) - WIIFB_TOP_BOTTOM_BORDER * 2)
     53  1.5.2.3  martin 
     54  1.5.2.2  martin 
     55  1.5.2.2  martin struct wiifb_mode {
     56  1.5.2.2  martin 	const char *		name;
     57  1.5.2.2  martin 	u_int			width;
     58  1.5.2.2  martin 	u_int			height;
     59  1.5.2.2  martin 	u_int			lines;
     60  1.5.2.2  martin };
     61  1.5.2.2  martin 
     62  1.5.2.2  martin static uint32_t wiifb_devcmap[16] = {
     63  1.5.2.2  martin 	0x00800080,	/* Black */
     64  1.5.2.2  martin 	0x1dff1d6b,	/* Blue */
     65  1.5.2.2  martin 	0x4b554b4a,	/* Green */
     66  1.5.2.2  martin 	0x80808080,	/* Cyan */
     67  1.5.2.2  martin 	0x4c544cff,	/* Red */
     68  1.5.2.2  martin 	0x3aaa34b5,	/* Magenta */
     69  1.5.2.2  martin 	0x7140718a,	/* Brown */
     70  1.5.2.2  martin 	0xff80ff80,	/* White */
     71  1.5.2.2  martin 	0x80808080,	/* Gray */
     72  1.5.2.2  martin 	0xc399c36a,	/* Bright Blue */
     73  1.5.2.2  martin 	0xd076d074,	/* Bright Green */
     74  1.5.2.2  martin 	0x80808080,	/* Bright Cyan */
     75  1.5.2.2  martin 	0x4c544cff,	/* Bright Red */
     76  1.5.2.2  martin 	0x3aaa34b5,	/* Bright Magenta */
     77  1.5.2.2  martin 	0xe100e194,	/* Bright Yellow */
     78  1.5.2.2  martin 	0xff80ff80	/* Bright White */
     79  1.5.2.2  martin };
     80  1.5.2.2  martin 
     81  1.5.2.2  martin #define WIIFB_MODE_INDEX(fmt, interlaced)	((fmt << 1) | interlaced)
     82  1.5.2.2  martin 
     83  1.5.2.2  martin static const struct wiifb_mode wiifb_modes[] = {
     84  1.5.2.2  martin 	[WIIFB_MODE_INDEX(VI_DCR_FMT_NTSC, 0)] = {
     85  1.5.2.2  martin 		.name = "NTSC 480p",
     86  1.5.2.2  martin 		.width = 640,
     87  1.5.2.2  martin 		.height = 480,
     88  1.5.2.2  martin 		.lines = 525,
     89  1.5.2.2  martin 	},
     90  1.5.2.2  martin 	[WIIFB_MODE_INDEX(VI_DCR_FMT_NTSC, 1)] = {
     91  1.5.2.2  martin 		.name = "NTSC 480i",
     92  1.5.2.2  martin 		.width = 640,
     93  1.5.2.2  martin 		.height = 480,
     94  1.5.2.2  martin 		.lines = 525,
     95  1.5.2.2  martin 	},
     96  1.5.2.2  martin 	[WIIFB_MODE_INDEX(VI_DCR_FMT_PAL, 1)] = {
     97  1.5.2.2  martin 		.name = "PAL 576i",
     98  1.5.2.2  martin 		.width = 640,
     99  1.5.2.2  martin 		.height = 574,
    100  1.5.2.2  martin 		.lines = 625,
    101  1.5.2.2  martin 	},
    102  1.5.2.2  martin 
    103  1.5.2.2  martin };
    104  1.5.2.2  martin #define WIIFB_NMODES	__arraycount(wiifb_modes)
    105  1.5.2.2  martin 
    106  1.5.2.2  martin struct wiifb_softc {
    107  1.5.2.2  martin 	struct genfb_softc	sc_gen;
    108  1.5.2.2  martin 
    109  1.5.2.2  martin 	bus_space_tag_t		sc_bst;
    110  1.5.2.2  martin 	bus_space_handle_t	sc_bsh;
    111  1.5.2.2  martin 
    112  1.5.2.2  martin 	void			*sc_bits;
    113  1.5.2.2  martin 
    114  1.5.2.2  martin 	uint8_t			sc_format;
    115  1.5.2.2  martin 	bool			sc_interlaced;
    116  1.5.2.2  martin 
    117  1.5.2.2  martin 	const struct wiifb_mode	*sc_curmode;
    118  1.5.2.2  martin };
    119  1.5.2.2  martin 
    120  1.5.2.2  martin #define	RD2(sc, reg)		\
    121  1.5.2.2  martin 	bus_space_read_2((sc)->sc_bst, (sc)->sc_bsh, (reg))
    122  1.5.2.2  martin #define	RD4(sc, reg)		\
    123  1.5.2.2  martin 	bus_space_read_4((sc)->sc_bst, (sc)->sc_bsh, (reg))
    124  1.5.2.2  martin #define	WR2(sc, reg, val)	\
    125  1.5.2.2  martin 	bus_space_write_2((sc)->sc_bst, (sc)->sc_bsh, (reg), (val))
    126  1.5.2.2  martin #define	WR4(sc, reg, val)	\
    127  1.5.2.2  martin 	bus_space_write_4((sc)->sc_bst, (sc)->sc_bsh, (reg), (val))
    128  1.5.2.2  martin 
    129  1.5.2.2  martin static int	wiifb_match(device_t, cfdata_t, void *);
    130  1.5.2.2  martin static void	wiifb_attach(device_t, device_t, void *);
    131  1.5.2.2  martin 
    132  1.5.2.2  martin static void	wiifb_init(struct wiifb_softc *);
    133  1.5.2.2  martin static void	wiifb_set_mode(struct wiifb_softc *, uint8_t, bool);
    134  1.5.2.2  martin static void	wiifb_set_fb(struct wiifb_softc *);
    135  1.5.2.2  martin 
    136  1.5.2.2  martin static int	wiifb_ioctl(void *, void *, u_long, void *, int, lwp_t *);
    137  1.5.2.2  martin static paddr_t	wiifb_mmap(void *, void *, off_t, int);
    138  1.5.2.2  martin 
    139  1.5.2.2  martin static struct genfb_ops wiifb_ops = {
    140  1.5.2.2  martin 	.genfb_ioctl = wiifb_ioctl,
    141  1.5.2.2  martin 	.genfb_mmap = wiifb_mmap,
    142  1.5.2.2  martin };
    143  1.5.2.2  martin 
    144  1.5.2.2  martin CFATTACH_DECL_NEW(wiifb, sizeof(struct wiifb_softc),
    145  1.5.2.2  martin 	wiifb_match, wiifb_attach, NULL, NULL);
    146  1.5.2.2  martin 
    147  1.5.2.2  martin static int
    148  1.5.2.2  martin wiifb_match(device_t parent, cfdata_t cf, void *aux)
    149  1.5.2.2  martin {
    150  1.5.2.2  martin 	struct mainbus_attach_args *maa = aux;
    151  1.5.2.2  martin 
    152  1.5.2.2  martin 	return strcmp(maa->maa_name, "genfb") == 0;
    153  1.5.2.2  martin }
    154  1.5.2.2  martin 
    155  1.5.2.2  martin static void
    156  1.5.2.2  martin wiifb_attach(device_t parent, device_t self, void *aux)
    157  1.5.2.2  martin {
    158  1.5.2.2  martin 	struct wiifb_softc *sc = device_private(self);
    159  1.5.2.2  martin 	prop_dictionary_t dict = device_properties(self);
    160  1.5.2.2  martin 	struct mainbus_attach_args *maa = aux;
    161  1.5.2.3  martin 	u_int offset;
    162  1.5.2.3  martin 	uint32_t *p;
    163  1.5.2.2  martin 	int error;
    164  1.5.2.2  martin 
    165  1.5.2.2  martin 	sc->sc_gen.sc_dev = self;
    166  1.5.2.2  martin 	sc->sc_bst = maa->maa_bst;
    167  1.5.2.2  martin 	error = bus_space_map(sc->sc_bst, maa->maa_addr, VI_SIZE, 0,
    168  1.5.2.2  martin 	    &sc->sc_bsh);
    169  1.5.2.2  martin 	if (error != 0) {
    170  1.5.2.2  martin 		panic("couldn't map registers");
    171  1.5.2.2  martin 	}
    172  1.5.2.2  martin 	sc->sc_bits = mapiodev(XFB_START, XFB_SIZE, true);
    173  1.5.2.2  martin 
    174  1.5.2.3  martin 	/*
    175  1.5.2.3  martin 	 * Paint the entire FB black. Use 4-byte accesses as the Wii will
    176  1.5.2.3  martin 	 * ignore 1- and 2- byte writes to uncached memory.
    177  1.5.2.3  martin 	 */
    178  1.5.2.3  martin 	for (p = sc->sc_bits, offset = 0;
    179  1.5.2.3  martin 	     offset < XFB_SIZE;
    180  1.5.2.3  martin 	     offset += 4, p++) {
    181  1.5.2.3  martin 		*p = 0x00800080;
    182  1.5.2.3  martin 	}
    183  1.5.2.3  martin 
    184  1.5.2.2  martin 	wiifb_init(sc);
    185  1.5.2.2  martin 	wiifb_set_mode(sc, sc->sc_format, sc->sc_interlaced);
    186  1.5.2.2  martin 
    187  1.5.2.2  martin 	prop_dictionary_set_uint32(dict, "width", sc->sc_curmode->width);
    188  1.5.2.3  martin 	prop_dictionary_set_uint32(dict, "height",
    189  1.5.2.3  martin 	    WIIFB_EFFECTIVE_HEIGHT(sc->sc_curmode->height));
    190  1.5.2.2  martin 	prop_dictionary_set_uint8(dict, "depth", 16);
    191  1.5.2.2  martin 	prop_dictionary_set_uint32(dict, "address", XFB_START);
    192  1.5.2.2  martin 	prop_dictionary_set_uint32(dict, "virtual_address",
    193  1.5.2.3  martin 	    WIIFB_EFFECTIVE_START(sc->sc_bits, sc->sc_curmode->width));
    194  1.5.2.2  martin 	prop_dictionary_set_uint64(dict, "devcmap", (uintptr_t)wiifb_devcmap);
    195  1.5.2.2  martin 
    196  1.5.2.2  martin 	genfb_init(&sc->sc_gen);
    197  1.5.2.2  martin 
    198  1.5.2.2  martin 	aprint_naive("\n");
    199  1.5.2.2  martin 	aprint_normal(": %s\n", sc->sc_curmode->name);
    200  1.5.2.2  martin 
    201  1.5.2.2  martin 	genfb_cnattach();
    202  1.5.2.2  martin 	prop_dictionary_set_bool(dict, "is_console", true);
    203  1.5.2.2  martin 	genfb_attach(&sc->sc_gen, &wiifb_ops);
    204  1.5.2.2  martin }
    205  1.5.2.2  martin 
    206  1.5.2.2  martin static void
    207  1.5.2.2  martin wiifb_init(struct wiifb_softc *sc)
    208  1.5.2.2  martin {
    209  1.5.2.2  martin 	uint16_t dcr;
    210  1.5.2.2  martin 	uint16_t visel;
    211  1.5.2.2  martin 
    212  1.5.2.2  martin 	/* Read current display format and interlaced settings. */
    213  1.5.2.2  martin 	dcr = RD2(sc, VI_DCR);
    214  1.5.2.2  martin 	if ((dcr & VI_DCR_ENB) != 0) {
    215  1.5.2.2  martin 		sc->sc_format = __SHIFTOUT(dcr, VI_DCR_FMT);
    216  1.5.2.2  martin 		sc->sc_interlaced = (dcr & VI_DCR_NIN) == 0;
    217  1.5.2.2  martin 	} else {
    218  1.5.2.2  martin 		visel = RD2(sc, VI_VISEL);
    219  1.5.2.2  martin 		sc->sc_format = VI_DCR_FMT_NTSC;
    220  1.5.2.2  martin 		sc->sc_interlaced = (visel & VI_VISEL_COMPONENT_CABLE) == 0;
    221  1.5.2.2  martin 	}
    222  1.5.2.2  martin 
    223  1.5.2.2  martin 	/* Reset video interface. */
    224  1.5.2.2  martin 	WR2(sc, VI_DCR, dcr | VI_DCR_RST);
    225  1.5.2.2  martin 	WR2(sc, VI_DCR, dcr & ~VI_DCR_RST);
    226  1.5.2.2  martin }
    227  1.5.2.2  martin 
    228  1.5.2.2  martin static void
    229  1.5.2.2  martin wiifb_set_mode(struct wiifb_softc *sc, uint8_t format, bool interlaced)
    230  1.5.2.2  martin {
    231  1.5.2.2  martin 	u_int modeidx;
    232  1.5.2.2  martin 	u_int strides, reads;
    233  1.5.2.2  martin 
    234  1.5.2.2  martin 	modeidx = WIIFB_MODE_INDEX(format, interlaced);
    235  1.5.2.2  martin 	if (modeidx == WIIFB_MODE_INDEX(VI_DCR_FMT_NTSC, 1)) {
    236  1.5.2.2  martin 		/* NTSC 480i Magic numbers from YAGCD. */
    237  1.5.2.2  martin 		WR2(sc, VI_VTR, 0x0f06);
    238  1.5.2.2  martin 		WR4(sc, VI_HTR0, 0x476901AD);
    239  1.5.2.2  martin 		WR4(sc, VI_HTR1, 0x02EA5140);
    240  1.5.2.2  martin 		WR4(sc, VI_VTO, 0x00030018);
    241  1.5.2.2  martin 		WR4(sc, VI_VTE, 0x00020019);
    242  1.5.2.2  martin 		WR4(sc, VI_BBOI, 0x410C410C);
    243  1.5.2.2  martin 		WR4(sc, VI_BBEI, 0x40ED40ED);
    244  1.5.2.2  martin 	} else if (modeidx == WIIFB_MODE_INDEX(VI_DCR_FMT_NTSC, 0)) {
    245  1.5.2.2  martin 		/* NTSC 480p */
    246  1.5.2.2  martin 		WR2(sc, VI_VTR, 0x1e0c);
    247  1.5.2.2  martin 		WR4(sc, VI_HTR0, 0x476901ad);
    248  1.5.2.2  martin 		WR4(sc, VI_HTR1, 0x030a4940);
    249  1.5.2.2  martin 		WR4(sc, VI_VTO, 0x00060030);
    250  1.5.2.2  martin 		WR4(sc, VI_VTE, 0x00060030);
    251  1.5.2.2  martin 		WR4(sc, VI_BBOI, 0x81d881d8);
    252  1.5.2.2  martin 		WR4(sc, VI_BBEI, 0x81d881d8);
    253  1.5.2.2  martin 	} else if (modeidx == WIIFB_MODE_INDEX(VI_DCR_FMT_PAL, 1)) {
    254  1.5.2.2  martin 		/* PAL 576i */
    255  1.5.2.2  martin 		WR2(sc, VI_VTR, 0x11f5);
    256  1.5.2.2  martin 		WR4(sc, VI_HTR0, 0x4b6a01b0);
    257  1.5.2.2  martin 		WR4(sc, VI_HTR1, 0x02f85640);
    258  1.5.2.2  martin 		WR4(sc, VI_VTO, 0x00010023);
    259  1.5.2.2  martin 		WR4(sc, VI_VTE, 0x00000024);
    260  1.5.2.2  martin 		WR4(sc, VI_BBOI, 0x4d2b4d6d);
    261  1.5.2.2  martin 		WR4(sc, VI_BBEI, 0x4d8a4d4c);
    262  1.5.2.2  martin 	} else {
    263  1.5.2.2  martin 		/*
    264  1.5.2.2  martin 		 * Display mode is not supported. Blink the slot LED to
    265  1.5.2.2  martin 		 * indicate failure.
    266  1.5.2.2  martin 		 */
    267  1.5.2.2  martin 		wii_slot_led_blink(WIIFB_ERROR_BLINK_INTERVAL);
    268  1.5.2.2  martin 	}
    269  1.5.2.2  martin 
    270  1.5.2.3  martin 	if (modeidx >= WIIFB_NMODES || wiifb_modes[modeidx].name == NULL) {
    271  1.5.2.3  martin 		panic("Unsupported format (0x%x) / interlaced (%d) settings",
    272  1.5.2.3  martin 		    sc->sc_format, sc->sc_interlaced);
    273  1.5.2.3  martin 	}
    274  1.5.2.3  martin 	sc->sc_curmode = &wiifb_modes[modeidx];
    275  1.5.2.3  martin 
    276  1.5.2.2  martin 	/* Picture configuration */
    277  1.5.2.2  martin 	strides = (sc->sc_curmode->width * 2) / (interlaced ? 16 : 32);
    278  1.5.2.2  martin 	reads = (sc->sc_curmode->width * 2) / 32;
    279  1.5.2.2  martin 	WR2(sc, VI_PICCONF,
    280  1.5.2.2  martin 	    __SHIFTIN(strides, VI_PICCONF_STRIDES) |
    281  1.5.2.2  martin 	    __SHIFTIN(reads, VI_PICCONF_READS));
    282  1.5.2.2  martin 
    283  1.5.2.2  martin 	/* Horizontal scaler configuration */
    284  1.5.2.2  martin 	if (interlaced) {
    285  1.5.2.2  martin 		WR2(sc, VI_HSR, __SHIFTIN(256, VI_HSR_STP));
    286  1.5.2.2  martin 	} else {
    287  1.5.2.2  martin 		WR2(sc, VI_HSR, __SHIFTIN(244, VI_HSR_STP) | VI_HSR_HS_EN);
    288  1.5.2.2  martin 	}
    289  1.5.2.2  martin 
    290  1.5.2.2  martin 	/* Video clock configuration */
    291  1.5.2.2  martin 	WR2(sc, VI_VICLK,
    292  1.5.2.2  martin 	    interlaced ? VI_VICLK_SEL_27MHZ : VI_VICLK_SEL_54MHZ);
    293  1.5.2.2  martin 
    294  1.5.2.2  martin 	/* Horizontal scaling width */
    295  1.5.2.2  martin 	WR2(sc, VI_HSCALINGW, sc->sc_curmode->width);
    296  1.5.2.2  martin 
    297  1.5.2.2  martin 	/* Set framebuffer address */
    298  1.5.2.2  martin 	wiifb_set_fb(sc);
    299  1.5.2.2  martin }
    300  1.5.2.2  martin 
    301  1.5.2.2  martin static void
    302  1.5.2.2  martin wiifb_set_fb(struct wiifb_softc *sc)
    303  1.5.2.2  martin {
    304  1.5.2.2  martin 	uint32_t taddr = XFB_START;
    305  1.5.2.2  martin 	uint32_t baddr = taddr + (sc->sc_interlaced ?
    306  1.5.2.2  martin 				  sc->sc_curmode->width * 2 : 0);
    307  1.5.2.2  martin 
    308  1.5.2.2  martin 	WR4(sc, VI_TFBL,
    309  1.5.2.2  martin 	    VI_TFBL_PGOFF |
    310  1.5.2.2  martin 	    __SHIFTIN((taddr >> 5), VI_TFBL_FBB) |
    311  1.5.2.2  martin 	    __SHIFTIN((taddr / 2) & 0xf, VI_TFBL_XOF));
    312  1.5.2.2  martin 	WR4(sc, VI_TFBR, 0);
    313  1.5.2.2  martin 
    314  1.5.2.2  martin 	WR4(sc, VI_BFBL,
    315  1.5.2.2  martin 	    VI_BFBL_PGOFF |
    316  1.5.2.2  martin 	    __SHIFTIN((baddr >> 5), VI_BFBL_FBB) |
    317  1.5.2.2  martin 	    __SHIFTIN((baddr / 2) & 0xf, VI_BFBL_XOF));
    318  1.5.2.2  martin 	WR4(sc, VI_BFBR, 0);
    319  1.5.2.2  martin }
    320  1.5.2.2  martin 
    321  1.5.2.2  martin static int
    322  1.5.2.2  martin wiifb_ioctl(void *v, void *vs, u_long cmd, void *data, int flag, lwp_t *l)
    323  1.5.2.2  martin {
    324  1.5.2.2  martin 	struct wiifb_softc *sc = v;
    325  1.5.2.2  martin 	struct wsdisplayio_bus_id *busid;
    326  1.5.2.2  martin 	struct wsdisplayio_fbinfo *fbi;
    327  1.5.2.2  martin 	struct vi_regs *vr;
    328  1.5.2.2  martin 	u_int video;
    329  1.5.2.2  martin 
    330  1.5.2.2  martin 	switch (cmd) {
    331  1.5.2.2  martin 	case WSDISPLAYIO_GTYPE:
    332  1.5.2.2  martin 		*(u_int *)data = WSDISPLAY_TYPE_HOLLYWOOD;
    333  1.5.2.2  martin 		return 0;
    334  1.5.2.2  martin 	case WSDISPLAYIO_GET_BUSID:
    335  1.5.2.2  martin 		busid = data;
    336  1.5.2.2  martin 		busid->bus_type = WSDISPLAYIO_BUS_SOC;
    337  1.5.2.2  martin 		return 0;
    338  1.5.2.2  martin 	case WSDISPLAYIO_GET_FBINFO:
    339  1.5.2.2  martin 		fbi = data;
    340  1.5.2.2  martin 		/*
    341  1.5.2.2  martin 		 * rasops info does not match the pixel encoding due to our
    342  1.5.2.2  martin 		 * devcmap, so fill out fbinfo manually instead of relying
    343  1.5.2.2  martin 		 * on wsdisplayio_get_fbinfo.
    344  1.5.2.2  martin 		 */
    345  1.5.2.2  martin 		fbi->fbi_fboffset = 0;
    346  1.5.2.2  martin 		fbi->fbi_width = sc->sc_curmode->width;
    347  1.5.2.3  martin 		fbi->fbi_height =
    348  1.5.2.3  martin 		    WIIFB_EFFECTIVE_HEIGHT(sc->sc_curmode->height);
    349  1.5.2.2  martin 		fbi->fbi_stride = fbi->fbi_width * 2;
    350  1.5.2.3  martin 		fbi->fbi_fbsize = fbi->fbi_height * fbi->fbi_stride;
    351  1.5.2.2  martin 		fbi->fbi_bitsperpixel = 16;
    352  1.5.2.2  martin 		fbi->fbi_pixeltype = WSFB_YUY2;
    353  1.5.2.2  martin 		fbi->fbi_flags = WSFB_VRAM_IS_RAM;
    354  1.5.2.2  martin 		return 0;
    355  1.5.2.2  martin 
    356  1.5.2.2  martin 	case WSDISPLAYIO_SVIDEO:
    357  1.5.2.2  martin 		video = *(u_int *)data;
    358  1.5.2.2  martin 		switch (video) {
    359  1.5.2.2  martin 		case WSDISPLAYIO_VIDEO_OFF:
    360  1.5.2.2  martin 			out32(HW_VIDIM, __SHIFTIN(7, VIDIM_Y) |
    361  1.5.2.2  martin 					__SHIFTIN(7, VIDIM_C) |
    362  1.5.2.2  martin 					VIDIM_E);
    363  1.5.2.2  martin 			return 0;
    364  1.5.2.2  martin 		case WSDISPLAYIO_VIDEO_ON:
    365  1.5.2.2  martin 			out32(HW_VIDIM, 0);
    366  1.5.2.2  martin 			return 0;
    367  1.5.2.2  martin 		default:
    368  1.5.2.2  martin 			return EINVAL;
    369  1.5.2.2  martin 		}
    370  1.5.2.2  martin 
    371  1.5.2.2  martin 	case VIIO_GETREGS:
    372  1.5.2.2  martin 	case VIIO_SETREGS:
    373  1.5.2.2  martin 		vr = data;
    374  1.5.2.2  martin 		switch (vr->bits) {
    375  1.5.2.2  martin 		case 16:
    376  1.5.2.2  martin 			if ((vr->reg & 1) != 0) {
    377  1.5.2.2  martin 				return EINVAL;
    378  1.5.2.2  martin 			}
    379  1.5.2.2  martin 			if (cmd == VIIO_GETREGS) {
    380  1.5.2.2  martin 				vr->val16 = RD2(sc, vr->reg);
    381  1.5.2.2  martin 			} else {
    382  1.5.2.2  martin 				WR2(sc, vr->reg, vr->val16);
    383  1.5.2.2  martin 			}
    384  1.5.2.2  martin 			return 0;
    385  1.5.2.2  martin 		case 32:
    386  1.5.2.2  martin 			if ((vr->reg & 3) != 0) {
    387  1.5.2.2  martin 				return EINVAL;
    388  1.5.2.2  martin 			}
    389  1.5.2.2  martin 			if (cmd == VIIO_GETREGS) {
    390  1.5.2.2  martin 				vr->val32 = RD4(sc, vr->reg);
    391  1.5.2.2  martin 			} else {
    392  1.5.2.2  martin 				WR4(sc, vr->reg, vr->val32);
    393  1.5.2.2  martin 			}
    394  1.5.2.2  martin 			return 0;
    395  1.5.2.2  martin 		default:
    396  1.5.2.2  martin 			return EINVAL;
    397  1.5.2.2  martin 		}
    398  1.5.2.2  martin 		return 0;
    399  1.5.2.2  martin 	}
    400  1.5.2.2  martin 
    401  1.5.2.2  martin 	return EPASSTHROUGH;
    402  1.5.2.2  martin }
    403  1.5.2.2  martin 
    404  1.5.2.2  martin static paddr_t
    405  1.5.2.2  martin wiifb_mmap(void *v, void *vs, off_t off, int prot)
    406  1.5.2.2  martin {
    407  1.5.2.2  martin 	struct wiifb_softc *sc = v;
    408  1.5.2.3  martin 	bus_addr_t start;
    409  1.5.2.3  martin 	bus_size_t size;
    410  1.5.2.3  martin 
    411  1.5.2.3  martin 	start = WIIFB_EFFECTIVE_START(XFB_START, sc->sc_curmode->width);
    412  1.5.2.3  martin 	size = WIIFB_EFFECTIVE_HEIGHT(sc->sc_curmode->height) *
    413  1.5.2.3  martin 	       sc->sc_curmode->width * 2;
    414  1.5.2.2  martin 
    415  1.5.2.3  martin 	if (off < 0 || off >= size) {
    416  1.5.2.2  martin 		return -1;
    417  1.5.2.2  martin 	}
    418  1.5.2.2  martin 
    419  1.5.2.3  martin 	return bus_space_mmap(sc->sc_bst, start, off, prot,
    420  1.5.2.2  martin 	    BUS_SPACE_MAP_LINEAR | BUS_SPACE_MAP_PREFETCHABLE);
    421  1.5.2.2  martin }
    422