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