Home | History | Annotate | Line # | Download | only in isa
wss_isa.c revision 1.23.28.1
      1  1.23.28.1    bouyer /*	$NetBSD: wss_isa.c,v 1.23.28.1 2007/10/25 22:38:28 bouyer Exp $	*/
      2        1.1  augustss 
      3        1.1  augustss /*
      4        1.1  augustss  * Copyright (c) 1994 John Brezak
      5        1.1  augustss  * Copyright (c) 1991-1993 Regents of the University of California.
      6        1.1  augustss  * All rights reserved.
      7        1.1  augustss  *
      8        1.1  augustss  * MAD support:
      9        1.1  augustss  * Copyright (c) 1996 Lennart Augustsson
     10        1.1  augustss  * Based on code which is
     11        1.1  augustss  * Copyright (c) 1994 Hannu Savolainen
     12        1.1  augustss  *
     13        1.1  augustss  * Redistribution and use in source and binary forms, with or without
     14        1.1  augustss  * modification, are permitted provided that the following conditions
     15        1.1  augustss  * are met:
     16        1.1  augustss  * 1. Redistributions of source code must retain the above copyright
     17        1.1  augustss  *    notice, this list of conditions and the following disclaimer.
     18        1.1  augustss  * 2. Redistributions in binary form must reproduce the above copyright
     19        1.1  augustss  *    notice, this list of conditions and the following disclaimer in the
     20        1.1  augustss  *    documentation and/or other materials provided with the distribution.
     21        1.1  augustss  * 3. All advertising materials mentioning features or use of this software
     22        1.1  augustss  *    must display the following acknowledgement:
     23        1.1  augustss  *	This product includes software developed by the Computer Systems
     24        1.1  augustss  *	Engineering Group at Lawrence Berkeley Laboratory.
     25        1.1  augustss  * 4. Neither the name of the University nor of the Laboratory may be used
     26        1.1  augustss  *    to endorse or promote products derived from this software without
     27        1.1  augustss  *    specific prior written permission.
     28        1.1  augustss  *
     29        1.1  augustss  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     30        1.1  augustss  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     31        1.1  augustss  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     32        1.1  augustss  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     33        1.1  augustss  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     34        1.1  augustss  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     35        1.1  augustss  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     36        1.1  augustss  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     37        1.1  augustss  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     38        1.1  augustss  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     39        1.1  augustss  * SUCH DAMAGE.
     40        1.1  augustss  *
     41        1.1  augustss  */
     42       1.11     lukem 
     43       1.11     lukem #include <sys/cdefs.h>
     44  1.23.28.1    bouyer __KERNEL_RCSID(0, "$NetBSD: wss_isa.c,v 1.23.28.1 2007/10/25 22:38:28 bouyer Exp $");
     45       1.11     lukem 
     46        1.1  augustss #include <sys/param.h>
     47        1.1  augustss #include <sys/systm.h>
     48        1.5        pk #include <sys/device.h>
     49        1.1  augustss #include <sys/errno.h>
     50        1.1  augustss 
     51  1.23.28.1    bouyer #include <sys/cpu.h>
     52  1.23.28.1    bouyer #include <sys/intr.h>
     53  1.23.28.1    bouyer #include <sys/bus.h>
     54        1.1  augustss 
     55        1.1  augustss #include <sys/audioio.h>
     56        1.1  augustss #include <dev/audio_if.h>
     57        1.1  augustss 
     58        1.1  augustss #include <dev/isa/isavar.h>
     59        1.1  augustss #include <dev/isa/isadmavar.h>
     60        1.1  augustss 
     61        1.1  augustss #include <dev/ic/ad1848reg.h>
     62        1.1  augustss #include <dev/isa/ad1848var.h>
     63        1.1  augustss #include <dev/isa/wssreg.h>
     64        1.1  augustss #include <dev/isa/wssvar.h>
     65        1.1  augustss #include <dev/isa/madreg.h>
     66        1.1  augustss 
     67        1.1  augustss #ifdef AUDIO_DEBUG
     68        1.1  augustss #define DPRINTF(x)	if (wssdebug) printf x
     69        1.1  augustss extern int	wssdebug;
     70        1.1  augustss #else
     71        1.1  augustss #define DPRINTF(x)
     72        1.1  augustss #endif
     73        1.1  augustss 
     74       1.18      kent static int	wssfind(struct device *, struct wss_softc *, int,
     75       1.18      kent 		    struct isa_attach_args *);
     76        1.1  augustss 
     77       1.18      kent static void	madprobe(struct wss_softc *, int);
     78       1.18      kent static void	madunmap(struct wss_softc *);
     79       1.18      kent static int	detect_mad16(struct wss_softc *, int);
     80        1.1  augustss 
     81       1.18      kent int		wss_isa_probe(struct device *, struct cfdata *, void *);
     82       1.18      kent void		wss_isa_attach(struct device *, struct device *, void *);
     83        1.1  augustss 
     84       1.15   thorpej CFATTACH_DECL(wss_isa, sizeof(struct wss_softc),
     85       1.15   thorpej     wss_isa_probe, wss_isa_attach, NULL, NULL);
     86        1.1  augustss 
     87        1.1  augustss /*
     88        1.1  augustss  * Probe for the Microsoft Sound System hardware.
     89        1.1  augustss  */
     90        1.1  augustss int
     91       1.18      kent wss_isa_probe(struct device *parent, struct cfdata *match, void *aux)
     92        1.1  augustss {
     93       1.18      kent 	struct isa_attach_args *ia;
     94       1.18      kent 	struct wss_softc probesc, *sc;
     95       1.18      kent 	struct ad1848_softc *ac;
     96       1.18      kent 
     97       1.18      kent 	ia = aux;
     98       1.18      kent 	sc = &probesc;
     99       1.18      kent 	ac = (struct ad1848_softc *)&sc->sc_ad1848;
    100       1.18      kent 	if (ia->ia_nio < 1)
    101       1.18      kent 		return 0;
    102       1.18      kent 	if (ia->ia_nirq < 1)
    103       1.18      kent 		return 0;
    104       1.18      kent 	if (ia->ia_ndrq < 1)
    105       1.18      kent 		return 0;
    106       1.18      kent 
    107       1.18      kent 	if (ISA_DIRECT_CONFIG(ia))
    108       1.18      kent 		return 0;
    109       1.18      kent 
    110       1.18      kent 	memset(sc, 0, sizeof *sc);
    111       1.18      kent 	ac->sc_dev.dv_cfdata = match;
    112       1.18      kent 	if (wssfind(parent, sc, 1, aux)) {
    113       1.18      kent 		bus_space_unmap(sc->sc_iot, sc->sc_ioh, WSS_CODEC);
    114       1.18      kent 		ad1848_isa_unmap(&sc->sc_ad1848);
    115       1.18      kent 		madunmap(sc);
    116       1.18      kent 		return 1;
    117       1.18      kent 	} else
    118       1.18      kent 		/* Everything is already unmapped */
    119       1.18      kent 		return 0;
    120        1.1  augustss }
    121        1.1  augustss 
    122        1.1  augustss static int
    123       1.23  christos wssfind(struct device *parent, struct wss_softc *sc, int probing,
    124       1.18      kent     struct isa_attach_args *ia)
    125        1.1  augustss {
    126       1.18      kent 	static u_char interrupt_bits[12] = {
    127       1.18      kent 		-1, -1, -1, -1, -1, -1, -1, 0x08, -1, 0x10, 0x18, 0x20
    128       1.18      kent 	};
    129       1.18      kent 	static u_char dma_bits[4] = {1, 2, 0, 3};
    130       1.18      kent 	struct ad1848_softc *ac;
    131       1.18      kent 	int ndrq, playdrq, recdrq;
    132       1.18      kent 
    133       1.18      kent 	ac = &sc->sc_ad1848.sc_ad1848;
    134       1.18      kent 	sc->sc_iot = ia->ia_iot;
    135       1.20   thorpej 	if (device_cfdata(&ac->sc_dev)->cf_flags & 1)
    136       1.18      kent 		madprobe(sc, ia->ia_io[0].ir_addr);
    137       1.18      kent 	else
    138       1.18      kent 		sc->mad_chip_type = MAD_NONE;
    139        1.1  augustss 
    140        1.6   mycroft #if 0
    141       1.18      kent 	if (!WSS_BASE_VALID(ia->ia_io[0].ir_addr)) {
    142       1.18      kent 		DPRINTF(("wss: configured iobase %x invalid\n", ia->ia_iobase));
    143       1.18      kent 		goto bad1;
    144       1.18      kent 	}
    145        1.6   mycroft #endif
    146        1.1  augustss 
    147       1.18      kent 	/* Map the ports upto the AD1848 port */
    148       1.18      kent 	if (bus_space_map(sc->sc_iot, ia->ia_io[0].ir_addr, WSS_CODEC,
    149       1.18      kent 	    0, &sc->sc_ioh))
    150       1.18      kent 		goto bad1;
    151       1.18      kent 
    152       1.18      kent 	ac->sc_iot = sc->sc_iot;
    153       1.18      kent 
    154       1.18      kent 	/* Is there an ad1848 chip at (WSS iobase + WSS_CODEC)? */
    155       1.18      kent 	if (ad1848_isa_mapprobe(&sc->sc_ad1848,
    156       1.18      kent 	    ia->ia_io[0].ir_addr + WSS_CODEC) == 0)
    157       1.18      kent 		goto bad;
    158        1.1  augustss 
    159        1.6   mycroft #if 0
    160       1.18      kent 	/* Setup WSS interrupt and DMA */
    161       1.18      kent 	if (!WSS_DRQ_VALID(ia->ia_drq[0].ir_drq)) {
    162       1.18      kent 		DPRINTF(("wss: configured DMA chan %d invalid\n",
    163       1.18      kent 		    ia->ia_drq[0].ir_drq));
    164       1.18      kent 		goto bad;
    165       1.18      kent 	}
    166        1.6   mycroft #endif
    167       1.18      kent 	sc->wss_playdrq = ia->ia_drq[0].ir_drq;
    168       1.18      kent 	sc->wss_ic      = ia->ia_ic;
    169        1.1  augustss 
    170       1.18      kent 	if (sc->wss_playdrq != ISA_UNKNOWN_DRQ &&
    171       1.18      kent 	    !isa_drq_isfree(sc->wss_ic, sc->wss_playdrq))
    172       1.18      kent 		goto bad;
    173        1.1  augustss 
    174        1.6   mycroft #if 0
    175       1.18      kent 	if (!WSS_IRQ_VALID(ia->ia_irq[0].ir_irq)) {
    176       1.18      kent 		DPRINTF(("wss: configured interrupt %d invalid\n",
    177       1.18      kent 		    ia->ia_irq[0].ir_irq));
    178       1.18      kent 		goto bad;
    179       1.18      kent 	}
    180        1.6   mycroft #endif
    181        1.1  augustss 
    182       1.18      kent 	sc->wss_irq = ia->ia_irq[0].ir_irq;
    183       1.18      kent 
    184       1.18      kent 	playdrq = ia->ia_drq[0].ir_drq;
    185       1.18      kent 	if (ia->ia_ndrq > 1) {
    186       1.18      kent 		ndrq = 2;
    187       1.18      kent 		recdrq = ia->ia_drq[1].ir_drq;
    188       1.18      kent 	} else {
    189       1.18      kent 		ndrq = 1;
    190       1.18      kent 		recdrq = ISA_UNKNOWN_DRQ;
    191       1.18      kent 	}
    192       1.18      kent 
    193       1.18      kent 	if (ac->mode <= 1)
    194       1.18      kent 		ndrq = 1;
    195       1.18      kent 	sc->wss_recdrq =
    196       1.18      kent 	    ac->mode > 1 && ndrq > 1 &&
    197       1.18      kent 	    recdrq != ISA_UNKNOWN_DRQ ? recdrq : playdrq;
    198       1.18      kent 	if (sc->wss_recdrq != sc->wss_playdrq && !isa_drq_isfree(sc->wss_ic,
    199       1.18      kent 	    sc->wss_recdrq))
    200       1.18      kent 		goto bad;
    201       1.18      kent 
    202       1.18      kent 	if (probing) {
    203       1.18      kent 		ia->ia_nio = 1;
    204       1.18      kent 		ia->ia_io[0].ir_size = WSS_NPORT;
    205       1.18      kent 
    206       1.18      kent 		ia->ia_nirq = 1;
    207       1.18      kent 
    208       1.18      kent 		ia->ia_ndrq = ndrq;
    209       1.18      kent 		ia->ia_drq[0].ir_drq = playdrq;
    210       1.18      kent 		if (ndrq > 1)
    211       1.18      kent 			ia->ia_drq[1].ir_drq = recdrq;
    212       1.12   thorpej 
    213       1.18      kent 		ia->ia_niomem = 0;
    214       1.18      kent 	}
    215       1.18      kent 
    216       1.18      kent 	/* XXX recdrq */
    217       1.18      kent 	bus_space_write_1(sc->sc_iot, sc->sc_ioh, WSS_CONFIG,
    218       1.18      kent 	    (interrupt_bits[ia->ia_irq[0].ir_irq] |
    219       1.18      kent 		dma_bits[ia->ia_drq[0].ir_drq]));
    220        1.1  augustss 
    221       1.18      kent 	return 1;
    222        1.1  augustss 
    223        1.1  augustss bad:
    224       1.18      kent 	bus_space_unmap(sc->sc_iot, sc->sc_ioh, WSS_CODEC);
    225        1.1  augustss bad1:
    226       1.18      kent 	madunmap(sc);
    227       1.18      kent 	return 0;
    228        1.1  augustss }
    229        1.1  augustss 
    230        1.1  augustss /*
    231        1.1  augustss  * Attach hardware to driver, attach hardware driver to audio
    232        1.1  augustss  * pseudo-device driver .
    233        1.1  augustss  */
    234        1.1  augustss void
    235       1.18      kent wss_isa_attach(struct device *parent, struct device *self, void *aux)
    236        1.1  augustss {
    237       1.18      kent 	struct wss_softc *sc;
    238       1.18      kent 	struct ad1848_softc *ac;
    239       1.18      kent 	struct isa_attach_args *ia;
    240       1.18      kent 
    241       1.18      kent 	sc = (struct wss_softc *)self;
    242       1.18      kent 	ac = (struct ad1848_softc *)&sc->sc_ad1848;
    243       1.18      kent 	ia = (struct isa_attach_args *)aux;
    244       1.18      kent 	if (!wssfind(parent, sc, 0, ia)) {
    245       1.18      kent 		printf("%s: wssfind failed\n", ac->sc_dev.dv_xname);
    246       1.18      kent 		return;
    247       1.18      kent 	}
    248        1.1  augustss 
    249       1.18      kent 	sc->wss_ic = ia->ia_ic;
    250        1.1  augustss 
    251       1.18      kent 	wssattach(sc);
    252        1.1  augustss }
    253        1.1  augustss 
    254        1.1  augustss /*
    255        1.1  augustss  * Copyright by Hannu Savolainen 1994
    256        1.1  augustss  *
    257        1.1  augustss  * Redistribution and use in source and binary forms, with or without
    258        1.1  augustss  * modification, are permitted provided that the following conditions are
    259        1.1  augustss  * met: 1. Redistributions of source code must retain the above copyright
    260        1.1  augustss  * notice, this list of conditions and the following disclaimer. 2.
    261        1.1  augustss  * Redistributions in binary form must reproduce the above copyright notice,
    262        1.1  augustss  * this list of conditions and the following disclaimer in the documentation
    263        1.1  augustss  * and/or other materials provided with the distribution.
    264        1.1  augustss  *
    265        1.1  augustss  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND ANY
    266        1.1  augustss  * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
    267        1.1  augustss  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
    268        1.1  augustss  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
    269        1.1  augustss  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
    270        1.1  augustss  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
    271        1.1  augustss  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
    272        1.1  augustss  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
    273        1.1  augustss  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
    274        1.1  augustss  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
    275        1.1  augustss  * SUCH DAMAGE.
    276        1.1  augustss  *
    277        1.1  augustss  */
    278        1.1  augustss 
    279        1.1  augustss /*
    280        1.1  augustss  * Initialization code for OPTi MAD16 compatible audio chips. Including
    281        1.1  augustss  *
    282        1.1  augustss  *      OPTi 82C928     MAD16           (replaced by C929)
    283        1.1  augustss  *      OAK OTI-601D    Mozart
    284        1.1  augustss  *      OPTi 82C929     MAD16 Pro
    285        1.1  augustss  *	OPTi 82C931
    286        1.1  augustss  */
    287        1.1  augustss 
    288        1.1  augustss static int
    289       1.18      kent detect_mad16(struct wss_softc *sc, int chip_type)
    290        1.1  augustss {
    291       1.18      kent 	unsigned char tmp, tmp2;
    292        1.1  augustss 
    293       1.18      kent 	sc->mad_chip_type = chip_type;
    294       1.18      kent 	/*
    295       1.18      kent 	 * Check that reading a register doesn't return bus float (0xff)
    296       1.18      kent 	 * when the card is accessed using password. This may fail in case
    297       1.18      kent 	 * the card is in low power mode. Normally at least the power saving mode
    298       1.18      kent 	 * bit should be 0.
    299       1.18      kent 	 */
    300       1.18      kent 	if ((tmp = mad_read(sc, MC1_PORT)) == 0xff) {
    301       1.18      kent 		DPRINTF(("MC1_PORT returned 0xff\n"));
    302       1.18      kent 		return 0;
    303       1.18      kent 	}
    304       1.18      kent 
    305       1.18      kent 	/*
    306       1.18      kent 	 * Now check that the gate is closed on first I/O after writing
    307       1.18      kent 	 * the password. (This is how a MAD16 compatible card works).
    308       1.18      kent 	 */
    309       1.18      kent 	if ((tmp2 = bus_space_read_1(sc->sc_iot, sc->mad_ioh, MC1_PORT)) == tmp) {
    310       1.18      kent 		DPRINTF(("MC1_PORT didn't close after read (0x%02x)\n", tmp2));
    311       1.18      kent 		return 0;
    312       1.18      kent 	}
    313        1.1  augustss 
    314       1.18      kent 	mad_write(sc, MC1_PORT, tmp ^ 0x80);	/* Toggle a bit */
    315        1.1  augustss 
    316       1.18      kent 	/* Compare the bit */
    317       1.18      kent 	if ((tmp2 = mad_read(sc, MC1_PORT)) != (tmp ^ 0x80)) {
    318       1.18      kent 		mad_write(sc, MC1_PORT, tmp);	/* Restore */
    319       1.18      kent 		DPRINTF(("Bit revert test failed (0x%02x, 0x%02x)\n", tmp, tmp2));
    320       1.18      kent 		return 0;
    321       1.18      kent 	}
    322        1.1  augustss 
    323        1.1  augustss 	mad_write(sc, MC1_PORT, tmp);	/* Restore */
    324       1.18      kent 	return 1;
    325        1.1  augustss }
    326        1.1  augustss 
    327        1.1  augustss static void
    328       1.18      kent madprobe(struct wss_softc *sc, int iobase)
    329        1.1  augustss {
    330       1.18      kent 	static int valid_ports[M_WSS_NPORTS] =
    331       1.18      kent 	    { M_WSS_PORT0, M_WSS_PORT1, M_WSS_PORT2, M_WSS_PORT3 };
    332       1.18      kent 	int i;
    333       1.18      kent 
    334       1.18      kent 	/* Allocate bus space that the MAD chip wants */
    335       1.18      kent 	if (bus_space_map(sc->sc_iot, MAD_BASE, MAD_NPORT, 0, &sc->mad_ioh))
    336       1.18      kent 		goto bad0;
    337       1.18      kent 	if (bus_space_map(sc->sc_iot, MAD_REG1, MAD_LEN1, 0, &sc->mad_ioh1))
    338       1.18      kent 		goto bad1;
    339       1.18      kent 	if (bus_space_map(sc->sc_iot, MAD_REG2, MAD_LEN2, 0, &sc->mad_ioh2))
    340       1.18      kent 		goto bad2;
    341       1.18      kent 	if (bus_space_map(sc->sc_iot, MAD_REG3, MAD_LEN3, 0, &sc->sc_opl_ioh))
    342       1.18      kent 		goto bad3;
    343       1.18      kent 
    344       1.18      kent 	DPRINTF(("mad: Detect using password = 0xE2\n"));
    345       1.18      kent 	if (!detect_mad16(sc, MAD_82C928)) {
    346       1.18      kent 		/* No luck. Try different model */
    347       1.18      kent 		DPRINTF(("mad: Detect using password = 0xE3\n"));
    348       1.18      kent 		if (!detect_mad16(sc, MAD_82C929))
    349       1.18      kent 			goto bad;
    350       1.18      kent 		sc->mad_chip_type = MAD_82C929;
    351       1.18      kent 		DPRINTF(("mad: 82C929 detected\n"));
    352        1.1  augustss 	} else {
    353       1.18      kent 		sc->mad_chip_type = MAD_82C928;
    354       1.18      kent 		if ((mad_read(sc, MC3_PORT) & 0x03) == 0x03) {
    355       1.18      kent 			DPRINTF(("mad: Mozart detected\n"));
    356       1.18      kent 			sc->mad_chip_type = MAD_OTI601D;
    357       1.18      kent 		} else {
    358       1.18      kent 			DPRINTF(("mad: 82C928 detected?\n"));
    359       1.18      kent 			sc->mad_chip_type = MAD_82C928;
    360       1.18      kent 		}
    361        1.1  augustss 	}
    362        1.1  augustss 
    363        1.1  augustss #ifdef AUDIO_DEBUG
    364       1.18      kent 	if (wssdebug)
    365       1.18      kent 		for (i = MC1_PORT; i <= MC7_PORT; i++)
    366       1.18      kent 			printf("mad: port %03x = %02x\n", i, mad_read(sc, i));
    367        1.1  augustss #endif
    368        1.1  augustss 
    369       1.18      kent 	/* Set the WSS address. */
    370       1.18      kent 	for (i = 0; i < M_WSS_NPORTS; i++)
    371       1.18      kent 		if (valid_ports[i] == iobase)
    372       1.18      kent 			break;
    373       1.18      kent 	if (i >= M_WSS_NPORTS) {		/* Not a valid port */
    374       1.18      kent 		printf("mad: Bad WSS base address 0x%x\n", iobase);
    375       1.18      kent 		goto bad;
    376       1.18      kent 	}
    377       1.18      kent 	sc->mad_ioindex = i;
    378       1.18      kent 	/* enable WSS emulation at the I/O port, no joystick */
    379       1.18      kent 	mad_write(sc, MC1_PORT, M_WSS_PORT_SELECT(i) | MC1_JOYDISABLE);
    380       1.18      kent 	mad_write(sc, MC2_PORT, 0x03); /* ? */
    381       1.18      kent 	mad_write(sc, MC3_PORT, 0xf0); /* Disable SB */
    382       1.18      kent 	return;
    383        1.1  augustss 
    384        1.1  augustss bad:
    385       1.18      kent 	bus_space_unmap(sc->sc_iot, sc->sc_opl_ioh, MAD_LEN3);
    386        1.1  augustss bad3:
    387       1.18      kent 	bus_space_unmap(sc->sc_iot, sc->mad_ioh2, MAD_LEN2);
    388        1.1  augustss bad2:
    389       1.18      kent 	bus_space_unmap(sc->sc_iot, sc->mad_ioh1, MAD_LEN1);
    390        1.1  augustss bad1:
    391       1.18      kent 	bus_space_unmap(sc->sc_iot, sc->mad_ioh, MAD_NPORT);
    392        1.1  augustss bad0:
    393       1.18      kent 	sc->mad_chip_type = MAD_NONE;
    394        1.1  augustss }
    395        1.1  augustss 
    396        1.1  augustss static void
    397       1.18      kent madunmap(struct wss_softc *sc)
    398        1.1  augustss {
    399       1.18      kent 
    400       1.18      kent 	if (sc->mad_chip_type == MAD_NONE)
    401       1.18      kent 		return;
    402       1.18      kent 	bus_space_unmap(sc->sc_iot, sc->mad_ioh, MAD_NPORT);
    403       1.18      kent 	bus_space_unmap(sc->sc_iot, sc->mad_ioh1, MAD_LEN1);
    404       1.18      kent 	bus_space_unmap(sc->sc_iot, sc->mad_ioh2, MAD_LEN2);
    405       1.18      kent 	bus_space_unmap(sc->sc_iot, sc->sc_opl_ioh, MAD_LEN3);
    406        1.1  augustss }
    407