Home | History | Annotate | Line # | Download | only in iomd
vidcaudio.c revision 1.28
      1  1.28    bjh21 /*	$NetBSD: vidcaudio.c,v 1.28 2004/01/01 16:35:35 bjh21 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.28    bjh21 __KERNEL_RCSID(0, "$NetBSD: vidcaudio.c,v 1.28 2004/01/01 16:35:35 bjh21 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.1  reinoud #include <sys/proc.h>	/* device calls */
     75   1.1  reinoud #include <sys/systm.h>
     76   1.1  reinoud 
     77   1.1  reinoud #include <uvm/uvm_extern.h>
     78   1.1  reinoud 
     79   1.1  reinoud #include <dev/audio_if.h>
     80  1.24    bjh21 #include <dev/mulaw.h>
     81   1.1  reinoud 
     82   1.4  thorpej #include <machine/intr.h>
     83  1.27    bjh21 #include <machine/machdep.h>
     84   1.3  thorpej #include <arm/arm32/katelib.h>
     85   1.1  reinoud 
     86   1.5    bjh21 #include <arm/iomd/vidcaudiovar.h>
     87   1.1  reinoud #include <arm/iomd/iomdreg.h>
     88   1.1  reinoud #include <arm/iomd/iomdvar.h>
     89   1.1  reinoud #include <arm/iomd/vidc.h>
     90   1.1  reinoud #include <arm/mainbus/mainbus.h>
     91   1.1  reinoud #include <arm/iomd/waveform.h>
     92   1.1  reinoud #include "vidcaudio.h"
     93   1.1  reinoud 
     94   1.1  reinoud extern int *vidc_base;
     95   1.1  reinoud 
     96  1.28    bjh21 #ifdef VIDCAUDIO_DEBUG
     97  1.28    bjh21 #define DPRINTF(x)	printf x
     98  1.28    bjh21 #else
     99  1.28    bjh21 #define DPRINTF(x)
    100  1.28    bjh21 #endif
    101  1.28    bjh21 
    102  1.24    bjh21 struct vidcaudio_softc {
    103  1.24    bjh21 	struct	device sc_dev;
    104   1.1  reinoud 
    105  1.24    bjh21 	irqhandler_t	sc_ih;
    106  1.24    bjh21 	int	sc_dma_intr;
    107   1.1  reinoud 
    108  1.27    bjh21 	int	sc_is16bit;
    109   1.1  reinoud 
    110  1.24    bjh21 	void	*sc_pstart;
    111  1.24    bjh21 	void	*sc_pend;
    112  1.24    bjh21 	size_t	sc_pblksize;
    113  1.24    bjh21 	void	*sc_pnext;
    114  1.24    bjh21 	void	(*sc_pintr)(void *);
    115  1.24    bjh21 	void	*sc_parg;
    116  1.24    bjh21 	int	sc_pcountdown;
    117   1.1  reinoud };
    118   1.1  reinoud 
    119  1.25    bjh21 static int  vidcaudio_probe(struct device *, struct cfdata *, void *);
    120  1.25    bjh21 static void vidcaudio_attach(struct device *, struct device *, void *);
    121  1.25    bjh21 static int  vidcaudio_open(void *, int);
    122  1.25    bjh21 static void vidcaudio_close(void *);
    123  1.25    bjh21 
    124  1.25    bjh21 static int vidcaudio_intr(void *);
    125  1.25    bjh21 static void vidcaudio_rate(int);
    126  1.25    bjh21 static void vidcaudio_ctrl(int);
    127  1.25    bjh21 static void vidcaudio_stereo(int, int);
    128  1.25    bjh21 static void mulaw_to_vidc(void *, u_char *, int);
    129  1.25    bjh21 static void mulaw_to_vidc_stereo(void *, u_char *, int);
    130   1.1  reinoud 
    131  1.12  thorpej CFATTACH_DECL(vidcaudio, sizeof(struct vidcaudio_softc),
    132  1.13  thorpej     vidcaudio_probe, vidcaudio_attach, NULL, NULL);
    133   1.1  reinoud 
    134  1.25    bjh21 static int    vidcaudio_query_encoding(void *, struct audio_encoding *);
    135  1.25    bjh21 static int    vidcaudio_set_params(void *, int, int, struct audio_params *,
    136  1.18    bjh21     struct audio_params *);
    137  1.25    bjh21 static int    vidcaudio_round_blocksize(void *, int);
    138  1.25    bjh21 static int    vidcaudio_trigger_output(void *, void *, void *, int,
    139  1.25    bjh21     void (*)(void *), void *, struct audio_params *);
    140  1.25    bjh21 static int    vidcaudio_trigger_input(void *, void *, void *, int,
    141  1.25    bjh21     void (*)(void *), void *, struct audio_params *);
    142  1.25    bjh21 static int    vidcaudio_halt_output(void *);
    143  1.25    bjh21 static int    vidcaudio_halt_input(void *);
    144  1.25    bjh21 static int    vidcaudio_getdev(void *, struct audio_device *);
    145  1.25    bjh21 static int    vidcaudio_set_port(void *, mixer_ctrl_t *);
    146  1.25    bjh21 static int    vidcaudio_get_port(void *, mixer_ctrl_t *);
    147  1.25    bjh21 static int    vidcaudio_query_devinfo(void *, mixer_devinfo_t *);
    148  1.25    bjh21 static int    vidcaudio_get_props(void *);
    149   1.1  reinoud 
    150  1.25    bjh21 static struct audio_device vidcaudio_device = {
    151  1.24    bjh21 	"ARM VIDC",
    152  1.24    bjh21 	"",
    153   1.1  reinoud 	"vidcaudio"
    154   1.1  reinoud };
    155   1.1  reinoud 
    156  1.25    bjh21 static struct audio_hw_if vidcaudio_hw_if = {
    157   1.1  reinoud 	vidcaudio_open,
    158   1.1  reinoud 	vidcaudio_close,
    159  1.19    bjh21 	NULL,
    160   1.1  reinoud 	vidcaudio_query_encoding,
    161   1.1  reinoud 	vidcaudio_set_params,
    162   1.1  reinoud 	vidcaudio_round_blocksize,
    163  1.19    bjh21 	NULL,
    164  1.19    bjh21 	NULL,
    165  1.19    bjh21 	NULL,
    166  1.24    bjh21 	NULL,
    167  1.24    bjh21 	NULL,
    168   1.1  reinoud 	vidcaudio_halt_output,
    169   1.1  reinoud 	vidcaudio_halt_input,
    170  1.23    bjh21 	NULL,
    171   1.1  reinoud 	vidcaudio_getdev,
    172  1.19    bjh21 	NULL,
    173   1.1  reinoud 	vidcaudio_set_port,
    174   1.1  reinoud 	vidcaudio_get_port,
    175   1.1  reinoud 	vidcaudio_query_devinfo,
    176  1.19    bjh21 	NULL,
    177  1.19    bjh21 	NULL,
    178  1.19    bjh21 	NULL,
    179  1.19    bjh21 	NULL,
    180   1.1  reinoud 	vidcaudio_get_props,
    181  1.24    bjh21 	vidcaudio_trigger_output,
    182  1.24    bjh21 	vidcaudio_trigger_input,
    183  1.19    bjh21 	NULL,
    184   1.1  reinoud };
    185   1.1  reinoud 
    186   1.1  reinoud 
    187   1.1  reinoud void
    188  1.17    bjh21 vidcaudio_beep_generate(void)
    189   1.1  reinoud {
    190  1.18    bjh21 
    191   1.1  reinoud }
    192   1.1  reinoud 
    193   1.1  reinoud 
    194  1.25    bjh21 static int
    195  1.17    bjh21 vidcaudio_probe(struct device *parent, struct cfdata *cf, void *aux)
    196   1.1  reinoud {
    197   1.1  reinoud 	int id;
    198   1.1  reinoud 
    199   1.1  reinoud 	id = IOMD_ID;
    200   1.1  reinoud 
    201   1.1  reinoud 	/* So far I only know about this IOMD */
    202   1.1  reinoud 	switch (id) {
    203   1.1  reinoud 	case RPC600_IOMD_ID:
    204   1.1  reinoud 	case ARM7500_IOC_ID:
    205   1.1  reinoud 	case ARM7500FE_IOC_ID:
    206  1.18    bjh21 		return 1;
    207   1.1  reinoud 	default:
    208  1.24    bjh21 		aprint_error("vidcaudio: Unknown IOMD id=%04x", id);
    209  1.24    bjh21 		return 0;
    210   1.1  reinoud 	}
    211   1.1  reinoud }
    212   1.1  reinoud 
    213   1.1  reinoud 
    214  1.25    bjh21 static void
    215  1.17    bjh21 vidcaudio_attach(struct device *parent, struct device *self, void *aux)
    216   1.1  reinoud {
    217   1.1  reinoud 	struct vidcaudio_softc *sc = (void *)self;
    218   1.1  reinoud 
    219  1.24    bjh21 	switch (IOMD_ID) {
    220   1.1  reinoud 	case RPC600_IOMD_ID:
    221  1.27    bjh21 		sc->sc_is16bit = (cmos_read(0xc4) >> 5) & 1;
    222  1.24    bjh21 		sc->sc_dma_intr = IRQ_DMASCH0;
    223   1.1  reinoud 		break;
    224   1.1  reinoud 	case ARM7500_IOC_ID:
    225   1.1  reinoud 	case ARM7500FE_IOC_ID:
    226  1.27    bjh21 		sc->sc_is16bit = TRUE;
    227  1.24    bjh21 		sc->sc_dma_intr = IRQ_SDMA;
    228   1.1  reinoud 		break;
    229  1.24    bjh21 	default:
    230  1.24    bjh21 		aprint_error(": strange IOMD\n");
    231  1.24    bjh21 		return;
    232   1.1  reinoud 	}
    233   1.1  reinoud 
    234  1.27    bjh21 	if (sc->sc_is16bit)
    235  1.27    bjh21 		aprint_normal(": 16-bit external DAC\n");
    236  1.27    bjh21 	else
    237  1.27    bjh21 		aprint_normal(": 8-bit internal DAC\n");
    238  1.27    bjh21 
    239  1.24    bjh21 	/* Install the irq handler for the DMA interrupt */
    240  1.24    bjh21 	sc->sc_ih.ih_func = vidcaudio_intr;
    241  1.24    bjh21 	sc->sc_ih.ih_arg = sc;
    242  1.24    bjh21 	sc->sc_ih.ih_level = IPL_AUDIO;
    243  1.24    bjh21 	sc->sc_ih.ih_name = self->dv_xname;
    244  1.24    bjh21 
    245  1.24    bjh21 	if (irq_claim(sc->sc_dma_intr, &sc->sc_ih) != 0) {
    246  1.24    bjh21 		aprint_error("%s: couldn't claim IRQ %d\n",
    247  1.24    bjh21 		    self->dv_xname, sc->sc_dma_intr);
    248  1.24    bjh21 		return;
    249  1.24    bjh21 	}
    250   1.1  reinoud 
    251  1.24    bjh21 	disable_irq(sc->sc_dma_intr);
    252   1.1  reinoud 
    253  1.24    bjh21 	audio_attach_mi(&vidcaudio_hw_if, sc, self);
    254   1.1  reinoud }
    255   1.1  reinoud 
    256  1.25    bjh21 static int
    257  1.17    bjh21 vidcaudio_open(void *addr, int flags)
    258   1.1  reinoud {
    259   1.1  reinoud 
    260  1.28    bjh21 	DPRINTF(("DEBUG: vidcaudio_open called\n"));
    261   1.1  reinoud 	return 0;
    262   1.1  reinoud }
    263   1.1  reinoud 
    264  1.25    bjh21 static void
    265  1.17    bjh21 vidcaudio_close(void *addr)
    266   1.1  reinoud {
    267   1.1  reinoud 
    268  1.28    bjh21 	DPRINTF(("DEBUG: vidcaudio_close called\n"));
    269   1.1  reinoud }
    270   1.1  reinoud 
    271  1.18    bjh21 /*
    272  1.18    bjh21  * Interface to the generic audio driver
    273  1.18    bjh21  */
    274   1.1  reinoud 
    275  1.25    bjh21 static int
    276  1.17    bjh21 vidcaudio_query_encoding(void *addr, struct audio_encoding *fp)
    277   1.1  reinoud {
    278  1.24    bjh21 	struct vidcaudio_softc *sc = addr;
    279  1.18    bjh21 
    280   1.1  reinoud 	switch (fp->index) {
    281   1.1  reinoud 	case 0:
    282  1.24    bjh21 		strcpy(fp->name, AudioEmulaw);
    283   1.1  reinoud 		fp->encoding = AUDIO_ENCODING_ULAW;
    284   1.1  reinoud 		fp->precision = 8;
    285  1.27    bjh21 		fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
    286   1.1  reinoud 		break;
    287   1.1  reinoud 
    288  1.24    bjh21 	case 1:
    289  1.27    bjh21 		if (sc->sc_is16bit) {
    290  1.24    bjh21 			strcpy(fp->name, AudioEslinear_le);
    291  1.24    bjh21 			fp->encoding = AUDIO_ENCODING_SLINEAR_LE;
    292  1.24    bjh21 			fp->precision = 16;
    293  1.24    bjh21 			fp->flags = 0;
    294  1.24    bjh21 			break;
    295  1.24    bjh21 		}
    296  1.24    bjh21 		/* FALLTHROUGH */
    297   1.1  reinoud 	default:
    298  1.18    bjh21 		return EINVAL;
    299   1.1  reinoud 	}
    300   1.1  reinoud 	return 0;
    301   1.1  reinoud }
    302   1.1  reinoud 
    303  1.24    bjh21 #define MULAW_TO_VIDC(m) (~(m) << 1 | (m) >> 7)
    304  1.24    bjh21 
    305  1.25    bjh21 static void
    306  1.24    bjh21 mulaw_to_vidc(void *v, u_char *p, int cc)
    307  1.24    bjh21 {
    308  1.24    bjh21 
    309  1.24    bjh21 	while (--cc >= 0) {
    310  1.24    bjh21 		*p = MULAW_TO_VIDC(*p);
    311  1.24    bjh21 		++p;
    312  1.24    bjh21 	}
    313  1.24    bjh21 }
    314  1.24    bjh21 
    315  1.25    bjh21 static void
    316  1.24    bjh21 mulaw_to_vidc_stereo(void *v, u_char *p, int cc)
    317  1.24    bjh21 {
    318  1.24    bjh21 	u_char *q = p;
    319  1.24    bjh21 
    320  1.24    bjh21 	p += cc;
    321  1.24    bjh21 	q += cc * 2;
    322  1.24    bjh21 	while (--cc >= 0) {
    323  1.24    bjh21 		q -= 2;
    324  1.24    bjh21 		--p;
    325  1.24    bjh21 		q[0] = q[1] = MULAW_TO_VIDC(*p);
    326  1.24    bjh21 	}
    327  1.24    bjh21 }
    328  1.24    bjh21 
    329  1.25    bjh21 static int
    330  1.17    bjh21 vidcaudio_set_params(void *addr, int setmode, int usemode,
    331  1.17    bjh21     struct audio_params *p, struct audio_params *r)
    332   1.1  reinoud {
    333  1.24    bjh21 	struct vidcaudio_softc *sc = addr;
    334  1.24    bjh21 	int sample_period, ch;
    335  1.18    bjh21 
    336  1.24    bjh21 	if (setmode & AUMODE_PLAY) {
    337  1.27    bjh21 		if (sc->sc_is16bit) {
    338  1.27    bjh21 			/* ARM7500ish, 16-bit, two-channel */
    339  1.27    bjh21 			if (p->encoding == AUDIO_ENCODING_ULAW &&
    340  1.27    bjh21 			    p->precision == 8) {
    341  1.27    bjh21 				p->sw_code = mulaw_to_slinear16_le;
    342  1.27    bjh21 				p->factor = 2; p->factor_denom = 1;
    343  1.27    bjh21 			} else if (p->encoding != AUDIO_ENCODING_SLINEAR_LE ||
    344  1.27    bjh21 			    p->precision != 16)
    345  1.27    bjh21 				return EINVAL;
    346  1.27    bjh21 			p->hw_channels = 2;
    347  1.27    bjh21 			sample_period = 705600 / 4 / p->sample_rate;
    348  1.27    bjh21 			if (sample_period < 3) sample_period = 3;
    349  1.27    bjh21 			p->hw_sample_rate =
    350  1.27    bjh21 			    705600 / 4 / sample_period;
    351  1.27    bjh21 			vidcaudio_rate(sample_period - 2);
    352  1.27    bjh21 			p->hw_encoding = AUDIO_ENCODING_SLINEAR_LE;
    353  1.27    bjh21 			p->hw_precision = 16;
    354  1.27    bjh21 		} else {
    355  1.24    bjh21 			/* VIDC20ish, u-law, 8-channel */
    356  1.24    bjh21 			if (p->encoding != AUDIO_ENCODING_ULAW ||
    357  1.24    bjh21 			    p->precision != 8)
    358  1.24    bjh21 				return EINVAL;
    359  1.24    bjh21 			/*
    360  1.24    bjh21 			 * We always use two hardware channels,
    361  1.24    bjh21 			 * because using one at 8kHz gives a nasty
    362  1.24    bjh21 			 * whining sound from the speaker.  The
    363  1.24    bjh21 			 * aurateconv mechanism doesn't support ulaw,
    364  1.24    bjh21 			 * so we do the channel duplication ourselves,
    365  1.24    bjh21 			 * and don't try to do rate conversion.
    366  1.24    bjh21 			 */
    367  1.24    bjh21 			switch (p->channels) {
    368  1.24    bjh21 			case 1:
    369  1.24    bjh21 				p->sw_code = mulaw_to_vidc_stereo;
    370  1.24    bjh21 				p->factor = 2; p->factor_denom = 1;
    371  1.24    bjh21 				break;
    372  1.24    bjh21 			case 2:
    373  1.24    bjh21 				p->sw_code = mulaw_to_vidc;
    374  1.24    bjh21 				p->factor = 1; p->factor_denom = 1;
    375  1.24    bjh21 				break;
    376  1.24    bjh21 			default:
    377  1.24    bjh21 				return EINVAL;
    378  1.24    bjh21 			}
    379  1.24    bjh21 			p->hw_channels = p->channels;
    380  1.24    bjh21 			sample_period =
    381  1.24    bjh21 			    1000000 / 2 / p->sample_rate;
    382  1.24    bjh21 			if (sample_period < 3) sample_period = 3;
    383  1.24    bjh21 			p->hw_sample_rate = p->sample_rate =
    384  1.24    bjh21 			    1000000 / 2 / sample_period;
    385  1.24    bjh21 			p->hw_encoding = AUDIO_ENCODING_NONE;
    386  1.24    bjh21 			p->hw_precision = 8;
    387  1.24    bjh21 			vidcaudio_rate(sample_period - 2);
    388  1.24    bjh21 			vidcaudio_ctrl(SCR_SDAC | SCR_CLKSEL);
    389  1.24    bjh21 			if (p->hw_channels == 1)
    390  1.24    bjh21 				for (ch = 0; ch < 8; ch++)
    391  1.24    bjh21 					vidcaudio_stereo(ch, SIR_CENTRE);
    392  1.24    bjh21 			else
    393  1.24    bjh21 				for (ch = 0; ch < 8; ch++)
    394  1.24    bjh21 					vidcaudio_stereo(ch, ch & 1 ?
    395  1.24    bjh21 					    SIR_LEFT_100 : SIR_RIGHT_100);
    396  1.24    bjh21 		}
    397  1.24    bjh21 	}
    398   1.1  reinoud 	return 0;
    399   1.1  reinoud }
    400   1.1  reinoud 
    401  1.25    bjh21 static int
    402  1.24    bjh21 vidcaudio_round_blocksize(void *addr, int wantblk)
    403   1.1  reinoud {
    404  1.24    bjh21 	int blk;
    405  1.18    bjh21 
    406  1.24    bjh21 	/*
    407  1.24    bjh21 	 * Find the smallest power of two that's larger than the
    408  1.24    bjh21 	 * requested block size, but don't allow < 32 (DMA burst is 16
    409  1.24    bjh21 	 * bytes, and single bursts are tricky) or > PAGE_SIZE (DMA is
    410  1.24    bjh21 	 * confined to a page).
    411  1.24    bjh21 	 */
    412  1.24    bjh21 
    413  1.24    bjh21 	for (blk = 32; blk < PAGE_SIZE; blk <<= 1)
    414  1.24    bjh21 		if (blk >= wantblk) return blk;
    415  1.24    bjh21 	return blk;
    416   1.1  reinoud }
    417   1.1  reinoud 
    418  1.25    bjh21 static int
    419  1.24    bjh21 vidcaudio_trigger_output(void *addr, void *start, void *end, int blksize,
    420  1.24    bjh21     void (*intr)(void *), void *arg, struct audio_params *params)
    421   1.1  reinoud {
    422  1.24    bjh21 	struct vidcaudio_softc *sc = addr;
    423  1.18    bjh21 
    424  1.24    bjh21 	KASSERT(blksize == vidcaudio_round_blocksize(addr, blksize));
    425   1.1  reinoud 
    426  1.28    bjh21 	DPRINTF(("vidcaudio_trigger_output %p-%p/0x%x\n",
    427  1.28    bjh21 	    start, end, blksize));
    428   1.1  reinoud 
    429  1.24    bjh21 	sc->sc_pstart = start;
    430  1.24    bjh21 	sc->sc_pend = end;
    431  1.24    bjh21 	sc->sc_pblksize = blksize;
    432  1.24    bjh21 	sc->sc_pnext = start;
    433  1.24    bjh21 	sc->sc_pintr = intr;
    434  1.24    bjh21 	sc->sc_parg = arg;
    435   1.1  reinoud 
    436  1.24    bjh21 	IOMD_WRITE_WORD(IOMD_SD0CR, IOMD_DMACR_CLEAR | IOMD_DMACR_QUADWORD);
    437  1.24    bjh21 	IOMD_WRITE_WORD(IOMD_SD0CR, IOMD_DMACR_ENABLE | IOMD_DMACR_QUADWORD);
    438  1.24    bjh21 
    439  1.24    bjh21 	/*
    440  1.24    bjh21 	 * Queue up the first two blocks, but don't tell audio code
    441  1.24    bjh21 	 * we're finished with them yet.
    442  1.24    bjh21 	 */
    443  1.24    bjh21 	sc->sc_pcountdown = 2;
    444  1.24    bjh21 
    445  1.24    bjh21 	enable_irq(sc->sc_dma_intr);
    446   1.1  reinoud 
    447   1.1  reinoud 	return 0;
    448   1.1  reinoud }
    449   1.1  reinoud 
    450  1.25    bjh21 static int
    451  1.24    bjh21 vidcaudio_trigger_input(void *addr, void *start, void *end, int blksize,
    452  1.24    bjh21     void (*intr)(void *), void *arg, struct audio_params *params)
    453   1.1  reinoud {
    454  1.24    bjh21 
    455  1.24    bjh21 	return ENODEV;
    456   1.1  reinoud }
    457   1.1  reinoud 
    458  1.25    bjh21 static int
    459  1.17    bjh21 vidcaudio_halt_output(void *addr)
    460   1.1  reinoud {
    461  1.24    bjh21 	struct vidcaudio_softc *sc = addr;
    462  1.18    bjh21 
    463  1.28    bjh21 	DPRINTF(("vidcaudio_halt_output\n"));
    464  1.24    bjh21 	IOMD_WRITE_WORD(IOMD_SD0CR, IOMD_DMACR_CLEAR | IOMD_DMACR_QUADWORD);
    465  1.24    bjh21 	disable_irq(sc->sc_dma_intr);
    466  1.24    bjh21 	return 0;
    467   1.1  reinoud }
    468   1.1  reinoud 
    469  1.25    bjh21 static int
    470  1.17    bjh21 vidcaudio_halt_input(void *addr)
    471   1.1  reinoud {
    472  1.18    bjh21 
    473  1.24    bjh21 	return ENODEV;
    474   1.1  reinoud }
    475   1.1  reinoud 
    476  1.25    bjh21 static int
    477  1.17    bjh21 vidcaudio_getdev(void *addr, struct audio_device *retp)
    478   1.1  reinoud {
    479  1.18    bjh21 
    480   1.1  reinoud 	*retp = vidcaudio_device;
    481   1.1  reinoud 	return 0;
    482   1.1  reinoud }
    483   1.1  reinoud 
    484   1.1  reinoud 
    485  1.25    bjh21 static int
    486  1.17    bjh21 vidcaudio_set_port(void *addr, mixer_ctrl_t *cp)
    487   1.1  reinoud {
    488  1.18    bjh21 
    489   1.1  reinoud 	return EINVAL;
    490   1.1  reinoud }
    491   1.1  reinoud 
    492  1.25    bjh21 static int
    493  1.17    bjh21 vidcaudio_get_port(void *addr, mixer_ctrl_t *cp)
    494   1.1  reinoud {
    495  1.18    bjh21 
    496   1.1  reinoud 	return EINVAL;
    497   1.1  reinoud }
    498   1.1  reinoud 
    499  1.25    bjh21 static int
    500  1.17    bjh21 vidcaudio_query_devinfo(void *addr, mixer_devinfo_t *dip)
    501   1.1  reinoud {
    502  1.18    bjh21 
    503   1.1  reinoud 	return ENXIO;
    504   1.1  reinoud }
    505   1.1  reinoud 
    506  1.25    bjh21 static int
    507  1.17    bjh21 vidcaudio_get_props(void *addr)
    508   1.1  reinoud {
    509  1.18    bjh21 
    510   1.1  reinoud 	return 0;
    511   1.1  reinoud }
    512  1.25    bjh21 
    513  1.25    bjh21 static void
    514  1.24    bjh21 vidcaudio_rate(int rate)
    515   1.1  reinoud {
    516  1.18    bjh21 
    517  1.24    bjh21 	WriteWord(vidc_base, VIDC_SFR | rate);
    518   1.1  reinoud }
    519   1.1  reinoud 
    520  1.25    bjh21 static void
    521  1.24    bjh21 vidcaudio_ctrl(int ctrl)
    522   1.1  reinoud {
    523  1.18    bjh21 
    524  1.24    bjh21 	WriteWord(vidc_base, VIDC_SCR | ctrl);
    525   1.1  reinoud }
    526   1.1  reinoud 
    527  1.25    bjh21 static void
    528  1.17    bjh21 vidcaudio_stereo(int channel, int position)
    529   1.1  reinoud {
    530  1.18    bjh21 
    531  1.18    bjh21 	channel = channel << 24 | VIDC_SIR0;
    532   1.1  reinoud 	WriteWord(vidc_base, channel | position);
    533   1.1  reinoud }
    534   1.1  reinoud 
    535  1.25    bjh21 static int
    536  1.24    bjh21 vidcaudio_intr(void *arg)
    537   1.1  reinoud {
    538  1.24    bjh21 	struct vidcaudio_softc *sc = arg;
    539  1.24    bjh21 	int status;
    540  1.24    bjh21 	paddr_t pnext, pend;
    541   1.1  reinoud 
    542  1.24    bjh21 	status = IOMD_READ_BYTE(IOMD_SD0ST);
    543  1.28    bjh21 	DPRINTF(("I[%x]", status));
    544  1.24    bjh21 	if ((status & IOMD_DMAST_INT) == 0)
    545  1.24    bjh21 		return 0;
    546   1.1  reinoud 
    547  1.24    bjh21 	/* FIXME: Not really allowed to use pmap here. */
    548  1.24    bjh21 	pmap_extract(pmap_kernel(), (vaddr_t)sc->sc_pnext, &pnext);
    549  1.24    bjh21 	pend = (pnext + sc->sc_pblksize - 16) & IOMD_DMAEND_OFFSET;
    550   1.1  reinoud 
    551  1.24    bjh21 	switch (status &
    552  1.24    bjh21 	    (IOMD_DMAST_OVERRUN | IOMD_DMAST_INT | IOMD_DMAST_BANKB)) {
    553   1.1  reinoud 
    554  1.24    bjh21 	case (IOMD_DMAST_INT | IOMD_DMAST_BANKA):
    555  1.24    bjh21 	case (IOMD_DMAST_OVERRUN | IOMD_DMAST_INT | IOMD_DMAST_BANKB):
    556  1.28    bjh21 		DPRINTF(("B<0x%08lx,0x%03lx>", pnext, pend));
    557  1.24    bjh21 		IOMD_WRITE_WORD(IOMD_SD0CURB, pnext);
    558  1.24    bjh21 		IOMD_WRITE_WORD(IOMD_SD0ENDB, pend);
    559  1.24    bjh21 		break;
    560   1.1  reinoud 
    561  1.24    bjh21 	case (IOMD_DMAST_INT | IOMD_DMAST_BANKB):
    562  1.24    bjh21 	case (IOMD_DMAST_OVERRUN | IOMD_DMAST_INT | IOMD_DMAST_BANKA):
    563  1.28    bjh21 		DPRINTF(("A<0x%08lx,0x%03lx>", pnext, pend));
    564  1.24    bjh21 		IOMD_WRITE_WORD(IOMD_SD0CURA, pnext);
    565  1.24    bjh21 		IOMD_WRITE_WORD(IOMD_SD0ENDA, pend);
    566  1.24    bjh21 		break;
    567   1.1  reinoud 	}
    568   1.1  reinoud 
    569  1.24    bjh21 	sc->sc_pnext = (char *)sc->sc_pnext + sc->sc_pblksize;
    570  1.24    bjh21 	if (sc->sc_pnext >= sc->sc_pend)
    571  1.24    bjh21 		sc->sc_pnext = sc->sc_pstart;
    572  1.24    bjh21 
    573  1.24    bjh21 	if (sc->sc_pcountdown > 0)
    574  1.24    bjh21 		sc->sc_pcountdown--;
    575  1.24    bjh21 	else
    576  1.24    bjh21 		(*sc->sc_pintr)(sc->sc_parg);
    577   1.1  reinoud 
    578  1.24    bjh21 	return 1;
    579   1.1  reinoud }
    580