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