Home | History | Annotate | Line # | Download | only in pci
sv.c revision 1.5
      1  1.5   mycroft /*      $NetBSD: sv.c,v 1.5 1999/02/18 09:22:17 mycroft Exp $ */
      2  1.1  augustss /*      $OpenBSD: sv.c,v 1.2 1998/07/13 01:50:15 csapuntz Exp $ */
      3  1.1  augustss 
      4  1.1  augustss /*
      5  1.3   mycroft  * Copyright (c) 1999 The NetBSD Foundation, Inc.
      6  1.3   mycroft  * All rights reserved.
      7  1.3   mycroft  *
      8  1.3   mycroft  * This code is derived from software contributed to The NetBSD Foundation
      9  1.3   mycroft  * by Charles M. Hannum.
     10  1.3   mycroft  *
     11  1.3   mycroft  * Redistribution and use in source and binary forms, with or without
     12  1.3   mycroft  * modification, are permitted provided that the following conditions
     13  1.3   mycroft  * are met:
     14  1.3   mycroft  * 1. Redistributions of source code must retain the above copyright
     15  1.3   mycroft  *    notice, this list of conditions and the following disclaimer.
     16  1.3   mycroft  * 2. Redistributions in binary form must reproduce the above copyright
     17  1.3   mycroft  *    notice, this list of conditions and the following disclaimer in the
     18  1.3   mycroft  *    documentation and/or other materials provided with the distribution.
     19  1.3   mycroft  * 3. All advertising materials mentioning features or use of this software
     20  1.3   mycroft  *    must display the following acknowledgement:
     21  1.3   mycroft  *        This product includes software developed by the NetBSD
     22  1.3   mycroft  *        Foundation, Inc. and its contributors.
     23  1.3   mycroft  * 4. Neither the name of The NetBSD Foundation nor the names of its
     24  1.3   mycroft  *    contributors may be used to endorse or promote products derived
     25  1.3   mycroft  *    from this software without specific prior written permission.
     26  1.3   mycroft  *
     27  1.3   mycroft  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     28  1.3   mycroft  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     29  1.3   mycroft  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     30  1.3   mycroft  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     31  1.3   mycroft  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     32  1.3   mycroft  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     33  1.3   mycroft  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     34  1.3   mycroft  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     35  1.3   mycroft  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     36  1.3   mycroft  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     37  1.3   mycroft  * POSSIBILITY OF SUCH DAMAGE.
     38  1.3   mycroft  */
     39  1.3   mycroft 
     40  1.3   mycroft /*
     41  1.1  augustss  * Copyright (c) 1998 Constantine Paul Sapuntzakis
     42  1.1  augustss  * All rights reserved
     43  1.1  augustss  *
     44  1.1  augustss  * Author: Constantine Paul Sapuntzakis (csapuntz (at) cvs.openbsd.org)
     45  1.1  augustss  *
     46  1.1  augustss  * Redistribution and use in source and binary forms, with or without
     47  1.1  augustss  * modification, are permitted provided that the following conditions
     48  1.1  augustss  * are met:
     49  1.1  augustss  * 1. Redistributions of source code must retain the above copyright
     50  1.1  augustss  *    notice, this list of conditions and the following disclaimer.
     51  1.1  augustss  * 2. Redistributions in binary form must reproduce the above copyright
     52  1.1  augustss  *    notice, this list of conditions and the following disclaimer in the
     53  1.1  augustss  *    documentation and/or other materials provided with the distribution.
     54  1.1  augustss  * 3. The author's name or those of the contributors may be used to
     55  1.1  augustss  *    endorse or promote products derived from this software without
     56  1.1  augustss  *    specific prior written permission.
     57  1.1  augustss  *
     58  1.1  augustss  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR(S) AND CONTRIBUTORS
     59  1.1  augustss  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     60  1.1  augustss  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     61  1.1  augustss  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     62  1.1  augustss  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     63  1.1  augustss  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     64  1.1  augustss  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     65  1.1  augustss  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     66  1.1  augustss  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     67  1.1  augustss  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     68  1.1  augustss  * POSSIBILITY OF SUCH DAMAGE.
     69  1.1  augustss  */
     70  1.1  augustss 
     71  1.1  augustss /*
     72  1.1  augustss  * S3 SonicVibes driver
     73  1.1  augustss  *   Heavily based on the eap driver by Lennart Augustsson
     74  1.1  augustss  */
     75  1.1  augustss 
     76  1.1  augustss #include <sys/param.h>
     77  1.1  augustss #include <sys/systm.h>
     78  1.1  augustss #include <sys/kernel.h>
     79  1.1  augustss #include <sys/malloc.h>
     80  1.1  augustss #include <sys/device.h>
     81  1.1  augustss 
     82  1.1  augustss #include <dev/pci/pcireg.h>
     83  1.1  augustss #include <dev/pci/pcivar.h>
     84  1.1  augustss #include <dev/pci/pcidevs.h>
     85  1.1  augustss 
     86  1.1  augustss #include <sys/audioio.h>
     87  1.1  augustss #include <dev/audio_if.h>
     88  1.1  augustss #include <dev/mulaw.h>
     89  1.1  augustss #include <dev/auconv.h>
     90  1.1  augustss 
     91  1.1  augustss #include <dev/ic/i8237reg.h>
     92  1.1  augustss #include <dev/pci/svreg.h>
     93  1.1  augustss #include <dev/pci/svvar.h>
     94  1.1  augustss 
     95  1.1  augustss #include <machine/bus.h>
     96  1.1  augustss 
     97  1.1  augustss #ifdef AUDIO_DEBUG
     98  1.1  augustss #define DPRINTF(x)	if (svdebug) printf x
     99  1.1  augustss #define DPRINTFN(n,x)	if (svdebug>(n)) printf x
    100  1.1  augustss int	svdebug = 0;
    101  1.1  augustss #else
    102  1.1  augustss #define DPRINTF(x)
    103  1.1  augustss #define DPRINTFN(n,x)
    104  1.1  augustss #endif
    105  1.1  augustss 
    106  1.1  augustss int	sv_match __P((struct device *, struct cfdata *, void *));
    107  1.1  augustss void	sv_attach __P((struct device *, struct device *, void *));
    108  1.1  augustss int	sv_intr __P((void *));
    109  1.1  augustss 
    110  1.1  augustss struct sv_dma {
    111  1.1  augustss 	bus_dmamap_t map;
    112  1.4   mycroft 	caddr_t addr;
    113  1.4   mycroft 	bus_dma_segment_t segs[1];
    114  1.4   mycroft 	int nsegs;
    115  1.4   mycroft 	size_t size;
    116  1.4   mycroft 	struct sv_dma *next;
    117  1.1  augustss };
    118  1.5   mycroft #define DMAADDR(p) ((p)->map->dm_segs[0].ds_addr)
    119  1.5   mycroft #define KERNADDR(p) ((void *)((p)->addr))
    120  1.1  augustss 
    121  1.1  augustss struct cfattach sv_ca = {
    122  1.1  augustss 	sizeof(struct sv_softc), sv_match, sv_attach
    123  1.1  augustss };
    124  1.1  augustss 
    125  1.1  augustss struct audio_device sv_device = {
    126  1.1  augustss 	"S3 SonicVibes",
    127  1.1  augustss 	"",
    128  1.1  augustss 	"sv"
    129  1.1  augustss };
    130  1.1  augustss 
    131  1.1  augustss #define ARRAY_SIZE(foo)  ((sizeof(foo)) / sizeof(foo[0]))
    132  1.1  augustss 
    133  1.1  augustss int	sv_allocmem __P((struct sv_softc *, size_t, size_t, struct sv_dma *));
    134  1.1  augustss int	sv_freemem __P((struct sv_softc *, struct sv_dma *));
    135  1.1  augustss 
    136  1.1  augustss int	sv_open __P((void *, int));
    137  1.1  augustss void	sv_close __P((void *));
    138  1.1  augustss int	sv_query_encoding __P((void *, struct audio_encoding *));
    139  1.1  augustss int	sv_set_params __P((void *, int, int, struct audio_params *, struct audio_params *));
    140  1.1  augustss int	sv_round_blocksize __P((void *, int));
    141  1.3   mycroft int	sv_trigger_output __P((void *, void *, void *, int, void (*)(void *),
    142  1.3   mycroft 	    void *, struct audio_params *));
    143  1.3   mycroft int	sv_trigger_input __P((void *, void *, void *, int, void (*)(void *),
    144  1.3   mycroft 	    void *, struct audio_params *));
    145  1.3   mycroft int	sv_halt_output __P((void *));
    146  1.3   mycroft int	sv_halt_input __P((void *));
    147  1.1  augustss int	sv_getdev __P((void *, struct audio_device *));
    148  1.1  augustss int	sv_mixer_set_port __P((void *, mixer_ctrl_t *));
    149  1.1  augustss int	sv_mixer_get_port __P((void *, mixer_ctrl_t *));
    150  1.1  augustss int	sv_query_devinfo __P((void *, mixer_devinfo_t *));
    151  1.2   mycroft void   *sv_malloc __P((void *, int, size_t, int, int));
    152  1.1  augustss void	sv_free __P((void *, void *, int));
    153  1.2   mycroft size_t	sv_round_buffersize __P((void *, int, size_t));
    154  1.1  augustss int	sv_mappage __P((void *, void *, int, int));
    155  1.1  augustss int	sv_get_props __P((void *));
    156  1.1  augustss 
    157  1.1  augustss #ifdef AUDIO_DEBUG
    158  1.1  augustss void    sv_dumpregs __P((struct sv_softc *sc));
    159  1.1  augustss #endif
    160  1.1  augustss 
    161  1.1  augustss struct audio_hw_if sv_hw_if = {
    162  1.1  augustss 	sv_open,
    163  1.1  augustss 	sv_close,
    164  1.1  augustss 	NULL,
    165  1.1  augustss 	sv_query_encoding,
    166  1.1  augustss 	sv_set_params,
    167  1.1  augustss 	sv_round_blocksize,
    168  1.1  augustss 	NULL,
    169  1.3   mycroft 	NULL,
    170  1.3   mycroft 	NULL,
    171  1.3   mycroft 	NULL,
    172  1.3   mycroft 	NULL,
    173  1.3   mycroft 	sv_halt_output,
    174  1.3   mycroft 	sv_halt_input,
    175  1.1  augustss 	NULL,
    176  1.1  augustss 	sv_getdev,
    177  1.1  augustss 	NULL,
    178  1.1  augustss 	sv_mixer_set_port,
    179  1.1  augustss 	sv_mixer_get_port,
    180  1.1  augustss 	sv_query_devinfo,
    181  1.1  augustss 	sv_malloc,
    182  1.1  augustss 	sv_free,
    183  1.2   mycroft 	sv_round_buffersize,
    184  1.1  augustss 	sv_mappage,
    185  1.1  augustss 	sv_get_props,
    186  1.3   mycroft 	sv_trigger_output,
    187  1.3   mycroft 	sv_trigger_input,
    188  1.1  augustss };
    189  1.1  augustss 
    190  1.1  augustss 
    191  1.1  augustss static u_int8_t sv_read __P((struct sv_softc *, u_int8_t));
    192  1.1  augustss static u_int8_t sv_read_indirect __P((struct sv_softc *, u_int8_t));
    193  1.1  augustss static void sv_write __P((struct sv_softc *, u_int8_t, u_int8_t ));
    194  1.1  augustss static void sv_write_indirect __P((struct sv_softc *, u_int8_t, u_int8_t ));
    195  1.1  augustss static void sv_init_mixer __P((struct sv_softc *));
    196  1.1  augustss 
    197  1.1  augustss static void sv_defer __P((struct device *self));
    198  1.1  augustss 
    199  1.1  augustss static void
    200  1.1  augustss sv_write (sc, reg, val)
    201  1.1  augustss 	struct sv_softc *sc;
    202  1.1  augustss 	u_int8_t reg, val;
    203  1.1  augustss 
    204  1.1  augustss {
    205  1.1  augustss 	DPRINTFN(8,("sv_write(0x%x, 0x%x)\n", reg, val));
    206  1.1  augustss 	bus_space_write_1(sc->sc_iot, sc->sc_ioh, reg, val);
    207  1.1  augustss }
    208  1.1  augustss 
    209  1.1  augustss static u_int8_t
    210  1.1  augustss sv_read(sc, reg)
    211  1.1  augustss 	struct sv_softc *sc;
    212  1.1  augustss 	u_int8_t reg;
    213  1.1  augustss 
    214  1.1  augustss {
    215  1.1  augustss 	u_int8_t val;
    216  1.1  augustss 
    217  1.1  augustss 	val = bus_space_read_1(sc->sc_iot, sc->sc_ioh, reg);
    218  1.1  augustss 	DPRINTFN(8,("sv_read(0x%x) = 0x%x\n", reg, val));
    219  1.1  augustss 	return val;
    220  1.1  augustss }
    221  1.1  augustss 
    222  1.1  augustss static u_int8_t
    223  1.1  augustss sv_read_indirect(sc, reg)
    224  1.1  augustss 	struct sv_softc *sc;
    225  1.1  augustss 	u_int8_t reg;
    226  1.1  augustss {
    227  1.1  augustss 	u_int8_t val;
    228  1.1  augustss 	int s = splaudio();
    229  1.1  augustss 
    230  1.1  augustss 	sv_write(sc, SV_CODEC_IADDR, reg & SV_IADDR_MASK);
    231  1.1  augustss 	val = sv_read(sc, SV_CODEC_IDATA);
    232  1.1  augustss 	splx(s);
    233  1.1  augustss 	return (val);
    234  1.1  augustss }
    235  1.1  augustss 
    236  1.1  augustss static void
    237  1.1  augustss sv_write_indirect(sc, reg, val)
    238  1.1  augustss 	struct sv_softc *sc;
    239  1.1  augustss 	u_int8_t reg, val;
    240  1.1  augustss {
    241  1.1  augustss 	u_int8_t iaddr = reg & SV_IADDR_MASK;
    242  1.1  augustss 	int s = splaudio();
    243  1.1  augustss 
    244  1.1  augustss 	if (reg == SV_DMA_DATA_FORMAT)
    245  1.1  augustss 		iaddr |= SV_IADDR_MCE;
    246  1.1  augustss 
    247  1.1  augustss 	sv_write(sc, SV_CODEC_IADDR, iaddr);
    248  1.1  augustss 	sv_write(sc, SV_CODEC_IDATA, val);
    249  1.1  augustss 	splx(s);
    250  1.1  augustss }
    251  1.1  augustss 
    252  1.1  augustss int
    253  1.1  augustss sv_match(parent, match, aux)
    254  1.1  augustss 	struct device *parent;
    255  1.1  augustss 	struct cfdata *match;
    256  1.1  augustss 	void *aux;
    257  1.1  augustss {
    258  1.1  augustss 	struct pci_attach_args *pa = aux;
    259  1.1  augustss 
    260  1.1  augustss 	if (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_S3 &&
    261  1.1  augustss 	    PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_S3_SONICVIBES)
    262  1.1  augustss 		return (1);
    263  1.1  augustss 
    264  1.1  augustss 	return (0);
    265  1.1  augustss }
    266  1.1  augustss 
    267  1.1  augustss int pci_alloc_io __P((pci_chipset_tag_t pc, pcitag_t pt,
    268  1.1  augustss 		      int pcioffs,
    269  1.1  augustss 		      bus_space_tag_t iot, bus_size_t size,
    270  1.1  augustss 		      bus_size_t align, bus_size_t bound, int flags,
    271  1.1  augustss 		      bus_space_handle_t *ioh));
    272  1.1  augustss 
    273  1.1  augustss #define PCI_IO_ALLOC_LOW 0xa000
    274  1.1  augustss #define PCI_IO_ALLOC_HIGH 0xb000
    275  1.1  augustss int
    276  1.1  augustss pci_alloc_io(pc, pt, pcioffs, iot, size, align, bound, flags, ioh)
    277  1.1  augustss 	pci_chipset_tag_t pc;
    278  1.1  augustss 	pcitag_t pt;
    279  1.1  augustss 	int pcioffs;
    280  1.1  augustss 	bus_space_tag_t iot;
    281  1.1  augustss 	bus_size_t size;
    282  1.1  augustss 	bus_size_t align;
    283  1.1  augustss 	bus_size_t bound;
    284  1.1  augustss 	int flags;
    285  1.1  augustss 	bus_space_handle_t *ioh;
    286  1.1  augustss {
    287  1.1  augustss 	bus_addr_t addr;
    288  1.1  augustss 	int error;
    289  1.1  augustss 
    290  1.1  augustss 	error = bus_space_alloc(iot, PCI_IO_ALLOC_LOW, PCI_IO_ALLOC_HIGH,
    291  1.1  augustss 				size, align, bound, flags, &addr, ioh);
    292  1.1  augustss 	if (error)
    293  1.1  augustss 		return(error);
    294  1.1  augustss 
    295  1.1  augustss 	pci_conf_write(pc, pt, pcioffs, addr);
    296  1.1  augustss 	return (0);
    297  1.1  augustss }
    298  1.1  augustss 
    299  1.1  augustss /*
    300  1.1  augustss  * Allocate IO addresses when all other configuration is done.
    301  1.1  augustss  */
    302  1.1  augustss void
    303  1.1  augustss sv_defer(self)
    304  1.1  augustss 	struct device *self;
    305  1.1  augustss {
    306  1.1  augustss 	struct sv_softc *sc = (struct sv_softc *)self;
    307  1.1  augustss 	pci_chipset_tag_t pc = sc->sc_pa.pa_pc;
    308  1.1  augustss 	pcitag_t pt = sc->sc_pa.pa_tag;
    309  1.1  augustss 	pcireg_t dmaio;
    310  1.1  augustss 
    311  1.1  augustss 	DPRINTF(("sv_defer: %p\n", sc));
    312  1.1  augustss 	if (pci_alloc_io(pc, pt, SV_DMAA_CONFIG_OFF,
    313  1.1  augustss 			  sc->sc_iot, SV_DMAA_SIZE, SV_DMAA_ALIGN, 0,
    314  1.1  augustss 			  0, &sc->sc_dmaa_ioh)) {
    315  1.1  augustss 		printf("sv_attach: cannot allocate DMA A range\n");
    316  1.1  augustss 		return;
    317  1.1  augustss 	}
    318  1.1  augustss 	dmaio = pci_conf_read(pc, pt, SV_DMAA_CONFIG_OFF);
    319  1.1  augustss 	DPRINTF(("sv_attach: addr a dmaio=0x%lx\n", (u_long)dmaio));
    320  1.1  augustss 	pci_conf_write(pc, pt, SV_DMAA_CONFIG_OFF,
    321  1.1  augustss 		       dmaio | SV_DMA_CHANNEL_ENABLE | SV_DMAA_EXTENDED_ADDR);
    322  1.1  augustss 
    323  1.1  augustss 	if (pci_alloc_io(pc, pt, SV_DMAC_CONFIG_OFF,
    324  1.5   mycroft 			  sc->sc_iot, SV_DMAC_SIZE, SV_DMAC_ALIGN, 0,
    325  1.1  augustss 			  0, &sc->sc_dmac_ioh)) {
    326  1.1  augustss 		printf("sv_attach: cannot allocate DMA C range\n");
    327  1.1  augustss 		return;
    328  1.1  augustss 	}
    329  1.1  augustss 	dmaio = pci_conf_read(pc, pt, SV_DMAC_CONFIG_OFF);
    330  1.1  augustss 	DPRINTF(("sv_attach: addr c dmaio=0x%lx\n", (u_long)dmaio));
    331  1.1  augustss 	pci_conf_write(pc, pt, SV_DMAC_CONFIG_OFF,
    332  1.1  augustss 		       dmaio | SV_DMA_CHANNEL_ENABLE);
    333  1.1  augustss 
    334  1.1  augustss 	sc->sc_dmaset = 1;
    335  1.1  augustss }
    336  1.1  augustss 
    337  1.1  augustss void
    338  1.1  augustss sv_attach(parent, self, aux)
    339  1.1  augustss 	struct device *parent, *self;
    340  1.1  augustss 	void *aux;
    341  1.1  augustss {
    342  1.1  augustss 	struct sv_softc *sc = (struct sv_softc *)self;
    343  1.1  augustss 	struct pci_attach_args *pa = aux;
    344  1.1  augustss 	pci_chipset_tag_t pc = pa->pa_pc;
    345  1.1  augustss 	pcitag_t pt = pa->pa_tag;
    346  1.1  augustss 	pci_intr_handle_t ih;
    347  1.1  augustss 	pcireg_t csr;
    348  1.1  augustss 	char const *intrstr;
    349  1.1  augustss 	u_int8_t reg;
    350  1.1  augustss 	struct audio_attach_args arg;
    351  1.1  augustss 
    352  1.1  augustss 	printf ("\n");
    353  1.1  augustss 
    354  1.1  augustss 	/* Map I/O registers */
    355  1.1  augustss 	if (pci_mapreg_map(pa, SV_ENHANCED_PORTBASE_SLOT,
    356  1.1  augustss 			   PCI_MAPREG_TYPE_IO, 0,
    357  1.1  augustss 			   &sc->sc_iot, &sc->sc_ioh, NULL, NULL)) {
    358  1.1  augustss 		printf("%s: can't map enhanced i/o space\n",
    359  1.1  augustss 		       sc->sc_dev.dv_xname);
    360  1.1  augustss 		return;
    361  1.1  augustss 	}
    362  1.1  augustss 	if (pci_mapreg_map(pa, SV_FM_PORTBASE_SLOT,
    363  1.1  augustss 			   PCI_MAPREG_TYPE_IO, 0,
    364  1.1  augustss 			   &sc->sc_opliot, &sc->sc_oplioh, NULL, NULL)) {
    365  1.1  augustss 		printf("%s: can't map FM i/o space\n", sc->sc_dev.dv_xname);
    366  1.1  augustss 		return;
    367  1.1  augustss 	}
    368  1.1  augustss 	if (pci_mapreg_map(pa, SV_MIDI_PORTBASE_SLOT,
    369  1.1  augustss 			   PCI_MAPREG_TYPE_IO, 0,
    370  1.1  augustss 			   &sc->sc_midiiot, &sc->sc_midiioh, NULL, NULL)) {
    371  1.1  augustss 		printf("%s: can't map MIDI i/o space\n", sc->sc_dev.dv_xname);
    372  1.1  augustss 		return;
    373  1.1  augustss 	}
    374  1.1  augustss 	DPRINTF(("sv: IO ports: enhanced=0x%x, OPL=0x%x, MIDI=0x%x\n",
    375  1.1  augustss 		 (int)sc->sc_ioh, (int)sc->sc_oplioh, (int)sc->sc_midiioh));
    376  1.1  augustss 
    377  1.1  augustss 	sc->sc_dmatag = pa->pa_dmat;
    378  1.1  augustss 
    379  1.5   mycroft 	pci_conf_write(pc, pt, SV_DMAA_CONFIG_OFF, SV_DMAA_EXTENDED_ADDR);
    380  1.1  augustss 	pci_conf_write(pc, pt, SV_DMAC_CONFIG_OFF, 0);
    381  1.1  augustss 
    382  1.1  augustss 	/* Enable the device. */
    383  1.1  augustss 	csr = pci_conf_read(pc, pt, PCI_COMMAND_STATUS_REG);
    384  1.1  augustss 	pci_conf_write(pc, pt, PCI_COMMAND_STATUS_REG,
    385  1.1  augustss 		       csr | PCI_COMMAND_MASTER_ENABLE);
    386  1.1  augustss 
    387  1.1  augustss 	sv_write_indirect(sc, SV_ANALOG_POWER_DOWN_CONTROL, 0);
    388  1.1  augustss 	sv_write_indirect(sc, SV_DIGITAL_POWER_DOWN_CONTROL, 0);
    389  1.1  augustss 
    390  1.1  augustss 	/* initialize codec registers */
    391  1.1  augustss 	reg = sv_read(sc, SV_CODEC_CONTROL);
    392  1.1  augustss 	reg |= SV_CTL_RESET;
    393  1.1  augustss 	sv_write(sc, SV_CODEC_CONTROL, reg);
    394  1.1  augustss 	delay(50);
    395  1.1  augustss 
    396  1.1  augustss 	reg = sv_read(sc, SV_CODEC_CONTROL);
    397  1.1  augustss 	reg &= ~SV_CTL_RESET;
    398  1.1  augustss 	reg |= SV_CTL_INTA | SV_CTL_ENHANCED;
    399  1.1  augustss 
    400  1.1  augustss 	/* This write clears the reset */
    401  1.1  augustss 	sv_write(sc, SV_CODEC_CONTROL, reg);
    402  1.1  augustss 	delay(50);
    403  1.1  augustss 
    404  1.1  augustss 	/* This write actually shoves the new values in */
    405  1.1  augustss 	sv_write(sc, SV_CODEC_CONTROL, reg);
    406  1.1  augustss 
    407  1.1  augustss 	DPRINTF(("sv_attach: control=0x%x\n", sv_read(sc, SV_CODEC_CONTROL)));
    408  1.1  augustss 
    409  1.1  augustss 	/* Enable DMA interrupts */
    410  1.1  augustss 	reg = sv_read(sc, SV_CODEC_INTMASK);
    411  1.1  augustss 	reg &= ~(SV_INTMASK_DMAA | SV_INTMASK_DMAC);
    412  1.1  augustss 	reg |= SV_INTMASK_UD | SV_INTMASK_SINT | SV_INTMASK_MIDI;
    413  1.1  augustss 	sv_write(sc, SV_CODEC_INTMASK, reg);
    414  1.1  augustss 
    415  1.1  augustss 	sv_read(sc, SV_CODEC_STATUS);
    416  1.1  augustss 
    417  1.1  augustss 	/* Map and establish the interrupt. */
    418  1.1  augustss 	if (pci_intr_map(pc, pa->pa_intrtag, pa->pa_intrpin,
    419  1.1  augustss 			 pa->pa_intrline, &ih)) {
    420  1.1  augustss 		printf("%s: couldn't map interrupt\n", sc->sc_dev.dv_xname);
    421  1.1  augustss 		return;
    422  1.1  augustss 	}
    423  1.1  augustss 	intrstr = pci_intr_string(pc, ih);
    424  1.1  augustss 	sc->sc_ih = pci_intr_establish(pc, ih, IPL_AUDIO, sv_intr, sc);
    425  1.1  augustss 	if (sc->sc_ih == NULL) {
    426  1.1  augustss 		printf("%s: couldn't establish interrupt",
    427  1.1  augustss 		       sc->sc_dev.dv_xname);
    428  1.1  augustss 		if (intrstr != NULL)
    429  1.1  augustss 			printf(" at %s", intrstr);
    430  1.1  augustss 		printf("\n");
    431  1.1  augustss 		return;
    432  1.1  augustss 	}
    433  1.1  augustss 	printf("%s: interrupting at %s\n", sc->sc_dev.dv_xname, intrstr);
    434  1.1  augustss 	printf("%s: rev %d", sc->sc_dev.dv_xname,
    435  1.1  augustss 	       sv_read_indirect(sc, SV_REVISION_LEVEL));
    436  1.1  augustss 	if (sv_read(sc, SV_CODEC_CONTROL) & SV_CTL_MD1)
    437  1.1  augustss 		printf(", reverb SRAM present");
    438  1.1  augustss 	if (!(sv_read_indirect(sc, SV_WAVETABLE_SOURCE_SELECT) & SV_WSS_WT0))
    439  1.1  augustss 		printf(", wavetable ROM present");
    440  1.1  augustss 	printf("\n");
    441  1.1  augustss 
    442  1.1  augustss 	sv_init_mixer(sc);
    443  1.1  augustss 
    444  1.1  augustss 	audio_attach_mi(&sv_hw_if, sc, &sc->sc_dev);
    445  1.1  augustss 
    446  1.1  augustss 	arg.type = AUDIODEV_TYPE_OPL;
    447  1.1  augustss 	arg.hwif = 0;
    448  1.1  augustss 	arg.hdl = 0;
    449  1.1  augustss 	(void)config_found(&sc->sc_dev, &arg, audioprint);
    450  1.1  augustss 
    451  1.1  augustss 	sc->sc_pa = *pa;	/* for deferred setup */
    452  1.1  augustss 	config_defer(self, sv_defer);
    453  1.1  augustss }
    454  1.1  augustss 
    455  1.1  augustss #ifdef AUDIO_DEBUG
    456  1.1  augustss void
    457  1.1  augustss sv_dumpregs(sc)
    458  1.1  augustss 	struct sv_softc *sc;
    459  1.1  augustss {
    460  1.1  augustss 	int idx;
    461  1.1  augustss 
    462  1.1  augustss #if 0
    463  1.1  augustss 	for (idx = 0; idx < 0x50; idx += 4)
    464  1.1  augustss 		printf ("%02x = %x\n", idx,
    465  1.1  augustss 			pci_conf_read(pa->pa_pc, pa->pa_tag, idx));
    466  1.1  augustss #endif
    467  1.1  augustss 
    468  1.1  augustss 	for (idx = 0; idx < 6; idx++)
    469  1.1  augustss 		printf ("REG %02x = %02x\n", idx, sv_read(sc, idx));
    470  1.1  augustss 
    471  1.1  augustss 	for (idx = 0; idx < 0x32; idx++)
    472  1.1  augustss 		printf ("IREG %02x = %02x\n", idx, sv_read_indirect(sc, idx));
    473  1.1  augustss 
    474  1.1  augustss 	for (idx = 0; idx < 0x10; idx++)
    475  1.1  augustss 		printf ("DMA %02x = %02x\n", idx,
    476  1.1  augustss 			bus_space_read_1(sc->sc_iot, sc->sc_dmaa_ioh, idx));
    477  1.1  augustss }
    478  1.1  augustss #endif
    479  1.1  augustss 
    480  1.1  augustss int
    481  1.1  augustss sv_intr(p)
    482  1.1  augustss 	void *p;
    483  1.1  augustss {
    484  1.1  augustss 	struct sv_softc *sc = p;
    485  1.1  augustss 	u_int8_t intr;
    486  1.1  augustss 
    487  1.1  augustss 	intr = sv_read(sc, SV_CODEC_STATUS);
    488  1.1  augustss 	DPRINTFN(5,("sv_intr: intr=0x%x\n", intr));
    489  1.1  augustss 
    490  1.1  augustss 	if (!(intr & (SV_INTSTATUS_DMAA | SV_INTSTATUS_DMAC)))
    491  1.1  augustss 		return (0);
    492  1.1  augustss 
    493  1.1  augustss 	if (intr & SV_INTSTATUS_DMAA) {
    494  1.1  augustss 		if (sc->sc_pintr)
    495  1.1  augustss 			sc->sc_pintr(sc->sc_parg);
    496  1.1  augustss 	}
    497  1.1  augustss 
    498  1.1  augustss 	if (intr & SV_INTSTATUS_DMAC) {
    499  1.1  augustss 		if (sc->sc_rintr)
    500  1.1  augustss 			sc->sc_rintr(sc->sc_rarg);
    501  1.1  augustss 	}
    502  1.1  augustss 
    503  1.1  augustss 	return (1);
    504  1.1  augustss }
    505  1.1  augustss 
    506  1.1  augustss int
    507  1.1  augustss sv_allocmem(sc, size, align, p)
    508  1.1  augustss 	struct sv_softc *sc;
    509  1.1  augustss 	size_t size;
    510  1.1  augustss 	size_t align;
    511  1.4   mycroft 	struct sv_dma *p;
    512  1.1  augustss {
    513  1.1  augustss 	int error;
    514  1.1  augustss 
    515  1.1  augustss 	p->size = size;
    516  1.1  augustss 	error = bus_dmamem_alloc(sc->sc_dmatag, p->size, align, 0,
    517  1.1  augustss 				 p->segs, ARRAY_SIZE(p->segs),
    518  1.1  augustss 				 &p->nsegs, BUS_DMA_NOWAIT);
    519  1.1  augustss 	if (error)
    520  1.1  augustss 		return (error);
    521  1.1  augustss 
    522  1.1  augustss 	error = bus_dmamem_map(sc->sc_dmatag, p->segs, p->nsegs, p->size,
    523  1.1  augustss 			       &p->addr, BUS_DMA_NOWAIT|BUS_DMA_COHERENT);
    524  1.1  augustss 	if (error)
    525  1.1  augustss 		goto free;
    526  1.1  augustss 
    527  1.1  augustss 	error = bus_dmamap_create(sc->sc_dmatag, p->size, 1, p->size,
    528  1.1  augustss 				  0, BUS_DMA_NOWAIT, &p->map);
    529  1.1  augustss 	if (error)
    530  1.1  augustss 		goto unmap;
    531  1.1  augustss 
    532  1.1  augustss 	error = bus_dmamap_load(sc->sc_dmatag, p->map, p->addr, p->size, NULL,
    533  1.1  augustss 				BUS_DMA_NOWAIT);
    534  1.1  augustss 	if (error)
    535  1.1  augustss 		goto destroy;
    536  1.5   mycroft 	DPRINTF(("sv_allocmem: pa=%lx va=%lx pba=%lx\n",
    537  1.5   mycroft 	    (long)p->segs[0].ds_addr, (long)KERNADDR(p), (long)DMAADDR(p)));
    538  1.1  augustss 	return (0);
    539  1.1  augustss 
    540  1.1  augustss destroy:
    541  1.1  augustss 	bus_dmamap_destroy(sc->sc_dmatag, p->map);
    542  1.1  augustss unmap:
    543  1.1  augustss 	bus_dmamem_unmap(sc->sc_dmatag, p->addr, p->size);
    544  1.1  augustss free:
    545  1.1  augustss 	bus_dmamem_free(sc->sc_dmatag, p->segs, p->nsegs);
    546  1.1  augustss 	return (error);
    547  1.1  augustss }
    548  1.1  augustss 
    549  1.1  augustss int
    550  1.1  augustss sv_freemem(sc, p)
    551  1.1  augustss 	struct sv_softc *sc;
    552  1.4   mycroft 	struct sv_dma *p;
    553  1.1  augustss {
    554  1.1  augustss 	bus_dmamap_unload(sc->sc_dmatag, p->map);
    555  1.1  augustss 	bus_dmamap_destroy(sc->sc_dmatag, p->map);
    556  1.1  augustss 	bus_dmamem_unmap(sc->sc_dmatag, p->addr, p->size);
    557  1.1  augustss 	bus_dmamem_free(sc->sc_dmatag, p->segs, p->nsegs);
    558  1.1  augustss 	return (0);
    559  1.1  augustss }
    560  1.1  augustss 
    561  1.1  augustss int
    562  1.1  augustss sv_open(addr, flags)
    563  1.1  augustss 	void *addr;
    564  1.1  augustss 	int flags;
    565  1.1  augustss {
    566  1.1  augustss 	struct sv_softc *sc = addr;
    567  1.1  augustss 
    568  1.1  augustss 	DPRINTF(("sv_open\n"));
    569  1.1  augustss 	if (!sc->sc_dmaset)
    570  1.1  augustss 		return (ENXIO);
    571  1.1  augustss 	sc->sc_pintr = 0;
    572  1.1  augustss 	sc->sc_rintr = 0;
    573  1.1  augustss 
    574  1.1  augustss 	return (0);
    575  1.1  augustss }
    576  1.1  augustss 
    577  1.1  augustss /*
    578  1.1  augustss  * Close function is called at splaudio().
    579  1.1  augustss  */
    580  1.1  augustss void
    581  1.1  augustss sv_close(addr)
    582  1.1  augustss 	void *addr;
    583  1.1  augustss {
    584  1.1  augustss 	struct sv_softc *sc = addr;
    585  1.1  augustss 
    586  1.1  augustss 	DPRINTF(("sv_close\n"));
    587  1.4   mycroft 	sv_halt_output(sc);
    588  1.4   mycroft 	sv_halt_input(sc);
    589  1.1  augustss 
    590  1.4   mycroft 	sc->sc_pintr = 0;
    591  1.4   mycroft 	sc->sc_rintr = 0;
    592  1.1  augustss }
    593  1.1  augustss 
    594  1.1  augustss int
    595  1.1  augustss sv_query_encoding(addr, fp)
    596  1.1  augustss 	void *addr;
    597  1.1  augustss 	struct audio_encoding *fp;
    598  1.1  augustss {
    599  1.1  augustss 	switch (fp->index) {
    600  1.1  augustss 	case 0:
    601  1.1  augustss 		strcpy(fp->name, AudioEulinear);
    602  1.1  augustss 		fp->encoding = AUDIO_ENCODING_ULINEAR;
    603  1.1  augustss 		fp->precision = 8;
    604  1.1  augustss 		fp->flags = 0;
    605  1.1  augustss 		return (0);
    606  1.1  augustss 	case 1:
    607  1.1  augustss 		strcpy(fp->name, AudioEmulaw);
    608  1.1  augustss 		fp->encoding = AUDIO_ENCODING_ULAW;
    609  1.1  augustss 		fp->precision = 8;
    610  1.1  augustss 		fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
    611  1.1  augustss 		return (0);
    612  1.1  augustss 	case 2:
    613  1.1  augustss 		strcpy(fp->name, AudioEalaw);
    614  1.1  augustss 		fp->encoding = AUDIO_ENCODING_ALAW;
    615  1.1  augustss 		fp->precision = 8;
    616  1.1  augustss 		fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
    617  1.1  augustss 		return (0);
    618  1.1  augustss 	case 3:
    619  1.1  augustss 		strcpy(fp->name, AudioEslinear);
    620  1.1  augustss 		fp->encoding = AUDIO_ENCODING_SLINEAR;
    621  1.1  augustss 		fp->precision = 8;
    622  1.1  augustss 		fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
    623  1.1  augustss 		return (0);
    624  1.4   mycroft 	case 4:
    625  1.1  augustss 		strcpy(fp->name, AudioEslinear_le);
    626  1.1  augustss 		fp->encoding = AUDIO_ENCODING_SLINEAR_LE;
    627  1.1  augustss 		fp->precision = 16;
    628  1.1  augustss 		fp->flags = 0;
    629  1.1  augustss 		return (0);
    630  1.1  augustss 	case 5:
    631  1.1  augustss 		strcpy(fp->name, AudioEulinear_le);
    632  1.1  augustss 		fp->encoding = AUDIO_ENCODING_ULINEAR_LE;
    633  1.1  augustss 		fp->precision = 16;
    634  1.1  augustss 		fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
    635  1.1  augustss 		return (0);
    636  1.1  augustss 	case 6:
    637  1.1  augustss 		strcpy(fp->name, AudioEslinear_be);
    638  1.1  augustss 		fp->encoding = AUDIO_ENCODING_SLINEAR_BE;
    639  1.1  augustss 		fp->precision = 16;
    640  1.1  augustss 		fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
    641  1.1  augustss 		return (0);
    642  1.1  augustss 	case 7:
    643  1.1  augustss 		strcpy(fp->name, AudioEulinear_be);
    644  1.1  augustss 		fp->encoding = AUDIO_ENCODING_ULINEAR_BE;
    645  1.1  augustss 		fp->precision = 16;
    646  1.1  augustss 		fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
    647  1.1  augustss 		return (0);
    648  1.1  augustss 	default:
    649  1.1  augustss 		return (EINVAL);
    650  1.1  augustss 	}
    651  1.1  augustss }
    652  1.1  augustss 
    653  1.1  augustss int
    654  1.3   mycroft sv_set_params(addr, setmode, usemode, play, rec)
    655  1.1  augustss 	void *addr;
    656  1.1  augustss 	int setmode, usemode;
    657  1.3   mycroft 	struct audio_params *play, *rec;
    658  1.1  augustss {
    659  1.1  augustss 	struct sv_softc *sc = addr;
    660  1.3   mycroft 	struct audio_params *p;
    661  1.3   mycroft 	int mode;
    662  1.4   mycroft 	u_int32_t val;
    663  1.1  augustss 
    664  1.3   mycroft 	/*
    665  1.3   mycroft 	 * This device only has one clock, so make the sample rates match.
    666  1.3   mycroft 	 */
    667  1.3   mycroft 	if (play->sample_rate != rec->sample_rate &&
    668  1.3   mycroft 	    usemode == (AUMODE_PLAY | AUMODE_RECORD)) {
    669  1.3   mycroft 		if (setmode == AUMODE_PLAY) {
    670  1.3   mycroft 			rec->sample_rate = play->sample_rate;
    671  1.3   mycroft 			setmode |= AUMODE_RECORD;
    672  1.3   mycroft 		} else if (setmode == AUMODE_RECORD) {
    673  1.3   mycroft 			play->sample_rate = rec->sample_rate;
    674  1.3   mycroft 			setmode |= AUMODE_PLAY;
    675  1.3   mycroft 		} else
    676  1.3   mycroft 			return (EINVAL);
    677  1.3   mycroft 	}
    678  1.1  augustss 
    679  1.3   mycroft 	for (mode = AUMODE_RECORD; mode != -1;
    680  1.3   mycroft 	     mode = mode == AUMODE_RECORD ? AUMODE_PLAY : -1) {
    681  1.3   mycroft 		if ((setmode & mode) == 0)
    682  1.3   mycroft 			continue;
    683  1.3   mycroft 
    684  1.3   mycroft 		p = mode == AUMODE_PLAY ? play : rec;
    685  1.3   mycroft 
    686  1.3   mycroft 		if (p->sample_rate < 2000 || p->sample_rate > 48000 ||
    687  1.3   mycroft 		    (p->precision != 8 && p->precision != 16) ||
    688  1.3   mycroft 		    (p->channels != 1 && p->channels != 2))
    689  1.3   mycroft 			return (EINVAL);
    690  1.1  augustss 
    691  1.3   mycroft 		p->factor = 1;
    692  1.3   mycroft 		p->sw_code = 0;
    693  1.3   mycroft 		switch (p->encoding) {
    694  1.3   mycroft 		case AUDIO_ENCODING_SLINEAR_BE:
    695  1.3   mycroft 			if (p->precision == 16)
    696  1.3   mycroft 				p->sw_code = swap_bytes;
    697  1.3   mycroft 			else
    698  1.3   mycroft 				p->sw_code = change_sign8;
    699  1.3   mycroft 			break;
    700  1.3   mycroft 		case AUDIO_ENCODING_SLINEAR_LE:
    701  1.3   mycroft 			if (p->precision != 16)
    702  1.3   mycroft 				p->sw_code = change_sign8;
    703  1.3   mycroft 			break;
    704  1.3   mycroft 		case AUDIO_ENCODING_ULINEAR_BE:
    705  1.3   mycroft 			if (p->precision == 16) {
    706  1.3   mycroft 				if (mode == AUMODE_PLAY)
    707  1.3   mycroft 					p->sw_code = swap_bytes_change_sign16;
    708  1.3   mycroft 				else
    709  1.3   mycroft 					p->sw_code = change_sign16_swap_bytes;
    710  1.3   mycroft 			}
    711  1.3   mycroft 			break;
    712  1.3   mycroft 		case AUDIO_ENCODING_ULINEAR_LE:
    713  1.3   mycroft 			if (p->precision == 16)
    714  1.3   mycroft 				p->sw_code = change_sign16;
    715  1.3   mycroft 			break;
    716  1.3   mycroft 		case AUDIO_ENCODING_ULAW:
    717  1.3   mycroft 			if (mode == AUMODE_PLAY) {
    718  1.3   mycroft 				p->factor = 2;
    719  1.3   mycroft 				p->sw_code = mulaw_to_slinear16;
    720  1.3   mycroft 			} else
    721  1.3   mycroft 				p->sw_code = ulinear8_to_mulaw;
    722  1.3   mycroft 			break;
    723  1.3   mycroft 		case AUDIO_ENCODING_ALAW:
    724  1.3   mycroft 			if (mode == AUMODE_PLAY) {
    725  1.3   mycroft 				p->factor = 2;
    726  1.3   mycroft 				p->sw_code = alaw_to_slinear16;
    727  1.3   mycroft 			} else
    728  1.3   mycroft 				p->sw_code = ulinear8_to_alaw;
    729  1.3   mycroft 			break;
    730  1.3   mycroft 		default:
    731  1.3   mycroft 			return (EINVAL);
    732  1.3   mycroft 		}
    733  1.3   mycroft 	}
    734  1.3   mycroft 
    735  1.1  augustss 	val = p->sample_rate * 65536 / 48000;
    736  1.1  augustss 
    737  1.3   mycroft 	sv_write_indirect(sc, SV_PCM_SAMPLE_RATE_0, val & 0xff);
    738  1.3   mycroft 	sv_write_indirect(sc, SV_PCM_SAMPLE_RATE_1, val >> 8);
    739  1.1  augustss 
    740  1.1  augustss #define F_REF 24576000
    741  1.1  augustss 
    742  1.1  augustss #define ABS(x) (((x) < 0) ? (-x) : (x))
    743  1.1  augustss 
    744  1.1  augustss 	if (setmode & AUMODE_RECORD) {
    745  1.1  augustss 		/* The ADC reference frequency (f_out) is 512 * sample rate */
    746  1.1  augustss 
    747  1.1  augustss 		/* f_out is dervied from the 24.576MHZ crystal by three values:
    748  1.1  augustss 		   M & N & R. The equation is as follows:
    749  1.1  augustss 
    750  1.1  augustss 		   f_out = (m + 2) * f_ref / ((n + 2) * (2 ^ a))
    751  1.1  augustss 
    752  1.1  augustss 		   with the constraint that:
    753  1.1  augustss 
    754  1.1  augustss 		   80 MhZ < (m + 2) / (n + 2) * f_ref <= 150Mhz
    755  1.1  augustss 		   and n, m >= 1
    756  1.1  augustss 		*/
    757  1.1  augustss 
    758  1.3   mycroft 		int  goal_f_out = 512 * rec->sample_rate;
    759  1.1  augustss 		int  a, n, m, best_n = 0, best_m = 0, best_error = 10000000;
    760  1.1  augustss 		int  pll_sample;
    761  1.1  augustss 		int  error;
    762  1.1  augustss 
    763  1.1  augustss 		for (a = 0; a < 8; a++) {
    764  1.1  augustss 			if ((goal_f_out * (1 << a)) >= 80000000)
    765  1.1  augustss 				break;
    766  1.1  augustss 		}
    767  1.1  augustss 
    768  1.1  augustss 		/* a != 8 because sample_rate >= 2000 */
    769  1.1  augustss 
    770  1.1  augustss 		for (n = 33; n > 2; n--) {
    771  1.1  augustss 			m = (goal_f_out * n * (1 << a)) / F_REF;
    772  1.3   mycroft 			if ((m > 257) || (m < 3))
    773  1.3   mycroft 				continue;
    774  1.1  augustss 
    775  1.1  augustss 			pll_sample = (m * F_REF) / (n * (1 << a));
    776  1.1  augustss 			pll_sample /= 512;
    777  1.1  augustss 
    778  1.1  augustss 			/* Threshold might be good here */
    779  1.3   mycroft 			error = pll_sample - rec->sample_rate;
    780  1.1  augustss 			error = ABS(error);
    781  1.1  augustss 
    782  1.1  augustss 			if (error < best_error) {
    783  1.1  augustss 				best_error = error;
    784  1.1  augustss 				best_n = n;
    785  1.1  augustss 				best_m = m;
    786  1.1  augustss 				if (error == 0) break;
    787  1.1  augustss 			}
    788  1.1  augustss 		}
    789  1.1  augustss 
    790  1.1  augustss 		best_n -= 2;
    791  1.1  augustss 		best_m -= 2;
    792  1.1  augustss 
    793  1.1  augustss 		sv_write_indirect(sc, SV_ADC_PLL_M, best_m);
    794  1.1  augustss 		sv_write_indirect(sc, SV_ADC_PLL_N,
    795  1.1  augustss 				  best_n | (a << SV_PLL_R_SHIFT));
    796  1.1  augustss 	}
    797  1.3   mycroft 
    798  1.3   mycroft 	return (0);
    799  1.1  augustss }
    800  1.1  augustss 
    801  1.1  augustss int
    802  1.1  augustss sv_round_blocksize(addr, blk)
    803  1.1  augustss 	void *addr;
    804  1.1  augustss 	int blk;
    805  1.1  augustss {
    806  1.1  augustss 	return (blk & -32);	/* keep good alignment */
    807  1.1  augustss }
    808  1.1  augustss 
    809  1.1  augustss int
    810  1.3   mycroft sv_trigger_output(addr, start, end, blksize, intr, arg, param)
    811  1.1  augustss 	void *addr;
    812  1.3   mycroft 	void *start, *end;
    813  1.3   mycroft 	int blksize;
    814  1.3   mycroft 	void (*intr) __P((void *));
    815  1.3   mycroft 	void *arg;
    816  1.3   mycroft 	struct audio_params *param;
    817  1.1  augustss {
    818  1.1  augustss 	struct sv_softc *sc = addr;
    819  1.1  augustss 	struct sv_dma *p;
    820  1.3   mycroft 	u_int8_t mode;
    821  1.1  augustss 	int dma_count;
    822  1.1  augustss 
    823  1.3   mycroft 	DPRINTFN(1, ("sv_trigger_output: sc=%p start=%p end=%p blksize=%d intr=%p(%p)\n",
    824  1.3   mycroft 	    addr, start, end, blksize, intr, arg));
    825  1.3   mycroft 	sc->sc_pintr = intr;
    826  1.3   mycroft 	sc->sc_parg = arg;
    827  1.1  augustss 
    828  1.3   mycroft 	mode = sv_read_indirect(sc, SV_DMA_DATA_FORMAT);
    829  1.3   mycroft 	mode &= ~(SV_DMAA_FORMAT16 | SV_DMAA_STEREO);
    830  1.3   mycroft 	if (param->precision * param->factor == 16)
    831  1.3   mycroft 		mode |= SV_DMAA_FORMAT16;
    832  1.3   mycroft 	if (param->channels == 2)
    833  1.3   mycroft 		mode |= SV_DMAA_STEREO;
    834  1.3   mycroft 	sv_write_indirect(sc, SV_DMA_DATA_FORMAT, mode);
    835  1.1  augustss 
    836  1.4   mycroft 	for (p = sc->sc_dmas; p && KERNADDR(p) != start; p = p->next)
    837  1.1  augustss 		;
    838  1.1  augustss 	if (!p) {
    839  1.3   mycroft 		printf("sv_trigger_output: bad addr %p\n", start);
    840  1.1  augustss 		return (EINVAL);
    841  1.1  augustss 	}
    842  1.1  augustss 
    843  1.3   mycroft 	dma_count = ((char *)end - (char *)start) - 1;
    844  1.5   mycroft 	DPRINTF(("sv_trigger_output: dma start loop input addr=%x cc=%d\n",
    845  1.5   mycroft 	    (int)DMAADDR(p), dma_count));
    846  1.1  augustss 
    847  1.1  augustss 	bus_space_write_4(sc->sc_iot, sc->sc_dmaa_ioh, SV_DMA_ADDR0,
    848  1.1  augustss 			  DMAADDR(p));
    849  1.1  augustss 	bus_space_write_4(sc->sc_iot, sc->sc_dmaa_ioh, SV_DMA_COUNT0,
    850  1.1  augustss 			  dma_count);
    851  1.1  augustss 	bus_space_write_1(sc->sc_iot, sc->sc_dmaa_ioh, SV_DMA_MODE,
    852  1.1  augustss 			  DMA37MD_READ | DMA37MD_LOOP);
    853  1.1  augustss 
    854  1.5   mycroft 	DPRINTF(("sv_trigger_output: current addr=%x\n",
    855  1.5   mycroft 	    bus_space_read_4(sc->sc_iot, sc->sc_dmaa_ioh, SV_DMA_ADDR0)));
    856  1.5   mycroft 
    857  1.3   mycroft 	dma_count = blksize - 1;
    858  1.3   mycroft 
    859  1.3   mycroft 	sv_write_indirect(sc, SV_DMAA_COUNT1, dma_count >> 8);
    860  1.3   mycroft 	sv_write_indirect(sc, SV_DMAA_COUNT0, dma_count & 0xFF);
    861  1.3   mycroft 
    862  1.3   mycroft 	mode = sv_read_indirect(sc, SV_PLAY_RECORD_ENABLE);
    863  1.3   mycroft 	sv_write_indirect(sc, SV_PLAY_RECORD_ENABLE, mode | SV_PLAY_ENABLE);
    864  1.3   mycroft 
    865  1.1  augustss 	return (0);
    866  1.1  augustss }
    867  1.1  augustss 
    868  1.1  augustss int
    869  1.3   mycroft sv_trigger_input(addr, start, end, blksize, intr, arg, param)
    870  1.1  augustss 	void *addr;
    871  1.3   mycroft 	void *start, *end;
    872  1.3   mycroft 	int blksize;
    873  1.1  augustss 	void (*intr) __P((void *));
    874  1.1  augustss 	void *arg;
    875  1.3   mycroft 	struct audio_params *param;
    876  1.1  augustss {
    877  1.1  augustss 	struct sv_softc *sc = addr;
    878  1.3   mycroft 	struct sv_dma *p;
    879  1.1  augustss 	u_int8_t mode;
    880  1.3   mycroft 	int dma_count;
    881  1.1  augustss 
    882  1.3   mycroft 	DPRINTFN(1, ("sv_trigger_input: sc=%p start=%p end=%p blksize=%d intr=%p(%p)\n",
    883  1.3   mycroft 	    addr, start, end, blksize, intr, arg));
    884  1.3   mycroft 	sc->sc_rintr = intr;
    885  1.3   mycroft 	sc->sc_rarg = arg;
    886  1.1  augustss 
    887  1.3   mycroft 	mode = sv_read_indirect(sc, SV_DMA_DATA_FORMAT);
    888  1.3   mycroft 	mode &= ~(SV_DMAC_FORMAT16 | SV_DMAC_STEREO);
    889  1.3   mycroft 	if (param->precision * param->factor == 16)
    890  1.3   mycroft 		mode |= SV_DMAC_FORMAT16;
    891  1.3   mycroft 	if (param->channels == 2)
    892  1.3   mycroft 		mode |= SV_DMAC_STEREO;
    893  1.3   mycroft 	sv_write_indirect(sc, SV_DMA_DATA_FORMAT, mode);
    894  1.1  augustss 
    895  1.4   mycroft 	for (p = sc->sc_dmas; p && KERNADDR(p) != start; p = p->next)
    896  1.3   mycroft 		;
    897  1.3   mycroft 	if (!p) {
    898  1.3   mycroft 		printf("sv_trigger_input: bad addr %p\n", start);
    899  1.3   mycroft 		return (EINVAL);
    900  1.1  augustss 	}
    901  1.1  augustss 
    902  1.3   mycroft 	dma_count = (((char *)end - (char *)start) >> 1) - 1;
    903  1.5   mycroft 	DPRINTF(("sv_trigger_input: dma start loop input addr=%x cc=%d\n",
    904  1.5   mycroft 	    (int)DMAADDR(p), dma_count));
    905  1.3   mycroft 
    906  1.3   mycroft 	bus_space_write_4(sc->sc_iot, sc->sc_dmac_ioh, SV_DMA_ADDR0,
    907  1.3   mycroft 			  DMAADDR(p));
    908  1.3   mycroft 	bus_space_write_4(sc->sc_iot, sc->sc_dmac_ioh, SV_DMA_COUNT0,
    909  1.3   mycroft 			  dma_count);
    910  1.3   mycroft 	bus_space_write_1(sc->sc_iot, sc->sc_dmac_ioh, SV_DMA_MODE,
    911  1.3   mycroft 			  DMA37MD_WRITE | DMA37MD_LOOP);
    912  1.5   mycroft 
    913  1.5   mycroft 	DPRINTF(("sv_trigger_input: current addr=%x\n",
    914  1.5   mycroft 	    bus_space_read_4(sc->sc_iot, sc->sc_dmac_ioh, SV_DMA_ADDR0)));
    915  1.3   mycroft 
    916  1.3   mycroft 	dma_count = (blksize >> 1) - 1;
    917  1.1  augustss 
    918  1.3   mycroft 	sv_write_indirect(sc, SV_DMAC_COUNT1, dma_count >> 8);
    919  1.3   mycroft 	sv_write_indirect(sc, SV_DMAC_COUNT0, dma_count & 0xFF);
    920  1.1  augustss 
    921  1.3   mycroft 	mode = sv_read_indirect(sc, SV_PLAY_RECORD_ENABLE);
    922  1.3   mycroft 	sv_write_indirect(sc, SV_PLAY_RECORD_ENABLE, mode | SV_RECORD_ENABLE);
    923  1.1  augustss 
    924  1.3   mycroft 	return (0);
    925  1.1  augustss }
    926  1.1  augustss 
    927  1.1  augustss int
    928  1.3   mycroft sv_halt_output(addr)
    929  1.1  augustss 	void *addr;
    930  1.1  augustss {
    931  1.1  augustss 	struct sv_softc *sc = addr;
    932  1.1  augustss 	u_int8_t mode;
    933  1.1  augustss 
    934  1.4   mycroft 	DPRINTF(("sv: sv_halt_output\n"));
    935  1.1  augustss 	mode = sv_read_indirect(sc, SV_PLAY_RECORD_ENABLE);
    936  1.3   mycroft 	sv_write_indirect(sc, SV_PLAY_RECORD_ENABLE, mode & ~SV_PLAY_ENABLE);
    937  1.1  augustss 
    938  1.4   mycroft 	return (0);
    939  1.1  augustss }
    940  1.1  augustss 
    941  1.1  augustss int
    942  1.3   mycroft sv_halt_input(addr)
    943  1.1  augustss 	void *addr;
    944  1.1  augustss {
    945  1.1  augustss 	struct sv_softc *sc = addr;
    946  1.1  augustss 	u_int8_t mode;
    947  1.1  augustss 
    948  1.4   mycroft 	DPRINTF(("sv: sv_halt_input\n"));
    949  1.1  augustss 	mode = sv_read_indirect(sc, SV_PLAY_RECORD_ENABLE);
    950  1.3   mycroft 	sv_write_indirect(sc, SV_PLAY_RECORD_ENABLE, mode & ~SV_RECORD_ENABLE);
    951  1.1  augustss 
    952  1.4   mycroft 	return (0);
    953  1.1  augustss }
    954  1.1  augustss 
    955  1.1  augustss int
    956  1.1  augustss sv_getdev(addr, retp)
    957  1.1  augustss 	void *addr;
    958  1.4   mycroft 	struct audio_device *retp;
    959  1.1  augustss {
    960  1.1  augustss 	*retp = sv_device;
    961  1.4   mycroft 	return (0);
    962  1.1  augustss }
    963  1.1  augustss 
    964  1.1  augustss 
    965  1.1  augustss /*
    966  1.1  augustss  * Mixer related code is here
    967  1.1  augustss  *
    968  1.1  augustss  */
    969  1.1  augustss 
    970  1.1  augustss #define SV_INPUT_CLASS 0
    971  1.1  augustss #define SV_OUTPUT_CLASS 1
    972  1.1  augustss #define SV_RECORD_CLASS 2
    973  1.1  augustss 
    974  1.1  augustss #define SV_LAST_CLASS 2
    975  1.1  augustss 
    976  1.1  augustss static const char *mixer_classes[] =
    977  1.1  augustss 	{ AudioCinputs, AudioCoutputs, AudioCrecord };
    978  1.1  augustss 
    979  1.1  augustss static const struct {
    980  1.1  augustss 	u_int8_t   l_port;
    981  1.1  augustss 	u_int8_t   r_port;
    982  1.1  augustss 	u_int8_t   mask;
    983  1.1  augustss 	u_int8_t   class;
    984  1.1  augustss 	const char *audio;
    985  1.1  augustss } ports[] = {
    986  1.1  augustss   { SV_LEFT_AUX1_INPUT_CONTROL, SV_RIGHT_AUX1_INPUT_CONTROL, SV_AUX1_MASK,
    987  1.1  augustss     SV_INPUT_CLASS, "aux1" },
    988  1.1  augustss   { SV_LEFT_CD_INPUT_CONTROL, SV_RIGHT_CD_INPUT_CONTROL, SV_CD_MASK,
    989  1.1  augustss     SV_INPUT_CLASS, AudioNcd },
    990  1.1  augustss   { SV_LEFT_LINE_IN_INPUT_CONTROL, SV_RIGHT_LINE_IN_INPUT_CONTROL, SV_LINE_IN_MASK,
    991  1.1  augustss     SV_INPUT_CLASS, AudioNline },
    992  1.1  augustss   { SV_MIC_INPUT_CONTROL, 0, SV_MIC_MASK, SV_INPUT_CLASS, AudioNmicrophone },
    993  1.1  augustss   { SV_LEFT_SYNTH_INPUT_CONTROL, SV_RIGHT_SYNTH_INPUT_CONTROL,
    994  1.1  augustss     SV_SYNTH_MASK, SV_INPUT_CLASS, AudioNfmsynth },
    995  1.1  augustss   { SV_LEFT_AUX2_INPUT_CONTROL, SV_RIGHT_AUX2_INPUT_CONTROL, SV_AUX2_MASK,
    996  1.1  augustss     SV_INPUT_CLASS, "aux2" },
    997  1.1  augustss   { SV_LEFT_PCM_INPUT_CONTROL, SV_RIGHT_PCM_INPUT_CONTROL, SV_PCM_MASK,
    998  1.1  augustss     SV_INPUT_CLASS, AudioNdac },
    999  1.1  augustss   { SV_LEFT_MIXER_OUTPUT_CONTROL, SV_RIGHT_MIXER_OUTPUT_CONTROL,
   1000  1.1  augustss     SV_MIXER_OUT_MASK, SV_OUTPUT_CLASS, AudioNmaster }
   1001  1.1  augustss };
   1002  1.1  augustss 
   1003  1.1  augustss 
   1004  1.1  augustss static const struct {
   1005  1.1  augustss 	int idx;
   1006  1.1  augustss 	const char *name;
   1007  1.1  augustss } record_sources[] = {
   1008  1.1  augustss 	{ SV_REC_CD, AudioNcd },
   1009  1.1  augustss 	{ SV_REC_DAC, AudioNdac },
   1010  1.1  augustss 	{ SV_REC_AUX2, "aux2" },
   1011  1.1  augustss 	{ SV_REC_LINE, AudioNline },
   1012  1.1  augustss 	{ SV_REC_AUX1, "aux1" },
   1013  1.1  augustss 	{ SV_REC_MIC, AudioNmicrophone },
   1014  1.1  augustss 	{ SV_REC_MIXER, AudioNmixerout }
   1015  1.1  augustss };
   1016  1.1  augustss 
   1017  1.1  augustss 
   1018  1.1  augustss #define SV_DEVICES_PER_PORT 2
   1019  1.1  augustss #define SV_FIRST_MIXER (SV_LAST_CLASS + 1)
   1020  1.1  augustss #define SV_LAST_MIXER (SV_DEVICES_PER_PORT * (ARRAY_SIZE(ports)) + SV_LAST_CLASS)
   1021  1.1  augustss #define SV_RECORD_SOURCE (SV_LAST_MIXER + 1)
   1022  1.1  augustss #define SV_MIC_BOOST (SV_LAST_MIXER + 2)
   1023  1.1  augustss #define SV_RECORD_GAIN (SV_LAST_MIXER + 3)
   1024  1.1  augustss #define SV_SRS_MODE (SV_LAST_MIXER + 4)
   1025  1.1  augustss 
   1026  1.1  augustss int
   1027  1.1  augustss sv_query_devinfo(addr, dip)
   1028  1.1  augustss 	void *addr;
   1029  1.1  augustss 	mixer_devinfo_t *dip;
   1030  1.1  augustss {
   1031  1.1  augustss 	int i;
   1032  1.1  augustss 
   1033  1.1  augustss 	/* It's a class */
   1034  1.1  augustss 	if (dip->index <= SV_LAST_CLASS) {
   1035  1.1  augustss 		dip->type = AUDIO_MIXER_CLASS;
   1036  1.1  augustss 		dip->mixer_class = dip->index;
   1037  1.1  augustss 		dip->next = dip->prev = AUDIO_MIXER_LAST;
   1038  1.1  augustss 		strcpy(dip->label.name,
   1039  1.1  augustss 		       mixer_classes[dip->index]);
   1040  1.1  augustss 		return (0);
   1041  1.1  augustss 	}
   1042  1.1  augustss 
   1043  1.1  augustss 	if (dip->index >= SV_FIRST_MIXER &&
   1044  1.1  augustss 	    dip->index <= SV_LAST_MIXER) {
   1045  1.1  augustss 		int off = dip->index - SV_FIRST_MIXER;
   1046  1.1  augustss 		int mute = (off % SV_DEVICES_PER_PORT);
   1047  1.1  augustss 		int idx = off / SV_DEVICES_PER_PORT;
   1048  1.1  augustss 
   1049  1.1  augustss 		dip->mixer_class = ports[idx].class;
   1050  1.1  augustss 		strcpy(dip->label.name, ports[idx].audio);
   1051  1.1  augustss 
   1052  1.1  augustss 		if (!mute) {
   1053  1.1  augustss 			dip->type = AUDIO_MIXER_VALUE;
   1054  1.1  augustss 			dip->prev = AUDIO_MIXER_LAST;
   1055  1.1  augustss 			dip->next = dip->index + 1;
   1056  1.1  augustss 
   1057  1.1  augustss 			if (ports[idx].r_port != 0)
   1058  1.1  augustss 				dip->un.v.num_channels = 2;
   1059  1.1  augustss 			else
   1060  1.1  augustss 				dip->un.v.num_channels = 1;
   1061  1.1  augustss 
   1062  1.1  augustss 			strcpy(dip->un.v.units.name, AudioNvolume);
   1063  1.1  augustss 		} else {
   1064  1.1  augustss 			dip->type = AUDIO_MIXER_ENUM;
   1065  1.1  augustss 			dip->prev = dip->index - 1;
   1066  1.1  augustss 			dip->next = AUDIO_MIXER_LAST;
   1067  1.1  augustss 
   1068  1.1  augustss 			strcpy(dip->label.name, AudioNmute);
   1069  1.1  augustss 			dip->un.e.num_mem = 2;
   1070  1.1  augustss 			strcpy(dip->un.e.member[0].label.name, AudioNoff);
   1071  1.1  augustss 			dip->un.e.member[0].ord = 0;
   1072  1.1  augustss 			strcpy(dip->un.e.member[1].label.name, AudioNon);
   1073  1.1  augustss 			dip->un.e.member[1].ord = 1;
   1074  1.1  augustss 		}
   1075  1.1  augustss 
   1076  1.1  augustss 		return (0);
   1077  1.1  augustss 	}
   1078  1.1  augustss 
   1079  1.1  augustss 	switch (dip->index) {
   1080  1.1  augustss 	case SV_RECORD_SOURCE:
   1081  1.1  augustss 		dip->mixer_class = SV_RECORD_CLASS;
   1082  1.1  augustss 		dip->prev = AUDIO_MIXER_LAST;
   1083  1.1  augustss 		dip->next = SV_RECORD_GAIN;
   1084  1.1  augustss 		strcpy(dip->label.name, AudioNsource);
   1085  1.1  augustss 		dip->type = AUDIO_MIXER_ENUM;
   1086  1.1  augustss 
   1087  1.1  augustss 		dip->un.e.num_mem = ARRAY_SIZE(record_sources);
   1088  1.1  augustss 		for (i = 0; i < ARRAY_SIZE(record_sources); i++) {
   1089  1.1  augustss 			strcpy(dip->un.e.member[i].label.name,
   1090  1.1  augustss 			       record_sources[i].name);
   1091  1.1  augustss 			dip->un.e.member[i].ord = record_sources[i].idx;
   1092  1.1  augustss 		}
   1093  1.1  augustss 		return (0);
   1094  1.1  augustss 
   1095  1.1  augustss 	case SV_RECORD_GAIN:
   1096  1.1  augustss 		dip->mixer_class = SV_RECORD_CLASS;
   1097  1.1  augustss 		dip->prev = SV_RECORD_SOURCE;
   1098  1.1  augustss 		dip->next = AUDIO_MIXER_LAST;
   1099  1.1  augustss 		strcpy(dip->label.name, "gain");
   1100  1.1  augustss 		dip->type = AUDIO_MIXER_VALUE;
   1101  1.1  augustss 		dip->un.v.num_channels = 1;
   1102  1.1  augustss 		strcpy(dip->un.v.units.name, AudioNvolume);
   1103  1.1  augustss 		return (0);
   1104  1.1  augustss 
   1105  1.1  augustss 	case SV_MIC_BOOST:
   1106  1.1  augustss 		dip->mixer_class = SV_RECORD_CLASS;
   1107  1.1  augustss 		dip->prev = AUDIO_MIXER_LAST;
   1108  1.1  augustss 		dip->next = AUDIO_MIXER_LAST;
   1109  1.1  augustss 		strcpy(dip->label.name, "micboost");
   1110  1.1  augustss 		goto on_off;
   1111  1.1  augustss 
   1112  1.1  augustss 	case SV_SRS_MODE:
   1113  1.1  augustss 		dip->mixer_class = SV_OUTPUT_CLASS;
   1114  1.1  augustss 		dip->prev = dip->next = AUDIO_MIXER_LAST;
   1115  1.1  augustss 		strcpy(dip->label.name, AudioNspatial);
   1116  1.1  augustss 
   1117  1.1  augustss 	on_off:
   1118  1.1  augustss 		dip->type = AUDIO_MIXER_ENUM;
   1119  1.1  augustss 		dip->un.e.num_mem = 2;
   1120  1.1  augustss 		strcpy(dip->un.e.member[0].label.name, AudioNoff);
   1121  1.1  augustss 		dip->un.e.member[0].ord = 0;
   1122  1.1  augustss 		strcpy(dip->un.e.member[1].label.name, AudioNon);
   1123  1.1  augustss 		dip->un.e.member[1].ord = 1;
   1124  1.1  augustss 		return (0);
   1125  1.1  augustss 	}
   1126  1.1  augustss 
   1127  1.1  augustss 	return (ENXIO);
   1128  1.1  augustss }
   1129  1.1  augustss 
   1130  1.1  augustss int
   1131  1.1  augustss sv_mixer_set_port(addr, cp)
   1132  1.1  augustss 	void *addr;
   1133  1.1  augustss 	mixer_ctrl_t *cp;
   1134  1.1  augustss {
   1135  1.1  augustss 	struct sv_softc *sc = addr;
   1136  1.1  augustss 	u_int8_t reg;
   1137  1.1  augustss 	int idx;
   1138  1.1  augustss 
   1139  1.1  augustss 	if (cp->dev >= SV_FIRST_MIXER &&
   1140  1.1  augustss 	    cp->dev <= SV_LAST_MIXER) {
   1141  1.1  augustss 		int off = cp->dev - SV_FIRST_MIXER;
   1142  1.1  augustss 		int mute = (off % SV_DEVICES_PER_PORT);
   1143  1.1  augustss 		idx = off / SV_DEVICES_PER_PORT;
   1144  1.1  augustss 
   1145  1.1  augustss 		if (mute) {
   1146  1.1  augustss 			if (cp->type != AUDIO_MIXER_ENUM)
   1147  1.1  augustss 				return (EINVAL);
   1148  1.1  augustss 
   1149  1.1  augustss 			reg = sv_read_indirect(sc, ports[idx].l_port);
   1150  1.1  augustss 			if (cp->un.ord)
   1151  1.1  augustss 				reg |= SV_MUTE_BIT;
   1152  1.1  augustss 			else
   1153  1.1  augustss 				reg &= ~SV_MUTE_BIT;
   1154  1.1  augustss 			sv_write_indirect(sc, ports[idx].l_port, reg);
   1155  1.1  augustss 
   1156  1.1  augustss 			if (ports[idx].r_port) {
   1157  1.1  augustss 				reg = sv_read_indirect(sc, ports[idx].r_port);
   1158  1.1  augustss 				if (cp->un.ord)
   1159  1.1  augustss 					reg |= SV_MUTE_BIT;
   1160  1.1  augustss 				else
   1161  1.1  augustss 					reg &= ~SV_MUTE_BIT;
   1162  1.1  augustss 				sv_write_indirect(sc, ports[idx].r_port, reg);
   1163  1.1  augustss 			}
   1164  1.1  augustss 		} else {
   1165  1.1  augustss 			int  lval, rval;
   1166  1.1  augustss 
   1167  1.1  augustss 			if (cp->type != AUDIO_MIXER_VALUE)
   1168  1.1  augustss 				return (EINVAL);
   1169  1.1  augustss 
   1170  1.1  augustss 			if (cp->un.value.num_channels != 1 &&
   1171  1.1  augustss 			    cp->un.value.num_channels != 2)
   1172  1.1  augustss 				return (EINVAL);
   1173  1.1  augustss 
   1174  1.1  augustss 			if (ports[idx].r_port == 0) {
   1175  1.1  augustss 				if (cp->un.value.num_channels != 1)
   1176  1.1  augustss 					return (EINVAL);
   1177  1.1  augustss 				lval = cp->un.value.level[AUDIO_MIXER_LEVEL_MONO];
   1178  1.1  augustss 				rval = 0; /* shut up GCC */
   1179  1.1  augustss 			} else {
   1180  1.1  augustss 				if (cp->un.value.num_channels != 2)
   1181  1.1  augustss 					return (EINVAL);
   1182  1.1  augustss 
   1183  1.1  augustss 				lval = cp->un.value.level[AUDIO_MIXER_LEVEL_LEFT];
   1184  1.1  augustss 				rval = cp->un.value.level[AUDIO_MIXER_LEVEL_RIGHT];
   1185  1.1  augustss       }
   1186  1.1  augustss 
   1187  1.1  augustss 
   1188  1.1  augustss 			reg = sv_read_indirect(sc, ports[idx].l_port);
   1189  1.1  augustss 			reg &= ~(ports[idx].mask);
   1190  1.1  augustss 			lval = (AUDIO_MAX_GAIN - lval) * ports[idx].mask /
   1191  1.1  augustss 				AUDIO_MAX_GAIN;
   1192  1.1  augustss 			reg |= lval;
   1193  1.1  augustss 			sv_write_indirect(sc, ports[idx].l_port, reg);
   1194  1.1  augustss 
   1195  1.1  augustss 			if (ports[idx].r_port != 0) {
   1196  1.1  augustss 				reg = sv_read_indirect(sc, ports[idx].r_port);
   1197  1.1  augustss 				reg &= ~(ports[idx].mask);
   1198  1.1  augustss 
   1199  1.1  augustss 				rval = (AUDIO_MAX_GAIN - rval) * ports[idx].mask /
   1200  1.1  augustss 					AUDIO_MAX_GAIN;
   1201  1.1  augustss 				reg |= rval;
   1202  1.1  augustss 
   1203  1.1  augustss 				sv_write_indirect(sc, ports[idx].r_port, reg);
   1204  1.1  augustss 			}
   1205  1.1  augustss 
   1206  1.1  augustss 			sv_read_indirect(sc, ports[idx].l_port);
   1207  1.1  augustss 		}
   1208  1.1  augustss 
   1209  1.1  augustss 		return (0);
   1210  1.1  augustss 	}
   1211  1.1  augustss 
   1212  1.1  augustss 
   1213  1.1  augustss 	switch (cp->dev) {
   1214  1.1  augustss 	case SV_RECORD_SOURCE:
   1215  1.1  augustss 		if (cp->type != AUDIO_MIXER_ENUM)
   1216  1.1  augustss 			return (EINVAL);
   1217  1.1  augustss 
   1218  1.1  augustss 		for (idx = 0; idx < ARRAY_SIZE(record_sources); idx++) {
   1219  1.1  augustss 			if (record_sources[idx].idx == cp->un.ord)
   1220  1.1  augustss 				goto found;
   1221  1.1  augustss 		}
   1222  1.1  augustss 
   1223  1.1  augustss 		return (EINVAL);
   1224  1.1  augustss 
   1225  1.1  augustss 	found:
   1226  1.1  augustss 		reg = sv_read_indirect(sc, SV_LEFT_ADC_INPUT_CONTROL);
   1227  1.1  augustss 		reg &= ~SV_REC_SOURCE_MASK;
   1228  1.1  augustss 		reg |= (((cp->un.ord) << SV_REC_SOURCE_SHIFT) & SV_REC_SOURCE_MASK);
   1229  1.1  augustss 		sv_write_indirect(sc, SV_LEFT_ADC_INPUT_CONTROL, reg);
   1230  1.1  augustss 
   1231  1.1  augustss 		reg = sv_read_indirect(sc, SV_RIGHT_ADC_INPUT_CONTROL);
   1232  1.1  augustss 		reg &= ~SV_REC_SOURCE_MASK;
   1233  1.1  augustss 		reg |= (((cp->un.ord) << SV_REC_SOURCE_SHIFT) & SV_REC_SOURCE_MASK);
   1234  1.1  augustss 		sv_write_indirect(sc, SV_RIGHT_ADC_INPUT_CONTROL, reg);
   1235  1.1  augustss 		return (0);
   1236  1.1  augustss 
   1237  1.1  augustss 	case SV_RECORD_GAIN:
   1238  1.1  augustss 	{
   1239  1.1  augustss 		int val;
   1240  1.1  augustss 
   1241  1.1  augustss 		if (cp->type != AUDIO_MIXER_VALUE)
   1242  1.1  augustss 			return (EINVAL);
   1243  1.1  augustss 
   1244  1.1  augustss 		if (cp->un.value.num_channels != 1)
   1245  1.1  augustss 			return (EINVAL);
   1246  1.1  augustss 
   1247  1.1  augustss 		val = (cp->un.value.level[AUDIO_MIXER_LEVEL_MONO] * SV_REC_GAIN_MASK)
   1248  1.1  augustss 			/ AUDIO_MAX_GAIN;
   1249  1.1  augustss 
   1250  1.1  augustss 		reg = sv_read_indirect(sc, SV_LEFT_ADC_INPUT_CONTROL);
   1251  1.1  augustss 		reg &= ~SV_REC_GAIN_MASK;
   1252  1.1  augustss 		reg |= val;
   1253  1.1  augustss 		sv_write_indirect(sc, SV_LEFT_ADC_INPUT_CONTROL, reg);
   1254  1.1  augustss 
   1255  1.1  augustss 		reg = sv_read_indirect(sc, SV_RIGHT_ADC_INPUT_CONTROL);
   1256  1.1  augustss 		reg &= ~SV_REC_GAIN_MASK;
   1257  1.1  augustss 		reg |= val;
   1258  1.1  augustss 		sv_write_indirect(sc, SV_RIGHT_ADC_INPUT_CONTROL, reg);
   1259  1.1  augustss 	}
   1260  1.1  augustss 	return (0);
   1261  1.1  augustss 
   1262  1.1  augustss 	case SV_MIC_BOOST:
   1263  1.1  augustss 		if (cp->type != AUDIO_MIXER_ENUM)
   1264  1.1  augustss 			return (EINVAL);
   1265  1.1  augustss 
   1266  1.1  augustss 		reg = sv_read_indirect(sc, SV_LEFT_ADC_INPUT_CONTROL);
   1267  1.1  augustss 		if (cp->un.ord) {
   1268  1.1  augustss 			reg |= SV_MIC_BOOST_BIT;
   1269  1.1  augustss 		} else {
   1270  1.1  augustss 			reg &= ~SV_MIC_BOOST_BIT;
   1271  1.1  augustss 		}
   1272  1.1  augustss 
   1273  1.1  augustss 		sv_write_indirect(sc, SV_LEFT_ADC_INPUT_CONTROL, reg);
   1274  1.1  augustss 		return (0);
   1275  1.1  augustss 
   1276  1.1  augustss 	case SV_SRS_MODE:
   1277  1.1  augustss 		if (cp->type != AUDIO_MIXER_ENUM)
   1278  1.1  augustss 			return (EINVAL);
   1279  1.1  augustss 
   1280  1.1  augustss 		reg = sv_read_indirect(sc, SV_SRS_SPACE_CONTROL);
   1281  1.1  augustss 		if (cp->un.ord) {
   1282  1.1  augustss 			reg &= ~SV_SRS_SPACE_ONOFF;
   1283  1.1  augustss 		} else {
   1284  1.1  augustss 			reg |= SV_SRS_SPACE_ONOFF;
   1285  1.1  augustss 		}
   1286  1.1  augustss 
   1287  1.1  augustss 		sv_write_indirect(sc, SV_SRS_SPACE_CONTROL, reg);
   1288  1.1  augustss 		return (0);
   1289  1.1  augustss 	}
   1290  1.1  augustss 
   1291  1.1  augustss 	return (EINVAL);
   1292  1.1  augustss }
   1293  1.1  augustss 
   1294  1.1  augustss int
   1295  1.1  augustss sv_mixer_get_port(addr, cp)
   1296  1.1  augustss 	void *addr;
   1297  1.1  augustss 	mixer_ctrl_t *cp;
   1298  1.1  augustss {
   1299  1.1  augustss 	struct sv_softc *sc = addr;
   1300  1.1  augustss 	int val;
   1301  1.1  augustss 	u_int8_t reg;
   1302  1.1  augustss 
   1303  1.1  augustss 	if (cp->dev >= SV_FIRST_MIXER &&
   1304  1.1  augustss 	    cp->dev <= SV_LAST_MIXER) {
   1305  1.1  augustss 		int off = cp->dev - SV_FIRST_MIXER;
   1306  1.1  augustss 		int mute = (off % 2);
   1307  1.1  augustss 		int idx = off / 2;
   1308  1.1  augustss 
   1309  1.1  augustss 		if (mute) {
   1310  1.1  augustss 			if (cp->type != AUDIO_MIXER_ENUM)
   1311  1.1  augustss 				return (EINVAL);
   1312  1.1  augustss 
   1313  1.1  augustss 			reg = sv_read_indirect(sc, ports[idx].l_port);
   1314  1.1  augustss 			cp->un.ord = ((reg & SV_MUTE_BIT) ? 1 : 0);
   1315  1.1  augustss 		} else {
   1316  1.1  augustss 			if (cp->type != AUDIO_MIXER_VALUE)
   1317  1.1  augustss 				return (EINVAL);
   1318  1.1  augustss 
   1319  1.1  augustss 			if (cp->un.value.num_channels != 1 &&
   1320  1.1  augustss 			    cp->un.value.num_channels != 2)
   1321  1.1  augustss 				return (EINVAL);
   1322  1.1  augustss 
   1323  1.1  augustss 			if ((ports[idx].r_port == 0 &&
   1324  1.1  augustss 			     cp->un.value.num_channels != 1) ||
   1325  1.1  augustss 			    (ports[idx].r_port != 0 &&
   1326  1.1  augustss 			     cp->un.value.num_channels != 2))
   1327  1.1  augustss 				return (EINVAL);
   1328  1.1  augustss 
   1329  1.1  augustss 			reg = sv_read_indirect(sc, ports[idx].l_port);
   1330  1.1  augustss 			reg &= ports[idx].mask;
   1331  1.1  augustss 
   1332  1.1  augustss 			val = AUDIO_MAX_GAIN - ((reg * AUDIO_MAX_GAIN) / ports[idx].mask);
   1333  1.1  augustss 
   1334  1.1  augustss 			if (ports[idx].r_port != 0) {
   1335  1.1  augustss 				cp->un.value.level[AUDIO_MIXER_LEVEL_LEFT] = val;
   1336  1.1  augustss 
   1337  1.1  augustss 				reg = sv_read_indirect(sc, ports[idx].r_port);
   1338  1.1  augustss 				reg &= ports[idx].mask;
   1339  1.1  augustss 
   1340  1.1  augustss 				val = AUDIO_MAX_GAIN - ((reg * AUDIO_MAX_GAIN) / ports[idx].mask);
   1341  1.1  augustss 				cp->un.value.level[AUDIO_MIXER_LEVEL_RIGHT] = val;
   1342  1.1  augustss 			} else
   1343  1.1  augustss 				cp->un.value.level[AUDIO_MIXER_LEVEL_MONO] = val;
   1344  1.1  augustss 		}
   1345  1.1  augustss 
   1346  1.1  augustss 		return (0);
   1347  1.1  augustss   }
   1348  1.1  augustss 
   1349  1.1  augustss 	switch (cp->dev) {
   1350  1.1  augustss 	case SV_RECORD_SOURCE:
   1351  1.1  augustss 		if (cp->type != AUDIO_MIXER_ENUM)
   1352  1.1  augustss 			return (EINVAL);
   1353  1.1  augustss 
   1354  1.1  augustss 		reg = sv_read_indirect(sc, SV_LEFT_ADC_INPUT_CONTROL);
   1355  1.1  augustss 		cp->un.ord = ((reg & SV_REC_SOURCE_MASK) >> SV_REC_SOURCE_SHIFT);
   1356  1.1  augustss 
   1357  1.1  augustss 		return (0);
   1358  1.1  augustss 
   1359  1.1  augustss 	case SV_RECORD_GAIN:
   1360  1.1  augustss 		if (cp->type != AUDIO_MIXER_VALUE)
   1361  1.1  augustss 			return (EINVAL);
   1362  1.1  augustss 		if (cp->un.value.num_channels != 1)
   1363  1.1  augustss 			return (EINVAL);
   1364  1.1  augustss 
   1365  1.1  augustss 		reg = sv_read_indirect(sc, SV_LEFT_ADC_INPUT_CONTROL) & SV_REC_GAIN_MASK;
   1366  1.1  augustss 		cp->un.value.level[AUDIO_MIXER_LEVEL_MONO] =
   1367  1.1  augustss 			(((unsigned int)reg) * AUDIO_MAX_GAIN) / SV_REC_GAIN_MASK;
   1368  1.1  augustss 
   1369  1.1  augustss 		return (0);
   1370  1.1  augustss 
   1371  1.1  augustss 	case SV_MIC_BOOST:
   1372  1.1  augustss 		if (cp->type != AUDIO_MIXER_ENUM)
   1373  1.1  augustss 			return (EINVAL);
   1374  1.1  augustss 		reg = sv_read_indirect(sc, SV_LEFT_ADC_INPUT_CONTROL);
   1375  1.1  augustss 		cp->un.ord = ((reg & SV_MIC_BOOST_BIT) ? 1 : 0);
   1376  1.1  augustss 		return (0);
   1377  1.1  augustss 
   1378  1.1  augustss 
   1379  1.1  augustss 	case SV_SRS_MODE:
   1380  1.1  augustss 		if (cp->type != AUDIO_MIXER_ENUM)
   1381  1.1  augustss 			return (EINVAL);
   1382  1.1  augustss 		reg = sv_read_indirect(sc, SV_SRS_SPACE_CONTROL);
   1383  1.1  augustss 		cp->un.ord = ((reg & SV_SRS_SPACE_ONOFF) ? 0 : 1);
   1384  1.1  augustss 		return (0);
   1385  1.1  augustss 	}
   1386  1.1  augustss 
   1387  1.1  augustss 	return (EINVAL);
   1388  1.1  augustss }
   1389  1.1  augustss 
   1390  1.1  augustss 
   1391  1.1  augustss static void
   1392  1.1  augustss sv_init_mixer(sc)
   1393  1.1  augustss 	struct sv_softc *sc;
   1394  1.1  augustss {
   1395  1.1  augustss 	mixer_ctrl_t cp;
   1396  1.1  augustss 	int i;
   1397  1.1  augustss 
   1398  1.1  augustss 	cp.type = AUDIO_MIXER_ENUM;
   1399  1.1  augustss 	cp.dev = SV_SRS_MODE;
   1400  1.1  augustss 	cp.un.ord = 0;
   1401  1.1  augustss 
   1402  1.1  augustss 	sv_mixer_set_port(sc, &cp);
   1403  1.1  augustss 
   1404  1.1  augustss 	for (i = 0; i < ARRAY_SIZE(ports); i++) {
   1405  1.1  augustss 		if (ports[i].audio == AudioNdac) {
   1406  1.1  augustss 			cp.type = AUDIO_MIXER_ENUM;
   1407  1.1  augustss 			cp.dev = SV_FIRST_MIXER + i * SV_DEVICES_PER_PORT + 1;
   1408  1.1  augustss 			cp.un.ord = 0;
   1409  1.1  augustss 			sv_mixer_set_port(sc, &cp);
   1410  1.1  augustss 			break;
   1411  1.1  augustss 		}
   1412  1.1  augustss 	}
   1413  1.1  augustss }
   1414  1.1  augustss 
   1415  1.1  augustss void *
   1416  1.2   mycroft sv_malloc(addr, direction, size, pool, flags)
   1417  1.1  augustss 	void *addr;
   1418  1.2   mycroft 	int direction;
   1419  1.2   mycroft 	size_t size;
   1420  1.2   mycroft 	int pool, flags;
   1421  1.1  augustss {
   1422  1.1  augustss 	struct sv_softc *sc = addr;
   1423  1.4   mycroft 	struct sv_dma *p;
   1424  1.4   mycroft 	int error;
   1425  1.1  augustss 
   1426  1.4   mycroft 	p = malloc(sizeof(*p), pool, flags);
   1427  1.4   mycroft 	if (!p)
   1428  1.4   mycroft 		return (0);
   1429  1.4   mycroft 	error = sv_allocmem(sc, size, 16, p);
   1430  1.4   mycroft 	if (error) {
   1431  1.4   mycroft 		free(p, pool);
   1432  1.4   mycroft 		return (0);
   1433  1.4   mycroft 	}
   1434  1.4   mycroft 	p->next = sc->sc_dmas;
   1435  1.4   mycroft 	sc->sc_dmas = p;
   1436  1.1  augustss 	return (KERNADDR(p));
   1437  1.1  augustss }
   1438  1.1  augustss 
   1439  1.1  augustss void
   1440  1.1  augustss sv_free(addr, ptr, pool)
   1441  1.1  augustss 	void *addr;
   1442  1.1  augustss 	void *ptr;
   1443  1.1  augustss 	int pool;
   1444  1.1  augustss {
   1445  1.1  augustss 	struct sv_softc *sc = addr;
   1446  1.4   mycroft 	struct sv_dma **p;
   1447  1.1  augustss 
   1448  1.4   mycroft 	for (p = &sc->sc_dmas; *p; p = &(*p)->next) {
   1449  1.4   mycroft 		if (KERNADDR(*p) == ptr) {
   1450  1.4   mycroft 			sv_freemem(sc, *p);
   1451  1.4   mycroft 			*p = (*p)->next;
   1452  1.4   mycroft 			free(*p, pool);
   1453  1.4   mycroft 			return;
   1454  1.4   mycroft 		}
   1455  1.4   mycroft 	}
   1456  1.1  augustss }
   1457  1.1  augustss 
   1458  1.2   mycroft size_t
   1459  1.2   mycroft sv_round_buffersize(addr, direction, size)
   1460  1.1  augustss 	void *addr;
   1461  1.2   mycroft 	int direction;
   1462  1.2   mycroft 	size_t size;
   1463  1.1  augustss {
   1464  1.1  augustss 	return (size);
   1465  1.1  augustss }
   1466  1.1  augustss 
   1467  1.1  augustss int
   1468  1.1  augustss sv_mappage(addr, mem, off, prot)
   1469  1.1  augustss 	void *addr;
   1470  1.4   mycroft 	void *mem;
   1471  1.4   mycroft 	int off;
   1472  1.1  augustss 	int prot;
   1473  1.1  augustss {
   1474  1.1  augustss 	struct sv_softc *sc = addr;
   1475  1.4   mycroft 	struct sv_dma *p;
   1476  1.1  augustss 
   1477  1.3   mycroft 	if (off < 0)
   1478  1.3   mycroft 		return (-1);
   1479  1.4   mycroft 	for (p = sc->sc_dmas; p && KERNADDR(p) != mem; p = p->next)
   1480  1.1  augustss 		;
   1481  1.1  augustss 	if (!p)
   1482  1.1  augustss 		return (-1);
   1483  1.1  augustss 	return (bus_dmamem_mmap(sc->sc_dmatag, p->segs, p->nsegs,
   1484  1.1  augustss 				off, prot, BUS_DMA_WAITOK));
   1485  1.1  augustss }
   1486  1.1  augustss 
   1487  1.1  augustss int
   1488  1.1  augustss sv_get_props(addr)
   1489  1.1  augustss 	void *addr;
   1490  1.1  augustss {
   1491  1.3   mycroft 	return (AUDIO_PROP_MMAP | AUDIO_PROP_INDEPENDENT | AUDIO_PROP_FULLDUPLEX);
   1492  1.1  augustss }
   1493