Home | History | Annotate | Line # | Download | only in isa
wss_isa.c revision 1.9.8.3
      1  1.9.8.3   nathanw /*	$NetBSD: wss_isa.c,v 1.9.8.3 2002/01/11 23:39:15 nathanw 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.9.8.2   nathanw 
     43  1.9.8.2   nathanw #include <sys/cdefs.h>
     44  1.9.8.3   nathanw __KERNEL_RCSID(0, "$NetBSD: wss_isa.c,v 1.9.8.3 2002/01/11 23:39:15 nathanw Exp $");
     45  1.9.8.2   nathanw 
     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.9.8.3   nathanw static int	wssfind __P((struct device *, struct wss_softc *, int,
     75  1.9.8.3   nathanw 		    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.9.8.3   nathanw     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.9.8.3   nathanw     if (ia->ia_nio < 1)
    102  1.9.8.3   nathanw 	return 0;
    103  1.9.8.3   nathanw     if (ia->ia_nirq < 1)
    104  1.9.8.3   nathanw 	return 0;
    105  1.9.8.3   nathanw     if (ia->ia_ndrq < 1)
    106  1.9.8.3   nathanw 	return 0;
    107  1.9.8.3   nathanw 
    108  1.9.8.3   nathanw     if (ISA_DIRECT_CONFIG(ia))
    109  1.9.8.3   nathanw 	return 0;
    110  1.9.8.3   nathanw 
    111  1.9.8.1   nathanw     memset(sc, 0, sizeof *sc);
    112      1.5        pk     ac->sc_dev.dv_cfdata = match;
    113  1.9.8.3   nathanw     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.9.8.3   nathanw wssfind(parent, sc, probing, ia)
    125      1.1  augustss     struct device *parent;
    126      1.1  augustss     struct wss_softc *sc;
    127  1.9.8.3   nathanw     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.9.8.3   nathanw     int ndrq, playdrq, recdrq;
    136  1.9.8.3   nathanw 
    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.9.8.3   nathanw 	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.9.8.3   nathanw     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.9.8.3   nathanw     if (bus_space_map(sc->sc_iot, ia->ia_io[0].ir_addr, WSS_CODEC,
    152  1.9.8.3   nathanw         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.9.8.3   nathanw     if (ad1848_isa_mapprobe(&sc->sc_ad1848,
    159  1.9.8.3   nathanw         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.9.8.3   nathanw     if (!WSS_DRQ_VALID(ia->ia_drq[0].ir_drq)) {
    165  1.9.8.3   nathanw 	DPRINTF(("wss: configured dma chan %d invalid\n",
    166  1.9.8.3   nathanw 	    ia->ia_drq[0].ir_drq));
    167      1.1  augustss 	goto bad;
    168      1.1  augustss     }
    169      1.6   mycroft #endif
    170  1.9.8.3   nathanw     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.9.8.3   nathanw     if (sc->wss_playdrq != ISACF_DRQ_DEFAULT &&
    174  1.9.8.3   nathanw         !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.9.8.3   nathanw     if (!WSS_IRQ_VALID(ia->ia_irq[0].ir_irq)) {
    179  1.9.8.3   nathanw 	DPRINTF(("wss: configured interrupt %d invalid\n",
    180  1.9.8.3   nathanw 	    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.9.8.3   nathanw     sc->wss_irq = ia->ia_irq[0].ir_irq;
    186  1.9.8.3   nathanw 
    187  1.9.8.3   nathanw     playdrq = ia->ia_drq[0].ir_drq;
    188  1.9.8.3   nathanw     if (ia->ia_ndrq > 1) {
    189  1.9.8.3   nathanw 	ndrq = 2;
    190  1.9.8.3   nathanw 	recdrq = ia->ia_drq[1].ir_drq;
    191  1.9.8.3   nathanw     } else {
    192  1.9.8.3   nathanw 	ndrq = 1;
    193  1.9.8.3   nathanw 	recdrq = ISACF_IRQ_DEFAULT;
    194  1.9.8.3   nathanw     }
    195      1.1  augustss 
    196      1.5        pk     if (ac->mode <= 1)
    197  1.9.8.3   nathanw 	ndrq = 1;
    198      1.1  augustss     sc->wss_recdrq =
    199  1.9.8.3   nathanw 	ac->mode > 1 && ndrq > 1 &&
    200  1.9.8.3   nathanw 	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.9.8.3   nathanw     if (probing) {
    206  1.9.8.3   nathanw 	ia->ia_nio = 1;
    207  1.9.8.3   nathanw 	ia->ia_io[0].ir_size = WSS_NPORT;
    208  1.9.8.3   nathanw 
    209  1.9.8.3   nathanw 	ia->ia_nirq = 1;
    210  1.9.8.3   nathanw 
    211  1.9.8.3   nathanw 	ia->ia_ndrq = ndrq;
    212  1.9.8.3   nathanw 	ia->ia_drq[0].ir_drq = playdrq;
    213  1.9.8.3   nathanw 	if (ndrq > 1)
    214  1.9.8.3   nathanw 	    ia->ia_drq[1].ir_drq = recdrq;
    215  1.9.8.3   nathanw 
    216  1.9.8.3   nathanw 	ia->ia_niomem = 0;
    217  1.9.8.3   nathanw     }
    218  1.9.8.3   nathanw 
    219      1.1  augustss     /* XXX recdrq */
    220      1.1  augustss     bus_space_write_1(sc->sc_iot, sc->sc_ioh, WSS_CONFIG,
    221  1.9.8.3   nathanw 		      (interrupt_bits[ia->ia_irq[0].ir_irq] |
    222  1.9.8.3   nathanw 		       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.9.8.3   nathanw     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