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