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