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