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