Home | History | Annotate | Line # | Download | only in dev
vs.c revision 1.22
      1  1.22     lukem /*	$NetBSD: vs.c,v 1.22 2003/07/15 01:44:52 lukem Exp $	*/
      2   1.1   minoura 
      3   1.1   minoura /*
      4   1.1   minoura  * Copyright (c) 2001 Tetsuya Isaki. All rights reserved.
      5   1.1   minoura  *
      6   1.1   minoura  * Redistribution and use in source and binary forms, with or without
      7   1.1   minoura  * modification, are permitted provided that the following conditions
      8   1.1   minoura  * are met:
      9   1.1   minoura  * 1. Redistributions of source code must retain the above copyright
     10   1.1   minoura  *    notice, this list of conditions and the following disclaimer.
     11   1.1   minoura  * 2. Redistributions in binary form must reproduce the above copyright
     12   1.1   minoura  *    notice, this list of conditions and the following disclaimer in the
     13   1.1   minoura  *    documentation and/or other materials provided with the distribution.
     14   1.1   minoura  * 3. All advertising materials mentioning features or use of this software
     15   1.1   minoura  *    must display the following acknowledgement:
     16   1.1   minoura  *      This product includes software developed by Tetsuya Isaki.
     17   1.1   minoura  * 4. The name of the author may not be used to endorse or promote products
     18   1.1   minoura  *    derived from this software without specific prior written permission
     19   1.1   minoura  *
     20   1.1   minoura  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     21   1.1   minoura  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     22   1.1   minoura  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     23   1.1   minoura  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     24   1.1   minoura  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
     25   1.1   minoura  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     26   1.1   minoura  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
     27   1.1   minoura  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
     28   1.1   minoura  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     29   1.1   minoura  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     30   1.1   minoura  * SUCH DAMAGE.
     31   1.1   minoura  */
     32   1.1   minoura 
     33   1.1   minoura /*
     34   1.1   minoura  * VS - OKI MSM6258 ADPCM voice synthesizer device driver.
     35   1.1   minoura  */
     36  1.22     lukem 
     37  1.22     lukem #include <sys/cdefs.h>
     38  1.22     lukem __KERNEL_RCSID(0, "$NetBSD: vs.c,v 1.22 2003/07/15 01:44:52 lukem Exp $");
     39   1.1   minoura 
     40   1.1   minoura #include "audio.h"
     41   1.1   minoura #include "vs.h"
     42   1.1   minoura #if NAUDIO > 0 && NVS > 0
     43   1.1   minoura 
     44   1.1   minoura #include <sys/param.h>
     45   1.1   minoura #include <sys/systm.h>
     46   1.1   minoura #include <sys/device.h>
     47   1.1   minoura 
     48   1.1   minoura #include <sys/audioio.h>
     49   1.1   minoura #include <dev/audio_if.h>
     50   1.1   minoura 
     51   1.1   minoura #include <machine/bus.h>
     52   1.1   minoura #include <machine/cpu.h>
     53   1.1   minoura 
     54   1.1   minoura #include <dev/ic/msm6258var.h>
     55   1.1   minoura 
     56   1.1   minoura #include <arch/x68k/dev/dmacvar.h>
     57   1.1   minoura #include <arch/x68k/dev/intiovar.h>
     58   1.1   minoura #include <arch/x68k/dev/opmreg.h>
     59   1.1   minoura 
     60   1.1   minoura #include <arch/x68k/dev/vsvar.h>
     61   1.1   minoura 
     62   1.1   minoura #ifdef VS_DEBUG
     63   1.9     isaki #define DPRINTF(y,x)	if(vs_debug>=(y))printf x
     64   1.9     isaki static int vs_debug;
     65   1.1   minoura #ifdef AUDIO_DEBUG
     66   1.1   minoura extern int audiodebug;
     67   1.1   minoura #endif
     68   1.1   minoura #else
     69   1.9     isaki #define DPRINTF(y,x)
     70   1.1   minoura #endif
     71   1.1   minoura 
     72   1.1   minoura static int  vs_match __P((struct device *, struct cfdata *, void *));
     73   1.1   minoura static void vs_attach __P((struct device *, struct device *, void *));
     74   1.1   minoura 
     75   1.1   minoura static int  vs_dmaintr __P((void *));
     76   1.1   minoura static int  vs_dmaerrintr __P((void *));
     77   1.1   minoura 
     78   1.1   minoura /* MI audio layer interface */
     79   1.1   minoura static int  vs_open __P((void *, int));
     80   1.1   minoura static void vs_close __P((void *));
     81   1.1   minoura static int  vs_query_encoding __P((void *, struct audio_encoding *));
     82   1.1   minoura static int  vs_set_params __P((void *, int, int, struct audio_params *,
     83   1.1   minoura 	struct audio_params *));
     84   1.1   minoura static int  vs_trigger_output __P((void *, void *, void *, int,
     85   1.1   minoura 				   void (*)(void *), void *,
     86   1.1   minoura 				   struct audio_params *));
     87   1.1   minoura static int  vs_trigger_input __P((void *, void *, void *, int,
     88   1.1   minoura 				   void (*)(void *), void *,
     89   1.1   minoura 				   struct audio_params *));
     90   1.1   minoura static int  vs_halt_output __P((void *));
     91   1.1   minoura static int  vs_halt_input __P((void *));
     92   1.1   minoura static int  vs_allocmem __P((struct vs_softc *, size_t, size_t, size_t, int,
     93   1.1   minoura 			    struct vs_dma *));
     94   1.1   minoura static void vs_freemem __P((struct vs_dma *));
     95   1.1   minoura static int  vs_getdev __P((void *, struct audio_device *));
     96   1.1   minoura static int  vs_set_port __P((void *, mixer_ctrl_t *));
     97   1.1   minoura static int  vs_get_port __P((void *, mixer_ctrl_t *));
     98   1.1   minoura static int  vs_query_devinfo __P((void *, mixer_devinfo_t *));
     99  1.21   thorpej static void *vs_allocm __P((void *, int, size_t, struct malloc_type *, int));
    100  1.21   thorpej static void vs_freem __P((void *, void *, struct malloc_type *));
    101   1.1   minoura static size_t vs_round_buffersize __P((void *, int, size_t));
    102   1.1   minoura static int  vs_get_props __P((void *));
    103   1.1   minoura 
    104   1.1   minoura /* lower functions */
    105   1.2   minoura static int vs_round_sr(u_long);
    106   1.2   minoura static void vs_set_sr(struct vs_softc *sc, int);
    107   1.1   minoura static inline void vs_set_po(struct vs_softc *sc, u_long);
    108   1.1   minoura 
    109  1.20     isaki extern struct cfdriver vs_cd;
    110   1.1   minoura 
    111  1.17   thorpej CFATTACH_DECL(vs, sizeof(struct vs_softc),
    112  1.18   thorpej     vs_match, vs_attach, NULL, NULL);
    113   1.1   minoura 
    114   1.1   minoura static struct audio_hw_if vs_hw_if = {
    115   1.1   minoura 	vs_open,
    116   1.1   minoura 	vs_close,
    117   1.1   minoura 	NULL,			/* drain */
    118   1.1   minoura 
    119   1.1   minoura 	vs_query_encoding,
    120   1.1   minoura 	vs_set_params,
    121   1.1   minoura 	NULL,			/* round_blocksize */
    122   1.1   minoura 	NULL,			/* commit_settings */
    123   1.1   minoura 
    124   1.1   minoura 	NULL, 			/* init_output */
    125   1.1   minoura 	NULL, 			/* init_input */
    126   1.1   minoura 	NULL, 			/* start_output */
    127   1.1   minoura 	NULL,			/* start_input */
    128   1.1   minoura 
    129   1.1   minoura 	vs_halt_output,
    130   1.1   minoura 	vs_halt_input,
    131   1.1   minoura 	NULL,			/* speaker_ctl */
    132   1.1   minoura 
    133   1.1   minoura 	vs_getdev,
    134   1.1   minoura 	NULL,			/* setfd */
    135   1.1   minoura 
    136   1.1   minoura 	vs_set_port,
    137   1.1   minoura 	vs_get_port,
    138   1.1   minoura 	vs_query_devinfo,
    139   1.1   minoura 
    140   1.1   minoura 	vs_allocm,
    141   1.1   minoura 	vs_freem,
    142   1.1   minoura 	vs_round_buffersize,
    143   1.1   minoura 	NULL,			/* mappage */
    144   1.1   minoura 
    145   1.1   minoura 	vs_get_props,
    146   1.1   minoura 
    147   1.1   minoura 	vs_trigger_output,
    148   1.1   minoura 	vs_trigger_input,
    149   1.8  augustss 
    150   1.8  augustss 	NULL,
    151   1.1   minoura };
    152   1.1   minoura 
    153   1.1   minoura static struct audio_device vs_device = {
    154   1.1   minoura 	"OKI MSM6258",
    155   1.1   minoura 	"",
    156   1.1   minoura 	"vs"
    157   1.1   minoura };
    158   1.1   minoura 
    159   1.1   minoura struct {
    160   1.1   minoura 	u_long rate;
    161   1.1   minoura 	u_char clk;
    162   1.1   minoura 	u_char den;
    163   1.1   minoura } vs_l2r[] = {
    164   1.2   minoura 	{ VS_RATE_15K, VS_CLK_8MHZ, VS_SRATE_512 },
    165   1.2   minoura 	{ VS_RATE_10K, VS_CLK_8MHZ, VS_SRATE_768 },
    166   1.2   minoura 	{ VS_RATE_7K,  VS_CLK_8MHZ, VS_SRATE_1024},
    167   1.2   minoura 	{ VS_RATE_5K,  VS_CLK_4MHZ, VS_SRATE_768 },
    168   1.2   minoura 	{ VS_RATE_3K,  VS_CLK_4MHZ, VS_SRATE_1024}
    169   1.1   minoura };
    170   1.1   minoura 
    171   1.2   minoura #define NUM_RATE	(sizeof(vs_l2r)/sizeof(vs_l2r[0]))
    172   1.1   minoura 
    173  1.15     isaki struct {
    174  1.15     isaki 	char	*name;
    175  1.15     isaki 	int	encoding;
    176  1.15     isaki 	int	precision;
    177  1.15     isaki } vs_encodings[] = {
    178  1.15     isaki 	{AudioEadpcm,      AUDIO_ENCODING_ADPCM,       4},
    179  1.15     isaki 	{AudioEslinear,    AUDIO_ENCODING_SLINEAR,     8},
    180  1.15     isaki 	{AudioEulinear,    AUDIO_ENCODING_ULINEAR,     8},
    181  1.15     isaki 	{AudioEmulaw,      AUDIO_ENCODING_ULAW,        8},
    182  1.15     isaki 	{AudioEslinear_be, AUDIO_ENCODING_SLINEAR_BE, 16},
    183  1.15     isaki 	{AudioEslinear_le, AUDIO_ENCODING_SLINEAR_LE, 16},
    184  1.10     isaki };
    185  1.10     isaki 
    186   1.1   minoura static int
    187   1.1   minoura vs_match(struct device *parent, struct cfdata *cf, void *aux)
    188   1.1   minoura {
    189   1.1   minoura 	struct intio_attach_args *ia = aux;
    190   1.1   minoura 
    191   1.1   minoura 	if (strcmp(ia->ia_name, "vs") || cf->cf_unit > 0)
    192   1.1   minoura 		return 0;
    193   1.1   minoura 
    194   1.1   minoura 	if (ia->ia_addr == INTIOCF_ADDR_DEFAULT)
    195   1.1   minoura 		ia->ia_addr = VS_ADDR;
    196   1.1   minoura 	if (ia->ia_dma == INTIOCF_DMA_DEFAULT)
    197   1.1   minoura 		ia->ia_dma = VS_DMA;
    198   1.1   minoura 	if (ia->ia_dmaintr == INTIOCF_DMAINTR_DEFAULT)
    199   1.1   minoura 		ia->ia_dmaintr = VS_DMAINTR;
    200   1.1   minoura 
    201   1.1   minoura 	/* fixed parameters */
    202   1.1   minoura 	if (ia->ia_addr != VS_ADDR)
    203   1.1   minoura 		return 0;
    204   1.1   minoura 	if (ia->ia_dma != VS_DMA)
    205   1.1   minoura 		return 0;
    206   1.1   minoura 	if (ia->ia_dmaintr != VS_DMAINTR)
    207   1.1   minoura 		return 0;
    208   1.1   minoura 
    209   1.9     isaki #ifdef VS_DEBUG
    210   1.9     isaki 	vs_debug = 1;
    211   1.1   minoura #ifdef AUDIO_DEBUG
    212   1.1   minoura 	audiodebug = 2;
    213   1.1   minoura #endif
    214   1.9     isaki #endif
    215   1.1   minoura 
    216   1.1   minoura 	return 1;
    217   1.1   minoura }
    218   1.1   minoura 
    219   1.1   minoura static void
    220   1.1   minoura vs_attach(struct device *parent, struct device *self, void *aux)
    221   1.1   minoura {
    222   1.1   minoura 	struct vs_softc *sc = (struct vs_softc *)self;
    223   1.1   minoura 	bus_space_tag_t iot;
    224   1.1   minoura 	bus_space_handle_t ioh;
    225   1.1   minoura 	struct intio_attach_args *ia = aux;
    226   1.1   minoura 
    227   1.1   minoura 	printf("\n");
    228   1.1   minoura 
    229   1.1   minoura 	/* Re-map the I/O space */
    230   1.1   minoura 	iot = ia->ia_bst;
    231   1.1   minoura 	bus_space_map(iot, ia->ia_addr, 0x2000, BUS_SPACE_MAP_SHIFTED, &ioh);
    232   1.1   minoura 
    233   1.1   minoura 	/* Initialize sc */
    234   1.1   minoura 	sc->sc_iot = iot;
    235   1.1   minoura 	sc->sc_ioh = ioh;
    236   1.1   minoura 	sc->sc_hw_if = &vs_hw_if;
    237   1.1   minoura 	sc->sc_addr = (caddr_t) ia->ia_addr;
    238   1.1   minoura 	sc->sc_dmas = NULL;
    239   1.1   minoura 
    240   1.1   minoura 	/* Initialize codec */
    241   1.1   minoura 	sc->sc_codec = msm6258_codec_init();
    242   1.1   minoura 	if (sc->sc_codec == NULL) {
    243   1.1   minoura 		printf ("Could not init codec\n");
    244   1.1   minoura 		return;
    245   1.1   minoura 	}
    246   1.1   minoura 
    247   1.1   minoura 	/* XXX */
    248   1.1   minoura 	bus_space_map(iot, PPI_ADDR, PPI_MAPSIZE, BUS_SPACE_MAP_SHIFTED,
    249   1.1   minoura 		      &sc->sc_ppi);
    250   1.1   minoura 
    251   1.1   minoura 	/* Initialize DMAC */
    252   1.1   minoura 	sc->sc_dmat = ia->ia_dmat;
    253   1.1   minoura 	sc->sc_dma_ch = dmac_alloc_channel(parent, ia->ia_dma, "vs",
    254   1.1   minoura 		ia->ia_dmaintr,   vs_dmaintr, sc,
    255   1.1   minoura 		ia->ia_dmaintr+1, vs_dmaerrintr, sc);
    256   1.1   minoura 
    257   1.1   minoura 	printf("%s: MSM6258V ADPCM voice synthesizer\n", sc->sc_dev.dv_xname);
    258   1.1   minoura 
    259   1.1   minoura 	audio_attach_mi(&vs_hw_if, sc, &sc->sc_dev);
    260   1.1   minoura }
    261   1.1   minoura 
    262   1.1   minoura /*
    263   1.1   minoura  * vs interrupt handler
    264   1.1   minoura  */
    265   1.1   minoura static int
    266   1.1   minoura vs_dmaintr(void *hdl)
    267   1.1   minoura {
    268   1.1   minoura 	struct vs_softc *sc = hdl;
    269   1.1   minoura 
    270   1.9     isaki 	DPRINTF(2, ("vs_dmaintr\n"));
    271   1.1   minoura 
    272   1.1   minoura 	if (sc->sc_pintr) {
    273   1.1   minoura 		/* start next transfer */
    274   1.2   minoura 		sc->sc_current.dmap += sc->sc_current.blksize;
    275   1.2   minoura 		if (sc->sc_current.dmap + sc->sc_current.blksize
    276  1.19     isaki 		    > sc->sc_current.bufsize)
    277   1.1   minoura 			sc->sc_current.dmap -= sc->sc_current.bufsize;
    278  1.19     isaki 		dmac_start_xfer_offset(sc->sc_dma_ch->ch_softc,
    279   1.1   minoura 					sc->sc_current.xfer,
    280   1.1   minoura 					sc->sc_current.dmap,
    281   1.2   minoura 					sc->sc_current.blksize);
    282   1.1   minoura 		sc->sc_pintr(sc->sc_parg);
    283   1.1   minoura 	} else if (sc->sc_rintr) {
    284   1.1   minoura 		/* start next transfer */
    285   1.2   minoura 		sc->sc_current.dmap += sc->sc_current.blksize;
    286   1.2   minoura 		if (sc->sc_current.dmap + sc->sc_current.blksize
    287  1.19     isaki 		    > sc->sc_current.bufsize)
    288   1.6   minoura 			sc->sc_current.dmap -= sc->sc_current.bufsize;
    289  1.19     isaki 		dmac_start_xfer_offset(sc->sc_dma_ch->ch_softc,
    290   1.1   minoura 					sc->sc_current.xfer,
    291   1.1   minoura 					sc->sc_current.dmap,
    292   1.2   minoura 					sc->sc_current.blksize);
    293   1.1   minoura 		sc->sc_rintr(sc->sc_rarg);
    294   1.1   minoura 	} else {
    295  1.19     isaki 		printf("vs_dmaintr: spurious interrupt\n");
    296   1.1   minoura 	}
    297   1.1   minoura 
    298   1.1   minoura 	return 1;
    299   1.1   minoura }
    300   1.1   minoura 
    301   1.1   minoura static int
    302   1.1   minoura vs_dmaerrintr(void *hdl)
    303   1.1   minoura {
    304   1.1   minoura 	struct vs_softc *sc = hdl;
    305   1.1   minoura 
    306   1.9     isaki 	DPRINTF(1, ("%s: DMA transfer error.\n", sc->sc_dev.dv_xname));
    307   1.1   minoura 	/* XXX */
    308  1.11   minoura 	vs_dmaintr(sc);
    309   1.1   minoura 
    310   1.1   minoura 	return 1;
    311   1.1   minoura }
    312   1.1   minoura 
    313   1.1   minoura 
    314   1.1   minoura /*
    315   1.1   minoura  * audio MD layer interfaces
    316   1.1   minoura  */
    317   1.1   minoura 
    318   1.1   minoura static int
    319   1.1   minoura vs_open(void *hdl, int flags)
    320   1.1   minoura {
    321   1.1   minoura 	struct vs_softc *sc = hdl;
    322   1.1   minoura 
    323   1.9     isaki 	DPRINTF(1, ("vs_open: flags=%d\n", flags));
    324   1.1   minoura 
    325   1.1   minoura 	sc->sc_pintr = NULL;
    326   1.1   minoura 	sc->sc_rintr = NULL;
    327  1.14     isaki 
    328  1.14     isaki 	msm6258_codec_open(sc);
    329   1.1   minoura 
    330   1.1   minoura 	return 0;
    331   1.1   minoura }
    332   1.1   minoura 
    333   1.1   minoura static void
    334   1.1   minoura vs_close(void *hdl)
    335   1.1   minoura {
    336   1.9     isaki 	DPRINTF(1, ("vs_close\n"));
    337   1.1   minoura }
    338   1.1   minoura 
    339   1.1   minoura static int
    340   1.1   minoura vs_query_encoding(void *hdl, struct audio_encoding *fp)
    341   1.1   minoura {
    342   1.9     isaki 	DPRINTF(1, ("vs_query_encoding\n"));
    343  1.10     isaki 
    344  1.10     isaki 	if (fp->index >= sizeof(vs_encodings) / sizeof(vs_encodings[0]))
    345   1.1   minoura 		return EINVAL;
    346  1.10     isaki 
    347  1.15     isaki 	strcpy(fp->name, vs_encodings[fp->index].name);
    348  1.15     isaki 	fp->encoding  = vs_encodings[fp->index].encoding;
    349  1.15     isaki 	fp->precision = vs_encodings[fp->index].precision;
    350  1.15     isaki 	if (fp->encoding == AUDIO_ENCODING_ADPCM)
    351  1.15     isaki 		fp->flags = 0;
    352  1.15     isaki 	else
    353  1.15     isaki 		fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
    354   1.1   minoura 	return 0;
    355   1.1   minoura }
    356   1.1   minoura 
    357   1.2   minoura static int
    358   1.1   minoura vs_round_sr(u_long rate)
    359   1.1   minoura {
    360   1.1   minoura 	int i;
    361   1.2   minoura 	int diff = rate;
    362   1.2   minoura 	int nearest = 0;
    363   1.2   minoura 
    364   1.2   minoura 	for (i = 0; i < NUM_RATE; i++) {
    365   1.2   minoura 		if (rate >= vs_l2r[i].rate) {
    366   1.2   minoura 			if (rate - vs_l2r[i].rate < diff) {
    367   1.2   minoura 				diff = rate - vs_l2r[i].rate;
    368   1.2   minoura 				nearest = i;
    369   1.2   minoura 			}
    370   1.2   minoura 		} else {
    371   1.2   minoura 			if (vs_l2r[i].rate - rate < diff) {
    372   1.2   minoura 				diff = vs_l2r[i].rate - rate;
    373   1.2   minoura 				nearest = i;
    374   1.2   minoura 			}
    375   1.2   minoura 		}
    376   1.1   minoura 	}
    377   1.2   minoura 	if (diff * 100 / rate > 15)
    378   1.2   minoura 		return -1;
    379   1.2   minoura 	else
    380   1.2   minoura 		return nearest;
    381   1.1   minoura }
    382   1.1   minoura 
    383   1.1   minoura static int
    384   1.1   minoura vs_set_params(void *hdl, int setmode, int usemode,
    385   1.1   minoura 	struct audio_params *play, struct audio_params *rec)
    386   1.1   minoura {
    387   1.1   minoura 	struct vs_softc *sc = hdl;
    388   1.1   minoura 	struct audio_params *p;
    389   1.1   minoura 	int mode;
    390   1.2   minoura 	int rate;
    391  1.15     isaki 	void (*pswcode)(void *, u_char *, int);
    392  1.15     isaki 	void (*rswcode)(void *, u_char *, int);
    393   1.1   minoura 
    394  1.19     isaki 	DPRINTF(1, ("vs_set_params: setmode=%d, usemode=%d\n",
    395  1.19     isaki 		setmode, usemode));
    396   1.1   minoura 
    397   1.1   minoura 	/* set first record info, then play info */
    398   1.1   minoura 	for (mode = AUMODE_RECORD; mode != -1;
    399   1.1   minoura 	     mode = (mode == AUMODE_RECORD) ? AUMODE_PLAY : -1) {
    400   1.1   minoura 		if ((setmode & mode) == 0)
    401   1.1   minoura 			continue;
    402   1.1   minoura 
    403   1.1   minoura 		p = (mode == AUMODE_PLAY) ? play : rec;
    404   1.1   minoura 
    405   1.1   minoura 		if (p->channels != 1)
    406   1.1   minoura 			return (EINVAL);
    407   1.1   minoura 
    408   1.2   minoura 		rate = p->sample_rate;
    409  1.15     isaki 		pswcode = NULL;
    410  1.15     isaki 		rswcode = NULL;
    411   1.1   minoura 		p->factor = 1;
    412  1.15     isaki 		p->factor_denom = 0;
    413  1.12     isaki 		p->hw_precision = 4;
    414  1.12     isaki 		p->hw_encoding = AUDIO_ENCODING_ADPCM;
    415  1.12     isaki 		DPRINTF(1, ("vs_set_params: encoding=%d, precision=%d\n",
    416  1.12     isaki 			p->encoding, p->precision));
    417  1.15     isaki 		switch (p->precision) {
    418  1.15     isaki 		case 4:
    419  1.15     isaki 			if (p->encoding == AUDIO_ENCODING_ADPCM)
    420  1.15     isaki 				p->factor_denom = 1;
    421   1.1   minoura 			break;
    422  1.15     isaki 		case 8:
    423  1.15     isaki 			switch (p->encoding) {
    424  1.15     isaki 			case AUDIO_ENCODING_ULAW:
    425  1.15     isaki 				p->factor_denom = 2;
    426  1.15     isaki 				pswcode = msm6258_mulaw_to_adpcm;
    427  1.15     isaki 				rswcode = msm6258_adpcm_to_mulaw;
    428  1.15     isaki 				break;
    429  1.15     isaki 			case AUDIO_ENCODING_SLINEAR:
    430  1.15     isaki 			case AUDIO_ENCODING_SLINEAR_LE:
    431  1.15     isaki 			case AUDIO_ENCODING_SLINEAR_BE:
    432  1.15     isaki 				p->factor_denom = 2;
    433  1.15     isaki 				pswcode = msm6258_slinear8_to_adpcm;
    434  1.15     isaki 				rswcode = msm6258_adpcm_to_slinear8;
    435  1.15     isaki 				break;
    436  1.15     isaki 			case AUDIO_ENCODING_ULINEAR:
    437  1.15     isaki 			case AUDIO_ENCODING_ULINEAR_LE:
    438  1.15     isaki 			case AUDIO_ENCODING_ULINEAR_BE:
    439  1.15     isaki 				p->factor_denom = 2;
    440  1.15     isaki 				pswcode = msm6258_ulinear8_to_adpcm;
    441  1.15     isaki 				rswcode = msm6258_adpcm_to_ulinear8;
    442  1.15     isaki 				break;
    443  1.15     isaki 			}
    444   1.1   minoura 			break;
    445  1.15     isaki 		case 16:
    446  1.15     isaki 			switch (p->encoding) {
    447  1.15     isaki 			case AUDIO_ENCODING_SLINEAR_LE:
    448  1.15     isaki 				p->factor_denom = 4;
    449  1.15     isaki 				pswcode = msm6258_slinear16_le_to_adpcm;
    450  1.15     isaki 				rswcode = msm6258_adpcm_to_slinear16_le;
    451  1.15     isaki 				break;
    452  1.15     isaki 			case AUDIO_ENCODING_SLINEAR_BE:
    453  1.15     isaki 				p->factor_denom = 4;
    454  1.15     isaki 				pswcode = msm6258_slinear16_be_to_adpcm;
    455  1.15     isaki 				rswcode = msm6258_adpcm_to_slinear16_be;
    456  1.15     isaki 				break;
    457  1.15     isaki 			}
    458   1.1   minoura 			break;
    459  1.15     isaki 		}
    460  1.15     isaki 		if (p->factor_denom == 0) {
    461   1.9     isaki 			DPRINTF(1, ("vs_set_params: mode=%d, encoding=%d\n",
    462   1.1   minoura 				mode, p->encoding));
    463  1.15     isaki 			return EINVAL;
    464   1.1   minoura 		}
    465  1.15     isaki 
    466   1.9     isaki 		DPRINTF(1, ("vs_set_params: rate=%d -> ", rate));
    467   1.2   minoura 		rate = vs_round_sr(rate);
    468   1.9     isaki 		DPRINTF(1, ("%d\n", rate));
    469   1.2   minoura 		if (rate < 0)
    470   1.2   minoura 			return (EINVAL);
    471  1.15     isaki 		if (mode == AUMODE_PLAY) {
    472  1.15     isaki 			p->sw_code = pswcode;
    473   1.2   minoura 			sc->sc_current.prate = rate;
    474  1.15     isaki 		} else {
    475  1.15     isaki 			p->sw_code = rswcode;
    476   1.2   minoura 			sc->sc_current.rrate = rate;
    477  1.15     isaki 		}
    478   1.1   minoura 	}
    479   1.1   minoura 
    480   1.1   minoura 	return 0;
    481   1.1   minoura }
    482   1.1   minoura 
    483   1.1   minoura static void
    484   1.2   minoura vs_set_sr(struct vs_softc *sc, int rate)
    485   1.1   minoura {
    486   1.9     isaki 	DPRINTF(1, ("setting sample rate to %d, %d\n",
    487   1.2   minoura 		 rate, (int)vs_l2r[rate].rate));
    488   1.2   minoura 	bus_space_write_1(sc->sc_iot, sc->sc_ppi, PPI_PORTC,
    489   1.2   minoura 			  (bus_space_read_1 (sc->sc_iot, sc->sc_ppi,
    490   1.2   minoura 					     PPI_PORTC) & 0xf0)
    491   1.2   minoura 			  | vs_l2r[rate].den);
    492   1.2   minoura 	adpcm_chgclk(vs_l2r[rate].clk);
    493   1.1   minoura }
    494   1.1   minoura 
    495   1.1   minoura static inline void
    496   1.1   minoura vs_set_po(struct vs_softc *sc, u_long po)
    497   1.1   minoura {
    498   1.1   minoura 	bus_space_write_1(sc->sc_iot, sc->sc_ppi, PPI_PORTC,
    499   1.1   minoura 			  (bus_space_read_1(sc->sc_iot, sc->sc_ppi, PPI_PORTC)
    500   1.1   minoura 			   & 0xfc) | po);
    501   1.1   minoura }
    502   1.1   minoura 
    503   1.1   minoura static int
    504   1.1   minoura vs_trigger_output(void *hdl, void *start, void *end, int bsize,
    505   1.6   minoura 		  void (*intr)(void *), void *arg,
    506   1.6   minoura 		  struct audio_params *p)
    507   1.1   minoura {
    508   1.1   minoura 	struct vs_softc *sc = hdl;
    509   1.1   minoura 	struct vs_dma *vd;
    510   1.1   minoura 	struct dmac_dma_xfer *xf;
    511   1.1   minoura 	struct dmac_channel_stat *chan = sc->sc_dma_ch;
    512   1.1   minoura 
    513   1.9     isaki 	DPRINTF(2, ("vs_trigger_output: start=%p, bsize=%d, intr=%p, arg=%p\n",
    514   1.1   minoura 		 start, bsize, intr, arg));
    515   1.1   minoura 
    516   1.1   minoura 	sc->sc_pintr = intr;
    517   1.1   minoura 	sc->sc_parg  = arg;
    518   1.2   minoura 	sc->sc_current.blksize = bsize;
    519   1.1   minoura 	sc->sc_current.bufsize = (char*)end - (char*)start;
    520   1.1   minoura 	sc->sc_current.dmap = 0;
    521   1.1   minoura 
    522   1.1   minoura 	/* Find DMA buffer. */
    523   1.1   minoura 	for (vd = sc->sc_dmas; vd != NULL && KVADDR(vd) != start;
    524   1.1   minoura 	     vd = vd->vd_next)
    525   1.1   minoura 		;
    526   1.1   minoura 	if (vd == NULL) {
    527   1.1   minoura 		printf("%s: trigger_output: bad addr %p\n",
    528   1.1   minoura 		    sc->sc_dev.dv_xname, start);
    529   1.1   minoura 		return (EINVAL);
    530   1.1   minoura 	}
    531   1.1   minoura 
    532   1.2   minoura 	vs_set_sr(sc, sc->sc_current.prate);
    533   1.1   minoura 	vs_set_po(sc, VS_PANOUT_LR);
    534   1.2   minoura 
    535  1.19     isaki 	xf = dmac_alloc_xfer(chan, sc->sc_dmat, vd->vd_map);
    536   1.1   minoura 	sc->sc_current.xfer = xf;
    537   1.1   minoura 	chan->ch_dcr = (DMAC_DCR_XRM_CSWOH | DMAC_DCR_OTYP_EASYNC |
    538   1.1   minoura 			DMAC_DCR_OPS_8BIT);
    539   1.1   minoura 	chan->ch_ocr = DMAC_OCR_REQG_EXTERNAL;
    540   1.1   minoura 	xf->dx_ocr = DMAC_OCR_DIR_MTD;
    541   1.1   minoura 	xf->dx_scr = DMAC_SCR_MAC_COUNT_UP | DMAC_SCR_DAC_NO_COUNT;
    542   1.1   minoura 	xf->dx_device = sc->sc_addr + MSM6258_DATA*2 + 1;
    543   1.2   minoura 
    544  1.19     isaki 	dmac_load_xfer(chan->ch_softc, xf);
    545  1.19     isaki 	dmac_start_xfer_offset(chan->ch_softc, xf, 0, sc->sc_current.blksize);
    546  1.19     isaki 	bus_space_write_1(sc->sc_iot, sc->sc_ioh, MSM6258_STAT, 2);
    547   1.1   minoura 
    548   1.1   minoura 	return 0;
    549   1.1   minoura }
    550   1.1   minoura 
    551   1.1   minoura static int
    552   1.1   minoura vs_trigger_input(void *hdl, void *start, void *end, int bsize,
    553   1.6   minoura 		 void (*intr)(void *), void *arg,
    554   1.6   minoura 		 struct audio_params *p)
    555   1.1   minoura {
    556   1.1   minoura 	struct vs_softc *sc = hdl;
    557   1.1   minoura 	struct vs_dma *vd;
    558   1.2   minoura 	struct dmac_dma_xfer *xf;
    559   1.2   minoura 	struct dmac_channel_stat *chan = sc->sc_dma_ch;
    560   1.1   minoura 
    561   1.9     isaki 	DPRINTF(2, ("vs_trigger_input: start=%p, bsize=%d, intr=%p, arg=%p\n",
    562   1.1   minoura 		 start, bsize, intr, arg));
    563   1.1   minoura 
    564   1.1   minoura 	sc->sc_rintr = intr;
    565   1.1   minoura 	sc->sc_rarg  = arg;
    566   1.2   minoura 	sc->sc_current.blksize = bsize;
    567   1.1   minoura 	sc->sc_current.bufsize = (char*)end - (char*)start;
    568   1.1   minoura 	sc->sc_current.dmap = 0;
    569   1.1   minoura 
    570   1.1   minoura 	/* Find DMA buffer. */
    571   1.1   minoura 	for (vd = sc->sc_dmas; vd != NULL && KVADDR(vd) != start;
    572   1.1   minoura 	     vd = vd->vd_next)
    573   1.1   minoura 		;
    574   1.1   minoura 	if (vd == NULL) {
    575   1.1   minoura 		printf("%s: trigger_output: bad addr %p\n",
    576   1.1   minoura 		    sc->sc_dev.dv_xname, start);
    577   1.1   minoura 		return (EINVAL);
    578   1.1   minoura 	}
    579   1.1   minoura 
    580   1.2   minoura 	vs_set_sr(sc, sc->sc_current.rrate);
    581  1.19     isaki 	xf = dmac_alloc_xfer(chan, sc->sc_dmat, vd->vd_map);
    582   1.2   minoura 	sc->sc_current.xfer = xf;
    583   1.2   minoura 	chan->ch_dcr = (DMAC_DCR_XRM_CSWOH | DMAC_DCR_OTYP_EASYNC |
    584   1.2   minoura 			DMAC_DCR_OPS_8BIT);
    585   1.2   minoura 	chan->ch_ocr = DMAC_OCR_REQG_EXTERNAL;
    586   1.2   minoura 	xf->dx_ocr = DMAC_OCR_DIR_DTM;
    587   1.2   minoura 	xf->dx_scr = DMAC_SCR_MAC_COUNT_UP | DMAC_SCR_DAC_NO_COUNT;
    588   1.2   minoura 	xf->dx_device = sc->sc_addr + MSM6258_DATA*2 + 1;
    589   1.2   minoura 
    590  1.19     isaki 	dmac_load_xfer(chan->ch_softc, xf);
    591  1.19     isaki 	dmac_start_xfer_offset(chan->ch_softc, xf, 0, sc->sc_current.blksize);
    592  1.19     isaki 	bus_space_write_1(sc->sc_iot, sc->sc_ioh, MSM6258_STAT, 4);
    593   1.1   minoura 
    594   1.1   minoura 	return 0;
    595   1.1   minoura }
    596   1.1   minoura 
    597   1.1   minoura static int
    598   1.1   minoura vs_halt_output(void *hdl)
    599   1.1   minoura {
    600   1.1   minoura 	struct vs_softc *sc = hdl;
    601   1.1   minoura 
    602   1.9     isaki 	DPRINTF(1, ("vs_halt_output\n"));
    603   1.1   minoura 
    604   1.1   minoura 	/* stop ADPCM play */
    605   1.1   minoura 	dmac_abort_xfer(sc->sc_dma_ch->ch_softc, sc->sc_current.xfer);
    606  1.19     isaki 	bus_space_write_1(sc->sc_iot, sc->sc_ioh, MSM6258_STAT, 1);
    607   1.1   minoura 
    608   1.1   minoura 	return 0;
    609   1.1   minoura }
    610   1.1   minoura 
    611   1.1   minoura static int
    612   1.1   minoura vs_halt_input(void *hdl)
    613   1.1   minoura {
    614   1.1   minoura 	struct vs_softc *sc = hdl;
    615   1.1   minoura 
    616   1.9     isaki 	DPRINTF(1, ("vs_halt_input\n"));
    617   1.1   minoura 
    618   1.1   minoura 	/* stop ADPCM recoding */
    619   1.1   minoura 	dmac_abort_xfer(sc->sc_dma_ch->ch_softc, sc->sc_current.xfer);
    620  1.19     isaki 	bus_space_write_1(sc->sc_iot, sc->sc_ioh, MSM6258_STAT, 1);
    621   1.1   minoura 
    622   1.1   minoura 	return 0;
    623   1.1   minoura }
    624   1.1   minoura 
    625   1.1   minoura static int
    626  1.19     isaki vs_allocmem(struct vs_softc *sc, size_t size, size_t align, size_t boundary,
    627  1.19     isaki 	int flags, struct vs_dma *vd)
    628   1.1   minoura {
    629   1.1   minoura 	int error, wait;
    630   1.1   minoura 
    631   1.1   minoura #ifdef DIAGNOSTIC
    632   1.1   minoura 	if (size > DMAC_MAXSEGSZ)
    633   1.1   minoura 		panic ("vs_allocmem: maximum size exceeded, %d", (int) size);
    634   1.1   minoura #endif
    635   1.1   minoura 
    636   1.1   minoura 	wait = (flags & M_NOWAIT) ? BUS_DMA_NOWAIT : BUS_DMA_WAITOK;
    637   1.1   minoura 	vd->vd_size = size;
    638   1.1   minoura 
    639   1.1   minoura 	error = bus_dmamem_alloc(vd->vd_dmat, vd->vd_size, align, boundary,
    640   1.1   minoura 				 vd->vd_segs,
    641   1.1   minoura 				 sizeof (vd->vd_segs) / sizeof (vd->vd_segs[0]),
    642   1.1   minoura 				 &vd->vd_nsegs, wait);
    643   1.1   minoura 	if (error)
    644   1.1   minoura 		goto out;
    645   1.1   minoura 
    646   1.1   minoura 	error = bus_dmamem_map(vd->vd_dmat, vd->vd_segs, vd->vd_nsegs,
    647   1.1   minoura 			       vd->vd_size, &vd->vd_addr,
    648   1.1   minoura 			       wait | BUS_DMA_COHERENT);
    649   1.1   minoura 	if (error)
    650   1.1   minoura 		goto free;
    651   1.1   minoura 
    652   1.1   minoura 	error = bus_dmamap_create(vd->vd_dmat, vd->vd_size, 1, DMAC_MAXSEGSZ,
    653   1.1   minoura 				  0, wait, &vd->vd_map);
    654   1.1   minoura 	if (error)
    655   1.1   minoura 		goto unmap;
    656   1.1   minoura 
    657   1.1   minoura 	error = bus_dmamap_load(vd->vd_dmat, vd->vd_map, vd->vd_addr,
    658   1.1   minoura 				vd->vd_size, NULL, wait);
    659   1.1   minoura 	if (error)
    660   1.1   minoura 		goto destroy;
    661   1.1   minoura 
    662   1.1   minoura 	return (0);
    663   1.1   minoura 
    664   1.1   minoura  destroy:
    665   1.1   minoura 	bus_dmamap_destroy(vd->vd_dmat, vd->vd_map);
    666   1.1   minoura  unmap:
    667   1.1   minoura 	bus_dmamem_unmap(vd->vd_dmat, vd->vd_addr, vd->vd_size);
    668   1.1   minoura  free:
    669   1.1   minoura 	bus_dmamem_free(vd->vd_dmat, vd->vd_segs, vd->vd_nsegs);
    670   1.1   minoura  out:
    671   1.1   minoura 	return (error);
    672   1.1   minoura }
    673   1.1   minoura 
    674   1.1   minoura static void
    675  1.19     isaki vs_freemem(struct vs_dma *vd)
    676   1.1   minoura {
    677   1.1   minoura 
    678   1.1   minoura 	bus_dmamap_unload(vd->vd_dmat, vd->vd_map);
    679   1.1   minoura 	bus_dmamap_destroy(vd->vd_dmat, vd->vd_map);
    680   1.1   minoura 	bus_dmamem_unmap(vd->vd_dmat, vd->vd_addr, vd->vd_size);
    681   1.1   minoura 	bus_dmamem_free(vd->vd_dmat, vd->vd_segs, vd->vd_nsegs);
    682   1.1   minoura }
    683   1.1   minoura 
    684   1.1   minoura static int
    685   1.1   minoura vs_getdev(void *hdl, struct audio_device *retp)
    686   1.1   minoura {
    687   1.9     isaki 	DPRINTF(1, ("vs_getdev\n"));
    688   1.1   minoura 
    689   1.1   minoura 	*retp = vs_device;
    690   1.1   minoura 	return 0;
    691   1.1   minoura }
    692   1.1   minoura 
    693   1.1   minoura static int
    694   1.1   minoura vs_set_port(void *hdl, mixer_ctrl_t *cp)
    695   1.1   minoura {
    696   1.9     isaki 	DPRINTF(1, ("vs_set_port\n"));
    697   1.1   minoura 	return 0;
    698   1.1   minoura }
    699   1.1   minoura 
    700   1.1   minoura static int
    701   1.1   minoura vs_get_port(void *hdl, mixer_ctrl_t *cp)
    702   1.1   minoura {
    703   1.9     isaki 	DPRINTF(1, ("vs_get_port\n"));
    704   1.1   minoura 	return 0;
    705   1.1   minoura }
    706   1.1   minoura 
    707   1.1   minoura static int
    708   1.1   minoura vs_query_devinfo(void *hdl, mixer_devinfo_t *mi)
    709   1.1   minoura {
    710   1.9     isaki 	DPRINTF(1, ("vs_query_devinfo\n"));
    711   1.1   minoura 	switch (mi->index) {
    712   1.1   minoura 	default:
    713   1.1   minoura 		return EINVAL;
    714   1.1   minoura 	}
    715   1.1   minoura 	return 0;
    716   1.1   minoura }
    717   1.1   minoura 
    718   1.1   minoura static void *
    719  1.21   thorpej vs_allocm(void *hdl, int direction, size_t size, struct malloc_type *type,
    720  1.21   thorpej     int flags)
    721   1.1   minoura {
    722   1.1   minoura 	struct vs_softc *sc = hdl;
    723   1.1   minoura 	struct vs_dma *vd;
    724   1.1   minoura 	int error;
    725   1.1   minoura 
    726   1.1   minoura 	if ((vd = malloc(size, type, flags)) == NULL)
    727   1.1   minoura 		return (NULL);
    728   1.1   minoura 
    729   1.1   minoura 	vd->vd_dmat = sc->sc_dmat;
    730   1.1   minoura 
    731   1.1   minoura 	error = vs_allocmem(sc, size, 32, 0, flags, vd);
    732   1.1   minoura 	if (error) {
    733   1.1   minoura 		free(vd, type);
    734   1.1   minoura 		return (NULL);
    735   1.1   minoura 	}
    736   1.1   minoura 	vd->vd_next = sc->sc_dmas;
    737   1.1   minoura 	sc->sc_dmas = vd;
    738   1.1   minoura 
    739   1.1   minoura 	return (KVADDR(vd));
    740   1.1   minoura }
    741   1.1   minoura 
    742   1.1   minoura static void
    743  1.21   thorpej vs_freem(void *hdl, void *addr, struct malloc_type *type)
    744   1.1   minoura {
    745   1.1   minoura 	struct vs_softc *sc = hdl;
    746   1.1   minoura 	struct vs_dma *p, **pp;
    747   1.1   minoura 
    748   1.1   minoura 	for (pp = &sc->sc_dmas; (p = *pp) != NULL; pp = &p->vd_next) {
    749   1.1   minoura 		if (KVADDR(p) == addr) {
    750   1.1   minoura 			vs_freemem(p);
    751   1.1   minoura 			*pp = p->vd_next;
    752   1.1   minoura 			free(p, type);
    753   1.1   minoura 			return;
    754   1.1   minoura 		}
    755   1.1   minoura 	}
    756   1.1   minoura }
    757   1.1   minoura 
    758   1.1   minoura static size_t
    759   1.1   minoura vs_round_buffersize(void *hdl, int direction, size_t bufsize)
    760   1.1   minoura {
    761   1.1   minoura 	if (bufsize > DMAC_MAXSEGSZ)
    762   1.1   minoura 		bufsize = DMAC_MAXSEGSZ;
    763   1.1   minoura 
    764   1.1   minoura 	return bufsize;
    765   1.1   minoura }
    766   1.1   minoura 
    767   1.1   minoura #if 0
    768   1.1   minoura paddr_t
    769  1.19     isaki vs_mappage(void *addr, void *mem, off_t off, int prot)
    770   1.1   minoura {
    771   1.1   minoura 	struct vs_softc *sc = addr;
    772   1.1   minoura 	struct vs_dma *p;
    773   1.1   minoura 
    774   1.1   minoura 	if (off < 0)
    775   1.1   minoura 		return (-1);
    776   1.1   minoura 	for (p = sc->sc_dmas; p != NULL && KVADDR(p) != mem;
    777   1.1   minoura 	     p = p->vd_next)
    778   1.1   minoura 		;
    779   1.1   minoura 	if (p == NULL) {
    780   1.1   minoura 		printf("%s: mappage: bad addr %p\n",
    781   1.1   minoura 		    sc->sc_dev.dv_xname, start);
    782   1.1   minoura 		return (-1);
    783   1.1   minoura 	}
    784   1.1   minoura 
    785   1.1   minoura 	return (bus_dmamem_mmap(sc->sc_dmat, p->vd_segs, p->vd_nsegs,
    786   1.1   minoura 				off, prot, BUS_DMA_WAITOK));
    787   1.1   minoura }
    788   1.1   minoura #endif
    789   1.1   minoura 
    790   1.1   minoura static int
    791   1.1   minoura vs_get_props(void *hdl)
    792   1.1   minoura {
    793   1.9     isaki 	DPRINTF(1, ("vs_get_props\n"));
    794   1.1   minoura 	return 0 /* | dependent | half duplex | no mmap */;
    795   1.1   minoura }
    796   1.1   minoura #endif /* NAUDIO > 0 && NVS > 0*/
    797