Home | History | Annotate | Line # | Download | only in iomd
vidcaudio.c revision 1.55.16.2
      1  1.55.16.2    martin /*	$NetBSD: vidcaudio.c,v 1.55.16.2 2020/04/08 14:07:29 martin Exp $	*/
      2        1.1   reinoud 
      3        1.1   reinoud /*
      4        1.1   reinoud  * Copyright (c) 1995 Melvin Tang-Richardson
      5        1.1   reinoud  *
      6        1.1   reinoud  * Redistribution and use in source and binary forms, with or without
      7        1.1   reinoud  * modification, are permitted provided that the following conditions
      8        1.1   reinoud  * are met:
      9        1.1   reinoud  * 1. Redistributions of source code must retain the above copyright
     10        1.1   reinoud  *    notice, this list of conditions and the following disclaimer.
     11        1.1   reinoud  * 2. Redistributions in binary form must reproduce the above copyright
     12        1.1   reinoud  *    notice, this list of conditions and the following disclaimer in the
     13        1.1   reinoud  *    documentation and/or other materials provided with the distribution.
     14        1.1   reinoud  * 3. All advertising materials mentioning features or use of this software
     15        1.1   reinoud  *    must display the following acknowledgement:
     16        1.1   reinoud  *	This product includes software developed by the RiscBSD team.
     17        1.1   reinoud  * 4. The name of the author may not be used to endorse or promote products
     18        1.1   reinoud  *    derived from this software without specific prior written permission.
     19        1.1   reinoud  *
     20        1.1   reinoud  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     21        1.1   reinoud  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     22        1.1   reinoud  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     23        1.1   reinoud  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     24        1.1   reinoud  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     25        1.1   reinoud  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     26        1.1   reinoud  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     27        1.1   reinoud  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     28        1.1   reinoud  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     29        1.1   reinoud  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     30        1.1   reinoud  */
     31        1.1   reinoud 
     32       1.24     bjh21 /*-
     33       1.24     bjh21  * Copyright (c) 2003 Ben Harris
     34       1.24     bjh21  * All rights reserved.
     35       1.24     bjh21  *
     36       1.24     bjh21  * Redistribution and use in source and binary forms, with or without
     37       1.24     bjh21  * modification, are permitted provided that the following conditions
     38       1.24     bjh21  * are met:
     39       1.24     bjh21  * 1. Redistributions of source code must retain the above copyright
     40       1.24     bjh21  *    notice, this list of conditions and the following disclaimer.
     41       1.24     bjh21  * 2. Redistributions in binary form must reproduce the above copyright
     42       1.24     bjh21  *    notice, this list of conditions and the following disclaimer in the
     43       1.24     bjh21  *    documentation and/or other materials provided with the distribution.
     44       1.24     bjh21  * 3. The name of the author may not be used to endorse or promote products
     45       1.24     bjh21  *    derived from this software without specific prior written permission.
     46       1.24     bjh21  *
     47       1.24     bjh21  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     48       1.24     bjh21  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     49       1.24     bjh21  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     50       1.24     bjh21  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     51       1.24     bjh21  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     52       1.24     bjh21  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     53       1.24     bjh21  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     54       1.24     bjh21  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     55       1.24     bjh21  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     56       1.24     bjh21  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     57       1.24     bjh21  */
     58       1.24     bjh21 
     59        1.1   reinoud /*
     60       1.24     bjh21  * audio driver for the RiscPC 8/16 bit sound
     61        1.1   reinoud  *
     62        1.1   reinoud  * Interfaces with the NetBSD generic audio driver to provide SUN
     63        1.1   reinoud  * /dev/audio (partial) compatibility.
     64        1.1   reinoud  */
     65        1.1   reinoud 
     66        1.1   reinoud #include <sys/param.h>	/* proc.h */
     67        1.5     bjh21 
     68  1.55.16.2    martin __KERNEL_RCSID(0, "$NetBSD: vidcaudio.c,v 1.55.16.2 2020/04/08 14:07:29 martin Exp $");
     69        1.5     bjh21 
     70       1.18     bjh21 #include <sys/audioio.h>
     71        1.1   reinoud #include <sys/conf.h>   /* autoconfig functions */
     72        1.1   reinoud #include <sys/device.h> /* device calls */
     73       1.18     bjh21 #include <sys/errno.h>
     74       1.30     bjh21 #include <sys/malloc.h>
     75        1.1   reinoud #include <sys/proc.h>	/* device calls */
     76        1.1   reinoud #include <sys/systm.h>
     77        1.1   reinoud 
     78        1.1   reinoud #include <uvm/uvm_extern.h>
     79        1.1   reinoud 
     80  1.55.16.1  christos #include <dev/audio/audio_if.h>
     81  1.55.16.1  christos #include <dev/audio/audiobellvar.h>
     82  1.55.16.1  christos #include <dev/audio/mulaw.h>
     83        1.1   reinoud 
     84        1.4   thorpej #include <machine/intr.h>
     85       1.27     bjh21 #include <machine/machdep.h>
     86        1.1   reinoud 
     87        1.5     bjh21 #include <arm/iomd/vidcaudiovar.h>
     88        1.1   reinoud #include <arm/iomd/iomdreg.h>
     89        1.1   reinoud #include <arm/iomd/iomdvar.h>
     90        1.1   reinoud #include <arm/iomd/vidc.h>
     91        1.1   reinoud #include <arm/mainbus/mainbus.h>
     92        1.1   reinoud 
     93       1.39     bjh21 #include "pckbd.h"
     94       1.39     bjh21 #if NPCKBD > 0
     95       1.39     bjh21 #include <dev/pckbport/pckbdvar.h>
     96       1.39     bjh21 #endif
     97       1.39     bjh21 
     98        1.1   reinoud extern int *vidc_base;
     99        1.1   reinoud 
    100       1.28     bjh21 #ifdef VIDCAUDIO_DEBUG
    101       1.28     bjh21 #define DPRINTF(x)	printf x
    102       1.28     bjh21 #else
    103       1.28     bjh21 #define DPRINTF(x)
    104       1.28     bjh21 #endif
    105       1.28     bjh21 
    106       1.53     skrll #define WriteWord(a, b) \
    107       1.53     skrll *((volatile unsigned int *)(a)) = (b)
    108       1.53     skrll 
    109       1.53     skrll #define ReadWord(a) \
    110       1.53     skrll (*((volatile unsigned int *)(a)))
    111       1.53     skrll 
    112       1.24     bjh21 struct vidcaudio_softc {
    113       1.50     skrll 	device_t	sc_dev;
    114        1.1   reinoud 
    115       1.24     bjh21 	irqhandler_t	sc_ih;
    116       1.24     bjh21 	int	sc_dma_intr;
    117        1.1   reinoud 
    118       1.27     bjh21 	int	sc_is16bit;
    119        1.1   reinoud 
    120       1.24     bjh21 	size_t	sc_pblksize;
    121       1.52      matt 	vaddr_t	sc_poffset;
    122       1.52      matt 	vaddr_t	sc_pbufsize;
    123       1.30     bjh21 	paddr_t	*sc_ppages;
    124       1.24     bjh21 	void	(*sc_pintr)(void *);
    125       1.24     bjh21 	void	*sc_parg;
    126       1.24     bjh21 	int	sc_pcountdown;
    127       1.47  jmcneill 
    128       1.47  jmcneill 	kmutex_t	sc_lock;
    129       1.47  jmcneill 	kmutex_t	sc_intr_lock;
    130        1.1   reinoud };
    131        1.1   reinoud 
    132       1.50     skrll static int  vidcaudio_probe(device_t , cfdata_t , void *);
    133       1.50     skrll static void vidcaudio_attach(device_t , device_t , void *);
    134       1.25     bjh21 static void vidcaudio_close(void *);
    135       1.25     bjh21 
    136       1.25     bjh21 static int vidcaudio_intr(void *);
    137       1.25     bjh21 static void vidcaudio_rate(int);
    138       1.25     bjh21 static void vidcaudio_ctrl(int);
    139       1.25     bjh21 static void vidcaudio_stereo(int, int);
    140        1.1   reinoud 
    141       1.50     skrll CFATTACH_DECL_NEW(vidcaudio, sizeof(struct vidcaudio_softc),
    142       1.13   thorpej     vidcaudio_probe, vidcaudio_attach, NULL, NULL);
    143        1.1   reinoud 
    144  1.55.16.1  christos static int    vidcaudio_query_format(void *, audio_format_query_t *);
    145  1.55.16.1  christos static int    vidcaudio_set_format(void *, int,
    146  1.55.16.1  christos     const audio_params_t *, const audio_params_t *,
    147  1.55.16.1  christos     audio_filter_reg_t *, audio_filter_reg_t *);
    148       1.41      kent static int    vidcaudio_round_blocksize(void *, int, int, const audio_params_t *);
    149       1.25     bjh21 static int    vidcaudio_trigger_output(void *, void *, void *, int,
    150       1.41      kent     void (*)(void *), void *, const audio_params_t *);
    151       1.25     bjh21 static int    vidcaudio_halt_output(void *);
    152       1.25     bjh21 static int    vidcaudio_getdev(void *, struct audio_device *);
    153       1.25     bjh21 static int    vidcaudio_set_port(void *, mixer_ctrl_t *);
    154       1.25     bjh21 static int    vidcaudio_get_port(void *, mixer_ctrl_t *);
    155       1.25     bjh21 static int    vidcaudio_query_devinfo(void *, mixer_devinfo_t *);
    156       1.25     bjh21 static int    vidcaudio_get_props(void *);
    157       1.47  jmcneill static void   vidcaudio_get_locks(void *, kmutex_t **, kmutex_t **);
    158        1.1   reinoud 
    159       1.25     bjh21 static struct audio_device vidcaudio_device = {
    160       1.24     bjh21 	"ARM VIDC",
    161       1.24     bjh21 	"",
    162        1.1   reinoud 	"vidcaudio"
    163        1.1   reinoud };
    164        1.1   reinoud 
    165       1.40      yamt static const struct audio_hw_if vidcaudio_hw_if = {
    166  1.55.16.1  christos 	.close			= vidcaudio_close,
    167  1.55.16.1  christos 	.query_format		= vidcaudio_query_format,
    168  1.55.16.1  christos 	.set_format		= vidcaudio_set_format,
    169  1.55.16.1  christos 	.round_blocksize	= vidcaudio_round_blocksize,
    170  1.55.16.1  christos 	.halt_output		= vidcaudio_halt_output,
    171  1.55.16.1  christos 	.getdev			= vidcaudio_getdev,
    172  1.55.16.1  christos 	.set_port		= vidcaudio_set_port,
    173  1.55.16.1  christos 	.get_port		= vidcaudio_get_port,
    174  1.55.16.1  christos 	.query_devinfo		= vidcaudio_query_devinfo,
    175  1.55.16.1  christos 	.get_props		= vidcaudio_get_props,
    176  1.55.16.1  christos 	.trigger_output		= vidcaudio_trigger_output,
    177  1.55.16.1  christos 	.get_locks		= vidcaudio_get_locks,
    178  1.55.16.1  christos };
    179  1.55.16.1  christos 
    180  1.55.16.1  christos static const struct audio_format vidcaudio_formats_16bit = {
    181  1.55.16.1  christos 	.mode		= AUMODE_PLAY,
    182  1.55.16.1  christos 	.encoding	= AUDIO_ENCODING_SLINEAR_LE,
    183  1.55.16.1  christos 	.validbits	= 16,
    184  1.55.16.1  christos 	.precision	= 16,
    185  1.55.16.1  christos 	.channels	= 2,
    186  1.55.16.1  christos 	.channel_mask	= AUFMT_STEREO,
    187  1.55.16.1  christos 	/* There are more selectable frequencies but these should be enough. */
    188  1.55.16.1  christos 	.frequency_type	= 6,
    189  1.55.16.1  christos 	.frequency	= {
    190  1.55.16.1  christos 		19600,	/* /9 */
    191  1.55.16.1  christos 		22050,	/* /8 */
    192  1.55.16.1  christos 		25200,	/* /7 */
    193  1.55.16.1  christos 		29400,	/* /6 */
    194  1.55.16.1  christos 		35280,	/* /5 */
    195  1.55.16.1  christos 		44100,	/* /4 */
    196  1.55.16.1  christos 	},
    197  1.55.16.1  christos };
    198  1.55.16.1  christos static const struct audio_format vidcaudio_formats_8bit = {
    199  1.55.16.1  christos 	.mode		= AUMODE_PLAY,
    200  1.55.16.1  christos 	.encoding	= AUDIO_ENCODING_ULAW,
    201  1.55.16.1  christos 	.validbits	= 8,
    202  1.55.16.1  christos 	.precision	= 8,
    203  1.55.16.1  christos 	.channels	= 2,	/* we use stereo always */
    204  1.55.16.1  christos 	.channel_mask	= AUFMT_STEREO,
    205  1.55.16.1  christos 	/* frequency is preferably an integer. */
    206  1.55.16.1  christos 	.frequency_type	= 6,
    207  1.55.16.1  christos 	.frequency	= {
    208  1.55.16.1  christos 		10000,	/* 50us */
    209  1.55.16.1  christos 		12500,	/* 40us */
    210  1.55.16.1  christos 		20000,	/* 25us */
    211  1.55.16.1  christos 		25000,	/* 20us */
    212  1.55.16.1  christos 		31250,	/* 16us */
    213  1.55.16.1  christos 		50000,	/* 10us */
    214  1.55.16.1  christos 	},
    215        1.1   reinoud };
    216        1.1   reinoud 
    217       1.25     bjh21 static int
    218       1.50     skrll vidcaudio_probe(device_t parent, cfdata_t cf, void *aux)
    219        1.1   reinoud {
    220        1.1   reinoud 	int id;
    221        1.1   reinoud 
    222        1.1   reinoud 	id = IOMD_ID;
    223        1.1   reinoud 
    224        1.1   reinoud 	/* So far I only know about this IOMD */
    225        1.1   reinoud 	switch (id) {
    226        1.1   reinoud 	case RPC600_IOMD_ID:
    227        1.1   reinoud 	case ARM7500_IOC_ID:
    228        1.1   reinoud 	case ARM7500FE_IOC_ID:
    229       1.18     bjh21 		return 1;
    230        1.1   reinoud 	default:
    231       1.24     bjh21 		aprint_error("vidcaudio: Unknown IOMD id=%04x", id);
    232       1.24     bjh21 		return 0;
    233        1.1   reinoud 	}
    234        1.1   reinoud }
    235        1.1   reinoud 
    236        1.1   reinoud 
    237       1.25     bjh21 static void
    238       1.50     skrll vidcaudio_attach(device_t parent, device_t self, void *aux)
    239        1.1   reinoud {
    240       1.50     skrll 	struct vidcaudio_softc *sc = device_private(self);
    241       1.50     skrll 	device_t beepdev;
    242        1.1   reinoud 
    243       1.50     skrll 	sc->sc_dev = self;
    244       1.24     bjh21 	switch (IOMD_ID) {
    245       1.32     chris #ifndef EB7500ATX
    246        1.1   reinoud 	case RPC600_IOMD_ID:
    247       1.27     bjh21 		sc->sc_is16bit = (cmos_read(0xc4) >> 5) & 1;
    248       1.24     bjh21 		sc->sc_dma_intr = IRQ_DMASCH0;
    249        1.1   reinoud 		break;
    250       1.32     chris #endif
    251        1.1   reinoud 	case ARM7500_IOC_ID:
    252        1.1   reinoud 	case ARM7500FE_IOC_ID:
    253       1.45   thorpej 		sc->sc_is16bit = true;
    254       1.24     bjh21 		sc->sc_dma_intr = IRQ_SDMA;
    255        1.1   reinoud 		break;
    256       1.24     bjh21 	default:
    257       1.24     bjh21 		aprint_error(": strange IOMD\n");
    258       1.24     bjh21 		return;
    259        1.1   reinoud 	}
    260        1.1   reinoud 
    261       1.27     bjh21 	if (sc->sc_is16bit)
    262       1.27     bjh21 		aprint_normal(": 16-bit external DAC\n");
    263       1.27     bjh21 	else
    264       1.27     bjh21 		aprint_normal(": 8-bit internal DAC\n");
    265       1.27     bjh21 
    266       1.47  jmcneill 	mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_NONE);
    267       1.48       mrg 	mutex_init(&sc->sc_intr_lock, MUTEX_DEFAULT, IPL_AUDIO);
    268       1.47  jmcneill 
    269       1.24     bjh21 	/* Install the irq handler for the DMA interrupt */
    270       1.24     bjh21 	sc->sc_ih.ih_func = vidcaudio_intr;
    271       1.24     bjh21 	sc->sc_ih.ih_arg = sc;
    272       1.48       mrg 	sc->sc_ih.ih_level = IPL_AUDIO;
    273       1.51     skrll 	sc->sc_ih.ih_name = device_xname(self);
    274       1.24     bjh21 
    275       1.24     bjh21 	if (irq_claim(sc->sc_dma_intr, &sc->sc_ih) != 0) {
    276       1.24     bjh21 		aprint_error("%s: couldn't claim IRQ %d\n",
    277       1.51     skrll 		    device_xname(self), sc->sc_dma_intr);
    278       1.24     bjh21 		return;
    279       1.24     bjh21 	}
    280        1.1   reinoud 
    281       1.24     bjh21 	disable_irq(sc->sc_dma_intr);
    282        1.1   reinoud 
    283       1.34     bjh21 	beepdev = audio_attach_mi(&vidcaudio_hw_if, sc, self);
    284       1.39     bjh21 #if NPCKBD > 0
    285       1.55  christos 	pckbd_hookup_bell(audiobell, beepdev);
    286       1.39     bjh21 #endif
    287        1.1   reinoud }
    288        1.1   reinoud 
    289       1.25     bjh21 static void
    290       1.17     bjh21 vidcaudio_close(void *addr)
    291        1.1   reinoud {
    292       1.42      kent 	struct vidcaudio_softc *sc;
    293        1.1   reinoud 
    294       1.28     bjh21 	DPRINTF(("DEBUG: vidcaudio_close called\n"));
    295       1.42      kent 	sc = addr;
    296       1.30     bjh21 	/*
    297       1.30     bjh21 	 * We do this here rather than in vidcaudio_halt_output()
    298       1.30     bjh21 	 * because the latter can be called from interrupt context
    299       1.30     bjh21 	 * (audio_pint()->audio_clear()->vidcaudio_halt_output()).
    300       1.30     bjh21 	 */
    301       1.30     bjh21 	if (sc->sc_ppages != NULL) {
    302       1.30     bjh21 		free(sc->sc_ppages, M_DEVBUF);
    303       1.30     bjh21 		sc->sc_ppages = NULL;
    304       1.30     bjh21 	}
    305        1.1   reinoud }
    306        1.1   reinoud 
    307       1.18     bjh21 /*
    308       1.18     bjh21  * Interface to the generic audio driver
    309       1.18     bjh21  */
    310        1.1   reinoud 
    311       1.25     bjh21 static int
    312  1.55.16.1  christos vidcaudio_query_format(void *addr, audio_format_query_t *afp)
    313        1.1   reinoud {
    314       1.42      kent 	struct vidcaudio_softc *sc;
    315       1.18     bjh21 
    316       1.42      kent 	sc = addr;
    317  1.55.16.1  christos 	if (sc->sc_is16bit)
    318  1.55.16.1  christos 		return audio_query_format(&vidcaudio_formats_16bit, 1, afp);
    319  1.55.16.1  christos 	else
    320  1.55.16.1  christos 		return audio_query_format(&vidcaudio_formats_8bit, 1, afp);
    321       1.24     bjh21 }
    322       1.24     bjh21 
    323       1.25     bjh21 static int
    324  1.55.16.1  christos vidcaudio_set_format(void *addr, int setmode,
    325  1.55.16.1  christos     const audio_params_t *play, const audio_params_t *rec,
    326  1.55.16.1  christos     audio_filter_reg_t *pfil, audio_filter_reg_t *rfil)
    327        1.1   reinoud {
    328       1.42      kent 	struct vidcaudio_softc *sc;
    329       1.24     bjh21 	int sample_period, ch;
    330       1.18     bjh21 
    331       1.42      kent 	sc = addr;
    332       1.36     bjh21 	if (sc->sc_is16bit) {
    333       1.36     bjh21 		/* ARM7500ish, 16-bit, two-channel */
    334  1.55.16.1  christos 		sample_period = 705600 / 4 / play->sample_rate;
    335  1.55.16.1  christos 		if (sample_period < 3)
    336  1.55.16.1  christos 			sample_period = 3;
    337       1.36     bjh21 		vidcaudio_rate(sample_period - 2);
    338       1.36     bjh21 		vidcaudio_ctrl(SCR_SERIAL);
    339       1.36     bjh21 	} else {
    340       1.36     bjh21 		/* VIDC20ish, u-law, 8-channel */
    341       1.36     bjh21 		/*
    342       1.36     bjh21 		 * We always use two hardware channels, because using
    343       1.36     bjh21 		 * one at 8kHz gives a nasty whining sound from the
    344  1.55.16.1  christos 		 * speaker.
    345       1.36     bjh21 		 */
    346  1.55.16.1  christos 		sample_period = 1000000 / 2 / play->sample_rate;
    347  1.55.16.1  christos 		if (sample_period < 3)
    348  1.55.16.1  christos 			sample_period = 3;
    349       1.36     bjh21 		vidcaudio_rate(sample_period - 2);
    350       1.36     bjh21 		vidcaudio_ctrl(SCR_SDAC | SCR_CLKSEL);
    351  1.55.16.1  christos 		for (ch = 0; ch < 8; ch += 2)
    352  1.55.16.1  christos 			vidcaudio_stereo(ch, SIR_LEFT_100);
    353  1.55.16.1  christos 		for (ch = 1; ch < 8; ch += 2)
    354  1.55.16.1  christos 			vidcaudio_stereo(ch, SIR_RIGHT_100);
    355  1.55.16.1  christos 
    356  1.55.16.1  christos 		pfil->codec = audio_internal_to_mulaw;
    357       1.24     bjh21 	}
    358        1.1   reinoud 	return 0;
    359        1.1   reinoud }
    360        1.1   reinoud 
    361       1.25     bjh21 static int
    362       1.41      kent vidcaudio_round_blocksize(void *addr, int wantblk,
    363       1.41      kent 			  int mode, const audio_params_t *param)
    364        1.1   reinoud {
    365       1.24     bjh21 	int blk;
    366       1.18     bjh21 
    367       1.42      kent 	/*
    368       1.24     bjh21 	 * Find the smallest power of two that's larger than the
    369       1.24     bjh21 	 * requested block size, but don't allow < 32 (DMA burst is 16
    370       1.24     bjh21 	 * bytes, and single bursts are tricky) or > PAGE_SIZE (DMA is
    371       1.24     bjh21 	 * confined to a page).
    372       1.24     bjh21 	 */
    373       1.24     bjh21 
    374       1.24     bjh21 	for (blk = 32; blk < PAGE_SIZE; blk <<= 1)
    375       1.42      kent 		if (blk >= wantblk)
    376       1.42      kent 			return blk;
    377       1.24     bjh21 	return blk;
    378        1.1   reinoud }
    379        1.1   reinoud 
    380       1.25     bjh21 static int
    381       1.24     bjh21 vidcaudio_trigger_output(void *addr, void *start, void *end, int blksize,
    382       1.41      kent     void (*intr)(void *), void *arg, const audio_params_t *params)
    383        1.1   reinoud {
    384       1.42      kent 	struct vidcaudio_softc *sc;
    385       1.30     bjh21 	size_t npages, i;
    386        1.1   reinoud 
    387       1.28     bjh21 	DPRINTF(("vidcaudio_trigger_output %p-%p/0x%x\n",
    388       1.28     bjh21 	    start, end, blksize));
    389        1.1   reinoud 
    390       1.42      kent 	sc = addr;
    391       1.41      kent 	KASSERT(blksize == vidcaudio_round_blocksize(addr, blksize, 0, NULL));
    392       1.30     bjh21 	KASSERT((vaddr_t)start % blksize == 0);
    393       1.30     bjh21 
    394       1.24     bjh21 	sc->sc_pblksize = blksize;
    395       1.30     bjh21 	sc->sc_pbufsize = (char *)end - (char *)start;
    396       1.30     bjh21 	npages = sc->sc_pbufsize >> PGSHIFT;
    397       1.30     bjh21 	if (sc->sc_ppages != NULL)
    398       1.30     bjh21 		free(sc->sc_ppages, M_DEVBUF);
    399       1.30     bjh21 	sc->sc_ppages = malloc(npages * sizeof(paddr_t), M_DEVBUF, M_WAITOK);
    400       1.49     skrll 	if (sc->sc_ppages == NULL)
    401       1.49     skrll 		return ENOMEM;
    402       1.30     bjh21 	for (i = 0; i < npages; i++)
    403       1.30     bjh21 		if (!pmap_extract(pmap_kernel(),
    404       1.30     bjh21 		    (vaddr_t)start + i * PAGE_SIZE, &sc->sc_ppages[i]))
    405       1.30     bjh21 			return EIO;
    406       1.30     bjh21 	sc->sc_poffset = 0;
    407       1.24     bjh21 	sc->sc_pintr = intr;
    408       1.24     bjh21 	sc->sc_parg = arg;
    409        1.1   reinoud 
    410       1.24     bjh21 	IOMD_WRITE_WORD(IOMD_SD0CR, IOMD_DMACR_CLEAR | IOMD_DMACR_QUADWORD);
    411       1.24     bjh21 	IOMD_WRITE_WORD(IOMD_SD0CR, IOMD_DMACR_ENABLE | IOMD_DMACR_QUADWORD);
    412       1.24     bjh21 
    413       1.24     bjh21 	/*
    414       1.24     bjh21 	 * Queue up the first two blocks, but don't tell audio code
    415       1.24     bjh21 	 * we're finished with them yet.
    416       1.24     bjh21 	 */
    417       1.24     bjh21 	sc->sc_pcountdown = 2;
    418       1.24     bjh21 
    419       1.24     bjh21 	enable_irq(sc->sc_dma_intr);
    420        1.1   reinoud 
    421        1.1   reinoud 	return 0;
    422        1.1   reinoud }
    423        1.1   reinoud 
    424       1.25     bjh21 static int
    425       1.17     bjh21 vidcaudio_halt_output(void *addr)
    426        1.1   reinoud {
    427       1.42      kent 	struct vidcaudio_softc *sc;
    428       1.18     bjh21 
    429       1.28     bjh21 	DPRINTF(("vidcaudio_halt_output\n"));
    430       1.42      kent 	sc = addr;
    431       1.30     bjh21 	disable_irq(sc->sc_dma_intr);
    432       1.24     bjh21 	IOMD_WRITE_WORD(IOMD_SD0CR, IOMD_DMACR_CLEAR | IOMD_DMACR_QUADWORD);
    433       1.24     bjh21 	return 0;
    434        1.1   reinoud }
    435        1.1   reinoud 
    436       1.25     bjh21 static int
    437       1.17     bjh21 vidcaudio_getdev(void *addr, struct audio_device *retp)
    438        1.1   reinoud {
    439       1.18     bjh21 
    440        1.1   reinoud 	*retp = vidcaudio_device;
    441        1.1   reinoud 	return 0;
    442        1.1   reinoud }
    443        1.1   reinoud 
    444        1.1   reinoud 
    445       1.25     bjh21 static int
    446       1.17     bjh21 vidcaudio_set_port(void *addr, mixer_ctrl_t *cp)
    447        1.1   reinoud {
    448       1.18     bjh21 
    449        1.1   reinoud 	return EINVAL;
    450        1.1   reinoud }
    451        1.1   reinoud 
    452       1.25     bjh21 static int
    453       1.17     bjh21 vidcaudio_get_port(void *addr, mixer_ctrl_t *cp)
    454        1.1   reinoud {
    455       1.18     bjh21 
    456        1.1   reinoud 	return EINVAL;
    457        1.1   reinoud }
    458        1.1   reinoud 
    459       1.25     bjh21 static int
    460       1.17     bjh21 vidcaudio_query_devinfo(void *addr, mixer_devinfo_t *dip)
    461        1.1   reinoud {
    462       1.18     bjh21 
    463        1.1   reinoud 	return ENXIO;
    464        1.1   reinoud }
    465        1.1   reinoud 
    466       1.25     bjh21 static int
    467       1.17     bjh21 vidcaudio_get_props(void *addr)
    468        1.1   reinoud {
    469       1.18     bjh21 
    470  1.55.16.1  christos 	return AUDIO_PROP_PLAYBACK | AUDIO_PROP_CAPTURE;
    471        1.1   reinoud }
    472       1.25     bjh21 
    473       1.25     bjh21 static void
    474       1.47  jmcneill vidcaudio_get_locks(void *opaque, kmutex_t **intr, kmutex_t **thread)
    475       1.47  jmcneill {
    476       1.47  jmcneill 	struct vidcaudio_softc *sc = opaque;
    477       1.47  jmcneill 
    478       1.47  jmcneill 	*intr = &sc->sc_intr_lock;
    479       1.47  jmcneill 	*thread = &sc->sc_lock;
    480       1.47  jmcneill }
    481       1.47  jmcneill 
    482       1.47  jmcneill static void
    483       1.24     bjh21 vidcaudio_rate(int rate)
    484        1.1   reinoud {
    485       1.18     bjh21 
    486       1.24     bjh21 	WriteWord(vidc_base, VIDC_SFR | rate);
    487        1.1   reinoud }
    488        1.1   reinoud 
    489       1.25     bjh21 static void
    490       1.24     bjh21 vidcaudio_ctrl(int ctrl)
    491        1.1   reinoud {
    492       1.18     bjh21 
    493       1.24     bjh21 	WriteWord(vidc_base, VIDC_SCR | ctrl);
    494        1.1   reinoud }
    495        1.1   reinoud 
    496       1.25     bjh21 static void
    497       1.17     bjh21 vidcaudio_stereo(int channel, int position)
    498        1.1   reinoud {
    499       1.18     bjh21 
    500       1.18     bjh21 	channel = channel << 24 | VIDC_SIR0;
    501        1.1   reinoud 	WriteWord(vidc_base, channel | position);
    502        1.1   reinoud }
    503        1.1   reinoud 
    504       1.25     bjh21 static int
    505       1.24     bjh21 vidcaudio_intr(void *arg)
    506        1.1   reinoud {
    507       1.42      kent 	struct vidcaudio_softc *sc;
    508       1.24     bjh21 	int status;
    509       1.24     bjh21 	paddr_t pnext, pend;
    510        1.1   reinoud 
    511       1.42      kent 	sc = arg;
    512       1.47  jmcneill 	mutex_spin_enter(&sc->sc_intr_lock);
    513       1.47  jmcneill 
    514       1.24     bjh21 	status = IOMD_READ_BYTE(IOMD_SD0ST);
    515       1.28     bjh21 	DPRINTF(("I[%x]", status));
    516       1.47  jmcneill 	if ((status & IOMD_DMAST_INT) == 0) {
    517       1.47  jmcneill 		mutex_spin_exit(&sc->sc_intr_lock);
    518       1.24     bjh21 		return 0;
    519       1.47  jmcneill 	}
    520        1.1   reinoud 
    521       1.30     bjh21 	pnext = sc->sc_ppages[sc->sc_poffset >> PGSHIFT] |
    522       1.30     bjh21 	    (sc->sc_poffset & PGOFSET);
    523       1.24     bjh21 	pend = (pnext + sc->sc_pblksize - 16) & IOMD_DMAEND_OFFSET;
    524        1.1   reinoud 
    525       1.24     bjh21 	switch (status &
    526       1.24     bjh21 	    (IOMD_DMAST_OVERRUN | IOMD_DMAST_INT | IOMD_DMAST_BANKB)) {
    527        1.1   reinoud 
    528       1.24     bjh21 	case (IOMD_DMAST_INT | IOMD_DMAST_BANKA):
    529       1.24     bjh21 	case (IOMD_DMAST_OVERRUN | IOMD_DMAST_INT | IOMD_DMAST_BANKB):
    530       1.28     bjh21 		DPRINTF(("B<0x%08lx,0x%03lx>", pnext, pend));
    531       1.24     bjh21 		IOMD_WRITE_WORD(IOMD_SD0CURB, pnext);
    532       1.24     bjh21 		IOMD_WRITE_WORD(IOMD_SD0ENDB, pend);
    533       1.24     bjh21 		break;
    534        1.1   reinoud 
    535       1.24     bjh21 	case (IOMD_DMAST_INT | IOMD_DMAST_BANKB):
    536       1.24     bjh21 	case (IOMD_DMAST_OVERRUN | IOMD_DMAST_INT | IOMD_DMAST_BANKA):
    537       1.28     bjh21 		DPRINTF(("A<0x%08lx,0x%03lx>", pnext, pend));
    538       1.24     bjh21 		IOMD_WRITE_WORD(IOMD_SD0CURA, pnext);
    539       1.24     bjh21 		IOMD_WRITE_WORD(IOMD_SD0ENDA, pend);
    540       1.24     bjh21 		break;
    541        1.1   reinoud 	}
    542        1.1   reinoud 
    543       1.30     bjh21 	sc->sc_poffset += sc->sc_pblksize;
    544       1.30     bjh21 	if (sc->sc_poffset >= sc->sc_pbufsize)
    545       1.30     bjh21 		sc->sc_poffset = 0;
    546       1.42      kent 
    547       1.24     bjh21 	if (sc->sc_pcountdown > 0)
    548       1.24     bjh21 		sc->sc_pcountdown--;
    549       1.24     bjh21 	else
    550       1.24     bjh21 		(*sc->sc_pintr)(sc->sc_parg);
    551        1.1   reinoud 
    552       1.47  jmcneill 	mutex_spin_exit(&sc->sc_intr_lock);
    553       1.24     bjh21 	return 1;
    554        1.1   reinoud }
    555