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