Home | History | Annotate | Line # | Download | only in dev
ucbsnd.c revision 1.9
      1  1.9  gehenna /*	$NetBSD: ucbsnd.c,v 1.9 2002/09/06 13:18:43 gehenna Exp $ */
      2  1.1      uch 
      3  1.6      uch /*-
      4  1.6      uch  * Copyright (c) 2000 The NetBSD Foundation, Inc.
      5  1.1      uch  * All rights reserved.
      6  1.1      uch  *
      7  1.6      uch  * This code is derived from software contributed to The NetBSD Foundation
      8  1.6      uch  * by UCHIYAMA Yasushi.
      9  1.6      uch  *
     10  1.1      uch  * Redistribution and use in source and binary forms, with or without
     11  1.1      uch  * modification, are permitted provided that the following conditions
     12  1.1      uch  * are met:
     13  1.1      uch  * 1. Redistributions of source code must retain the above copyright
     14  1.1      uch  *    notice, this list of conditions and the following disclaimer.
     15  1.6      uch  * 2. Redistributions in binary form must reproduce the above copyright
     16  1.6      uch  *    notice, this list of conditions and the following disclaimer in the
     17  1.6      uch  *    documentation and/or other materials provided with the distribution.
     18  1.6      uch  * 3. All advertising materials mentioning features or use of this software
     19  1.6      uch  *    must display the following acknowledgement:
     20  1.6      uch  *        This product includes software developed by the NetBSD
     21  1.6      uch  *        Foundation, Inc. and its contributors.
     22  1.6      uch  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23  1.6      uch  *    contributors may be used to endorse or promote products derived
     24  1.6      uch  *    from this software without specific prior written permission.
     25  1.1      uch  *
     26  1.6      uch  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27  1.6      uch  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28  1.6      uch  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29  1.6      uch  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30  1.6      uch  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31  1.6      uch  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32  1.6      uch  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33  1.6      uch  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34  1.6      uch  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35  1.6      uch  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36  1.6      uch  * POSSIBILITY OF SUCH DAMAGE.
     37  1.1      uch  */
     38  1.1      uch 
     39  1.1      uch /*
     40  1.1      uch  * Device driver for PHILIPS UCB1200 Advanced modem/audio analog front-end
     41  1.1      uch  *	Audio codec part.
     42  1.3      uch  *
     43  1.3      uch  * /dev/ucbsnd0 : sampling rate 22.154kHz monoral 16bit straight PCM device.
     44  1.1      uch  */
     45  1.1      uch 
     46  1.1      uch #include "opt_use_poll.h"
     47  1.1      uch 
     48  1.1      uch #include <sys/param.h>
     49  1.1      uch #include <sys/systm.h>
     50  1.3      uch #include <sys/conf.h>
     51  1.3      uch #include <sys/malloc.h>
     52  1.1      uch #include <sys/device.h>
     53  1.3      uch #include <sys/proc.h>
     54  1.3      uch #include <sys/endian.h>
     55  1.1      uch 
     56  1.7  thorpej #include <mips/cache.h>
     57  1.7  thorpej 
     58  1.1      uch #include <machine/bus.h>
     59  1.1      uch #include <machine/intr.h>
     60  1.1      uch 
     61  1.1      uch #include <hpcmips/tx/tx39var.h>
     62  1.1      uch #include <hpcmips/tx/tx39sibvar.h>
     63  1.1      uch #include <hpcmips/tx/tx39sibreg.h>
     64  1.1      uch #include <hpcmips/tx/tx39icureg.h>
     65  1.1      uch #include <hpcmips/tx/txsnd.h>
     66  1.1      uch 
     67  1.1      uch #include <hpcmips/dev/ucb1200var.h>
     68  1.1      uch #include <hpcmips/dev/ucb1200reg.h>
     69  1.1      uch 
     70  1.3      uch #define AUDIOUNIT(x)		(minor(x)&0x0f)
     71  1.3      uch #define AUDIODEV(x)		(minor(x)&0xf0)
     72  1.4      uch #define	splaudio	splbio	/* XXX */
     73  1.3      uch 
     74  1.1      uch #ifdef UCBSNDDEBUG
     75  1.1      uch int	ucbsnd_debug = 1;
     76  1.1      uch #define	DPRINTF(arg) if (ucbsnd_debug) printf arg;
     77  1.1      uch #define	DPRINTFN(n, arg) if (ucbsnd_debug > (n)) printf arg;
     78  1.1      uch #else
     79  1.1      uch #define	DPRINTF(arg)
     80  1.1      uch #define DPRINTFN(n, arg)
     81  1.1      uch #endif
     82  1.1      uch 
     83  1.3      uch #define UCBSND_BUFBLOCK		5
     84  1.3      uch /*
     85  1.3      uch  * XXX temporary DMA buffer
     86  1.3      uch  */
     87  1.3      uch static u_int8_t dmabuf_static[TX39_SIBDMA_SIZE * UCBSND_BUFBLOCK] __attribute__((__aligned__(16))); /* XXX */
     88  1.3      uch static size_t	dmabufcnt_static[UCBSND_BUFBLOCK]; /* XXX */
     89  1.3      uch 
     90  1.1      uch enum ucbsnd_state {
     91  1.1      uch /* 0 */	UCBSND_IDLE,
     92  1.1      uch /* 1 */	UCBSND_INIT,
     93  1.1      uch /* 2 */ UCBSND_ENABLE_SAMPLERATE,
     94  1.1      uch /* 3 */ UCBSND_ENABLE_OUTPUTPATH,
     95  1.3      uch /* 4 */ UCBSND_ENABLE_SETVOLUME,
     96  1.1      uch /* 5 */ UCBSND_ENABLE_SPEAKER0,
     97  1.1      uch /* 6 */ UCBSND_ENABLE_SPEAKER1,
     98  1.1      uch /* 7 */ UCBSND_TRANSITION_PIO,
     99  1.1      uch /* 8 */ UCBSND_PIO,
    100  1.1      uch /* 9 */ UCBSND_TRANSITION_DISABLE,
    101  1.1      uch /*10 */ UCBSND_DISABLE_OUTPUTPATH,
    102  1.1      uch /*11 */ UCBSND_DISABLE_SPEAKER0,
    103  1.1      uch /*12 */ UCBSND_DISABLE_SPEAKER1,
    104  1.3      uch /*13 */	UCBSND_DISABLE_SIB,
    105  1.3      uch /*14 */ UCBSND_DMASTART,
    106  1.3      uch /*15 */ UCBSND_DMAEND,
    107  1.3      uch };
    108  1.3      uch 
    109  1.3      uch struct ring_buf {
    110  1.3      uch 	u_int32_t rb_buf;	/* buffer start address */
    111  1.3      uch 	size_t	*rb_bufcnt;	/* effective data count (max rb_blksize)*/
    112  1.3      uch 
    113  1.3      uch 	size_t	rb_bufsize;	/* total amount of buffer */
    114  1.3      uch 	int	rb_blksize;	/* DMA block size */
    115  1.3      uch 	int	rb_maxblks;	/* # of blocks in ring */
    116  1.3      uch 
    117  1.3      uch 	int	rb_inp;		/* start of input (to buffer) */
    118  1.3      uch 	int	rb_outp;	/* output pointer */
    119  1.1      uch };
    120  1.1      uch 
    121  1.1      uch struct ucbsnd_softc {
    122  1.1      uch 	struct device		sc_dev;
    123  1.1      uch 	struct device		*sc_sib; /* parent (TX39 SIB module) */
    124  1.1      uch 	struct device		*sc_ucb; /* parent (UCB1200 module) */
    125  1.1      uch 	tx_chipset_tag_t	sc_tc;
    126  1.1      uch 
    127  1.3      uch 	struct	tx_sound_tag	sc_tag;
    128  1.3      uch 	int			sc_mute;
    129  1.1      uch 
    130  1.1      uch 	/*
    131  1.1      uch 	 *  audio codec state machine
    132  1.1      uch 	 */
    133  1.3      uch 	int		sa_transfer_mode;
    134  1.3      uch #define UCBSND_TRANSFERMODE_DMA		0
    135  1.3      uch #define UCBSND_TRANSFERMODE_PIO		1
    136  1.1      uch 	enum ucbsnd_state sa_state;
    137  1.3      uch 	int		sa_snd_attenuation;
    138  1.3      uch #define UCBSND_DEFAULT_ATTENUATION	0	/* Full volume */
    139  1.1      uch 	int		sa_snd_rate; /* passed down from SIB module */
    140  1.1      uch 	int		sa_tel_rate;
    141  1.1      uch 	void*		sa_sf0ih;
    142  1.1      uch 	void*		sa_sndih;
    143  1.1      uch 	int		sa_retry;
    144  1.1      uch 	int		sa_cnt; /* misc counter */
    145  1.3      uch 
    146  1.3      uch 	/*
    147  1.3      uch 	 *  input buffer
    148  1.3      uch 	 */
    149  1.3      uch 	size_t		sa_dmacnt;
    150  1.3      uch 	struct ring_buf sc_rb;
    151  1.1      uch };
    152  1.1      uch 
    153  1.6      uch int	ucbsnd_match(struct device*, struct cfdata*, void*);
    154  1.6      uch void	ucbsnd_attach(struct device*, struct device*, void*);
    155  1.1      uch 
    156  1.6      uch int	ucbsnd_exec_output(void*);
    157  1.6      uch int	ucbsnd_busy(void*);
    158  1.1      uch 
    159  1.6      uch void	ucbsnd_sound_init(struct ucbsnd_softc*);
    160  1.6      uch void	__ucbsnd_sound_click(tx_sound_tag_t);
    161  1.6      uch void	__ucbsnd_sound_mute(tx_sound_tag_t, int);
    162  1.6      uch 
    163  1.6      uch int	ucbsndwrite_subr(struct ucbsnd_softc *, u_int32_t *, size_t,
    164  1.6      uch 	    struct uio *);
    165  1.6      uch 
    166  1.6      uch int	ringbuf_allocate(struct ring_buf*, size_t, int);
    167  1.6      uch void	ringbuf_deallocate(struct ring_buf*);
    168  1.6      uch void	ringbuf_reset(struct ring_buf*);
    169  1.6      uch int	ringbuf_full(struct ring_buf*);
    170  1.6      uch void	*ringbuf_producer_get(struct ring_buf*);
    171  1.6      uch void	ringbuf_producer_return(struct ring_buf*, size_t);
    172  1.6      uch void	*ringbuf_consumer_get(struct ring_buf*, size_t*);
    173  1.6      uch void	ringbuf_consumer_return(struct ring_buf*);
    174  1.3      uch 
    175  1.1      uch struct cfattach ucbsnd_ca = {
    176  1.1      uch 	sizeof(struct ucbsnd_softc), ucbsnd_match, ucbsnd_attach
    177  1.9  gehenna };
    178  1.9  gehenna 
    179  1.9  gehenna dev_type_open(ucbsndopen);
    180  1.9  gehenna dev_type_close(ucbsndclose);
    181  1.9  gehenna dev_type_read(ucbsndread);
    182  1.9  gehenna dev_type_write(ucbsndwrite);
    183  1.9  gehenna dev_type_ioctl(ucbsndioctl);
    184  1.9  gehenna dev_type_poll(ucbsndpoll);
    185  1.9  gehenna dev_type_mmap(ucbsndmmap);
    186  1.9  gehenna 
    187  1.9  gehenna const struct cdevsw ucbsnd_cdevsw = {
    188  1.9  gehenna 	ucbsndopen, ucbsndclose, ucbsndread, ucbsndwrite, ucbsndioctl,
    189  1.9  gehenna 	nostop, notty, ucbsndpoll, ucbsndmmap,
    190  1.1      uch };
    191  1.1      uch 
    192  1.1      uch int
    193  1.6      uch ucbsnd_match(struct device *parent, struct cfdata *cf, void *aux)
    194  1.1      uch {
    195  1.6      uch 
    196  1.6      uch 	return (1);
    197  1.1      uch }
    198  1.1      uch 
    199  1.1      uch void
    200  1.6      uch ucbsnd_attach(struct device *parent, struct device *self, void *aux)
    201  1.1      uch {
    202  1.1      uch 	struct ucb1200_attach_args *ucba = aux;
    203  1.1      uch 	struct ucbsnd_softc *sc = (void*)self;
    204  1.1      uch 	tx_chipset_tag_t tc;
    205  1.1      uch 
    206  1.1      uch 	tc = sc->sc_tc = ucba->ucba_tc;
    207  1.1      uch 	sc->sc_sib = ucba->ucba_sib;
    208  1.1      uch 	sc->sc_ucb = ucba->ucba_ucb;
    209  1.2      uch 
    210  1.2      uch 	/* register sound functions */
    211  1.1      uch 	ucbsnd_sound_init(sc);
    212  1.2      uch 
    213  1.1      uch 	sc->sa_snd_rate = ucba->ucba_snd_rate;
    214  1.1      uch 	sc->sa_tel_rate = ucba->ucba_tel_rate;
    215  1.1      uch 
    216  1.3      uch 	sc->sa_snd_attenuation = UCBSND_DEFAULT_ATTENUATION;
    217  1.1      uch #define KHZ(a) ((a) / 1000), (((a) % 1000))
    218  1.1      uch 	printf(": audio %d.%03d kHz telecom %d.%03d kHz",
    219  1.6      uch 	    KHZ((tx39sib_clock(sc->sc_sib) * 2) /
    220  1.6      uch 		(sc->sa_snd_rate * 64)),
    221  1.6      uch 	    KHZ((tx39sib_clock(sc->sc_sib) * 2) /
    222  1.6      uch 		(sc->sa_tel_rate * 64)));
    223  1.1      uch 
    224  1.1      uch 	ucb1200_state_install(parent, ucbsnd_busy, self,
    225  1.6      uch 	    UCB1200_SND_MODULE);
    226  1.1      uch 
    227  1.3      uch 	ringbuf_allocate(&sc->sc_rb, TX39_SIBDMA_SIZE, UCBSND_BUFBLOCK);
    228  1.3      uch 
    229  1.1      uch 	printf("\n");
    230  1.1      uch }
    231  1.1      uch 
    232  1.1      uch int
    233  1.6      uch ucbsnd_busy(void *arg)
    234  1.1      uch {
    235  1.1      uch 	struct ucbsnd_softc *sc = arg;
    236  1.1      uch 
    237  1.6      uch 	return (sc->sa_state != UCBSND_IDLE);
    238  1.1      uch }
    239  1.1      uch 
    240  1.1      uch int
    241  1.6      uch ucbsnd_exec_output(void *arg)
    242  1.1      uch {
    243  1.1      uch 	struct ucbsnd_softc *sc = arg;
    244  1.1      uch 	tx_chipset_tag_t tc = sc->sc_tc;
    245  1.1      uch 	txreg_t reg;
    246  1.3      uch 	u_int32_t *buf;
    247  1.3      uch 	size_t bufcnt;
    248  1.1      uch 
    249  1.1      uch 	switch (sc->sa_state) {
    250  1.1      uch 	default:
    251  1.1      uch 		panic("ucbsnd_exec_output: invalid state %d", sc->sa_state);
    252  1.1      uch 		/* NOTREACHED */
    253  1.1      uch 		break;
    254  1.1      uch 
    255  1.1      uch 	case UCBSND_IDLE:
    256  1.1      uch 		/* nothing to do */
    257  1.6      uch 		return (0);
    258  1.1      uch 
    259  1.1      uch 	case UCBSND_INIT:
    260  1.1      uch 		sc->sa_sf0ih = tx_intr_establish(
    261  1.1      uch 			tc, MAKEINTR(1, TX39_INTRSTATUS1_SIBSF0INT),
    262  1.1      uch 			IST_EDGE, IPL_TTY, ucbsnd_exec_output, sc);
    263  1.1      uch 
    264  1.1      uch 		sc->sa_state = UCBSND_ENABLE_SAMPLERATE;
    265  1.6      uch 		return (0);
    266  1.1      uch 
    267  1.1      uch 	case UCBSND_ENABLE_SAMPLERATE:
    268  1.1      uch 		/* Enable UCB1200 side sample rate */
    269  1.1      uch 		reg = TX39_SIBSF0_WRITE;
    270  1.1      uch 		reg = TX39_SIBSF0_REGADDR_SET(reg, UCB1200_AUDIOCTRLA_REG);
    271  1.1      uch 		reg = TX39_SIBSF0_REGDATA_SET(reg, sc->sa_snd_rate);
    272  1.1      uch 		tx_conf_write(tc, TX39_SIBSF0CTRL_REG, reg);
    273  1.3      uch 
    274  1.1      uch 		sc->sa_state = UCBSND_ENABLE_OUTPUTPATH;
    275  1.6      uch 		return (0);
    276  1.3      uch 
    277  1.1      uch 	case UCBSND_ENABLE_OUTPUTPATH:
    278  1.1      uch 		/* Enable UCB1200 side */
    279  1.1      uch 		reg = TX39_SIBSF0_WRITE;
    280  1.1      uch 		reg = TX39_SIBSF0_REGADDR_SET(reg, UCB1200_AUDIOCTRLB_REG);
    281  1.3      uch 		reg = TX39_SIBSF0_REGDATA_SET(reg, sc->sa_snd_attenuation |
    282  1.6      uch 		    UCB1200_AUDIOCTRLB_OUTEN);
    283  1.1      uch 		tx_conf_write(tc, TX39_SIBSF0CTRL_REG, reg);
    284  1.1      uch 
    285  1.1      uch 		/* Enable SIB side */
    286  1.1      uch 		reg = tx_conf_read(tc, TX39_SIBCTRL_REG);
    287  1.1      uch 		tx_conf_write(tc, TX39_SIBCTRL_REG,
    288  1.6      uch 		    reg | TX39_SIBCTRL_ENSND);
    289  1.1      uch 
    290  1.1      uch 		sc->sa_state = UCBSND_ENABLE_SPEAKER0;
    291  1.1      uch 		sc->sa_retry = 10;
    292  1.6      uch 		return (0);
    293  1.1      uch 	case UCBSND_ENABLE_SPEAKER0:
    294  1.1      uch 		/* Speaker on */
    295  1.1      uch 
    296  1.1      uch 		reg = TX39_SIBSF0_REGADDR_SET(0, UCB1200_IO_DATA_REG);
    297  1.1      uch 		tx_conf_write(tc, TX39_SIBSF0CTRL_REG, reg);
    298  1.1      uch 
    299  1.1      uch 		sc->sa_state = UCBSND_ENABLE_SPEAKER1;
    300  1.6      uch 		return (0);
    301  1.1      uch 
    302  1.1      uch 	case UCBSND_ENABLE_SPEAKER1:
    303  1.1      uch 		reg = tx_conf_read(tc, TX39_SIBSF0STAT_REG);
    304  1.1      uch 		if ((TX39_SIBSF0_REGADDR(reg) != UCB1200_IO_DATA_REG) &&
    305  1.1      uch 		    --sc->sa_retry > 0) {
    306  1.1      uch 
    307  1.1      uch 			sc->sa_state = UCBSND_ENABLE_SPEAKER0;
    308  1.6      uch 			return (0);
    309  1.1      uch 		}
    310  1.1      uch 
    311  1.1      uch 		if (sc->sa_retry <= 0) {
    312  1.1      uch 			printf("ucbsnd_exec_output: subframe0 busy\n");
    313  1.1      uch 
    314  1.1      uch 			sc->sa_state = UCBSND_IDLE;
    315  1.6      uch 			return (0);
    316  1.1      uch 		}
    317  1.1      uch 
    318  1.1      uch 		reg |= TX39_SIBSF0_WRITE;
    319  1.1      uch 		reg |= UCB1200_IO_DATA_SPEAKER;
    320  1.1      uch 		tx_conf_write(tc, TX39_SIBSF0CTRL_REG, reg);
    321  1.1      uch 
    322  1.3      uch 		/*
    323  1.3      uch 		 * Begin to transfer.
    324  1.3      uch 		 */
    325  1.3      uch 		switch (sc->sa_transfer_mode) {
    326  1.3      uch 		case UCBSND_TRANSFERMODE_DMA:
    327  1.3      uch 			sc->sa_state = UCBSND_DMASTART;
    328  1.3      uch 			sc->sa_dmacnt = 0;
    329  1.3      uch 			break;
    330  1.3      uch 		case UCBSND_TRANSFERMODE_PIO:
    331  1.3      uch 			sc->sa_state = UCBSND_TRANSITION_PIO;
    332  1.3      uch 			break;
    333  1.3      uch 		}
    334  1.3      uch 
    335  1.6      uch 		return (0);
    336  1.3      uch 	case UCBSND_DMASTART:
    337  1.3      uch 		/* get data */
    338  1.3      uch 		if (sc->sa_dmacnt) /* return previous buffer */
    339  1.3      uch 			ringbuf_consumer_return(&sc->sc_rb);
    340  1.3      uch 		buf = ringbuf_consumer_get(&sc->sc_rb, &bufcnt);
    341  1.3      uch 		if (buf == 0) {
    342  1.3      uch 			sc->sa_state = UCBSND_DMAEND;
    343  1.6      uch 			return (0);
    344  1.3      uch 		}
    345  1.3      uch 
    346  1.3      uch 		if (sc->sa_dmacnt == 0) {
    347  1.3      uch 			/* change interrupt source */
    348  1.3      uch 			if (sc->sa_sf0ih) {
    349  1.3      uch 				tx_intr_disestablish(tc, sc->sa_sf0ih);
    350  1.3      uch 				sc->sa_sf0ih = 0;
    351  1.3      uch 			}
    352  1.3      uch 			sc->sa_sndih = tx_intr_establish(
    353  1.3      uch 				tc, MAKEINTR(1, TX39_INTRSTATUS1_SND1_0INT),
    354  1.3      uch 				IST_EDGE, IPL_TTY, ucbsnd_exec_output, sc);
    355  1.3      uch 		} else {
    356  1.3      uch 			wakeup(&sc->sc_rb);
    357  1.3      uch 		}
    358  1.3      uch 
    359  1.3      uch 		/* set DMA buffer address */
    360  1.3      uch 		tx_conf_write(tc, TX39_SIBSNDTXSTART_REG,
    361  1.6      uch 		    MIPS_KSEG0_TO_PHYS(buf));
    362  1.3      uch 
    363  1.3      uch 		/* set DMA buffer size */
    364  1.3      uch 		tx_conf_write(tc, TX39_SIBSIZE_REG,
    365  1.6      uch 		    TX39_SIBSIZE_SNDSIZE_SET(0, bufcnt));
    366  1.3      uch 
    367  1.3      uch 		tx_conf_write(tc, TX39_SIBSF0CTRL_REG, TX39_SIBSF0_SNDVALID);
    368  1.3      uch 
    369  1.3      uch 		/* kick DMA */
    370  1.3      uch 		reg = tx_conf_read(tc, TX39_SIBDMACTRL_REG);
    371  1.3      uch 		reg |= TX39_SIBDMACTRL_ENDMATXSND;
    372  1.3      uch 		tx_conf_write(tc, TX39_SIBDMACTRL_REG, reg);
    373  1.3      uch 
    374  1.3      uch 		/* set next */
    375  1.3      uch 		sc->sa_dmacnt += bufcnt;
    376  1.3      uch 
    377  1.3      uch 		break;
    378  1.1      uch 
    379  1.3      uch 	case UCBSND_DMAEND:
    380  1.3      uch 		sc->sa_state = UCBSND_TRANSITION_DISABLE;
    381  1.3      uch 		break;
    382  1.1      uch 	case UCBSND_TRANSITION_PIO:
    383  1.1      uch 		/* change interrupt source */
    384  1.3      uch 		if (sc->sa_sf0ih) {
    385  1.3      uch 			tx_intr_disestablish(tc, sc->sa_sf0ih);
    386  1.3      uch 			sc->sa_sf0ih = 0;
    387  1.3      uch 		}
    388  1.1      uch 		sc->sa_sndih = tx_intr_establish(
    389  1.1      uch 			tc, MAKEINTR(1, TX39_INTRSTATUS1_SNDININT),
    390  1.1      uch 			IST_EDGE, IPL_TTY, ucbsnd_exec_output, sc);
    391  1.1      uch 
    392  1.1      uch 		sc->sa_state = UCBSND_PIO;
    393  1.2      uch 		sc->sa_cnt = 0;
    394  1.6      uch 		return (0);
    395  1.1      uch 
    396  1.1      uch 	case UCBSND_PIO:
    397  1.3      uch 	{
    398  1.3      uch 		/* PIO test routine */
    399  1.3      uch 		int dummy_data = sc->sa_cnt * 3;
    400  1.3      uch 		tx_conf_write(tc, TX39_SIBSNDHOLD_REG,
    401  1.6      uch 		    dummy_data << 16 | dummy_data);
    402  1.1      uch 		tx_conf_write(tc, TX39_SIBSF0CTRL_REG, TX39_SIBSF0_SNDVALID);
    403  1.3      uch 		if (sc->sa_cnt++ > 50) {
    404  1.1      uch 			sc->sa_state = UCBSND_TRANSITION_DISABLE;
    405  1.3      uch 		}
    406  1.6      uch 		return (0);
    407  1.3      uch 	}
    408  1.1      uch 	case UCBSND_TRANSITION_DISABLE:
    409  1.1      uch 		/* change interrupt source */
    410  1.3      uch 		if (sc->sa_sndih) {
    411  1.3      uch 			tx_intr_disestablish(tc, sc->sa_sndih);
    412  1.3      uch 			sc->sa_sndih = 0;
    413  1.3      uch 		}
    414  1.1      uch 		sc->sa_sf0ih = tx_intr_establish(
    415  1.1      uch 			tc, MAKEINTR(1, TX39_INTRSTATUS1_SIBSF0INT),
    416  1.1      uch 			IST_EDGE, IPL_TTY, ucbsnd_exec_output, sc);
    417  1.1      uch 
    418  1.1      uch 		sc->sa_state = UCBSND_DISABLE_OUTPUTPATH;
    419  1.6      uch 		return (0);
    420  1.1      uch 
    421  1.1      uch 	case UCBSND_DISABLE_OUTPUTPATH:
    422  1.1      uch 		/* disable codec output path and mute */
    423  1.1      uch 		reg = TX39_SIBSF0_WRITE;
    424  1.1      uch 		reg = TX39_SIBSF0_REGADDR_SET(reg, UCB1200_AUDIOCTRLB_REG);
    425  1.1      uch 		reg = TX39_SIBSF0_REGDATA_SET(reg, UCB1200_AUDIOCTRLB_MUTE);
    426  1.1      uch 		tx_conf_write(tc, TX39_SIBSF0CTRL_REG, reg);
    427  1.1      uch 
    428  1.1      uch 		sc->sa_state = UCBSND_DISABLE_SPEAKER0;
    429  1.1      uch 		sc->sa_retry = 10;
    430  1.6      uch 		return (0);
    431  1.1      uch 
    432  1.1      uch 	case UCBSND_DISABLE_SPEAKER0:
    433  1.1      uch 		/* Speaker off */
    434  1.1      uch 		reg = TX39_SIBSF0_REGADDR_SET(0, UCB1200_IO_DATA_REG);
    435  1.1      uch 		tx_conf_write(tc, TX39_SIBSF0CTRL_REG, reg);
    436  1.1      uch 
    437  1.1      uch 		sc->sa_state = UCBSND_DISABLE_SPEAKER1;
    438  1.6      uch 		return (0);
    439  1.1      uch 
    440  1.1      uch 	case UCBSND_DISABLE_SPEAKER1:
    441  1.1      uch 		reg = tx_conf_read(tc, TX39_SIBSF0STAT_REG);
    442  1.1      uch 		if ((TX39_SIBSF0_REGADDR(reg) != UCB1200_IO_DATA_REG) &&
    443  1.1      uch 		    --sc->sa_retry > 0) {
    444  1.1      uch 
    445  1.1      uch 			sc->sa_state = UCBSND_DISABLE_SPEAKER0;
    446  1.6      uch 			return (0);
    447  1.1      uch 		}
    448  1.1      uch 
    449  1.1      uch 		if (sc->sa_retry <= 0) {
    450  1.1      uch 			printf("ucbsnd_exec_output: subframe0 busy\n");
    451  1.1      uch 
    452  1.1      uch 			sc->sa_state = UCBSND_IDLE;
    453  1.6      uch 			return (0);
    454  1.1      uch 		}
    455  1.1      uch 
    456  1.1      uch 		reg |= TX39_SIBSF0_WRITE;
    457  1.1      uch 		reg &= ~UCB1200_IO_DATA_SPEAKER;
    458  1.1      uch 		tx_conf_write(tc, TX39_SIBSF0CTRL_REG, reg);
    459  1.1      uch 
    460  1.1      uch 		sc->sa_state = UCBSND_DISABLE_SIB;
    461  1.6      uch 		return (0);
    462  1.1      uch 
    463  1.1      uch 	case UCBSND_DISABLE_SIB:
    464  1.1      uch 		/* Disable SIB side */
    465  1.1      uch 		reg = tx_conf_read(tc, TX39_SIBCTRL_REG);
    466  1.1      uch 		reg &= ~TX39_SIBCTRL_ENSND;
    467  1.1      uch 		tx_conf_write(tc, TX39_SIBCTRL_REG, reg);
    468  1.1      uch 
    469  1.1      uch 		/* end audio disable sequence */
    470  1.3      uch 		if (sc->sa_sf0ih) {
    471  1.3      uch 			tx_intr_disestablish(tc, sc->sa_sf0ih);
    472  1.3      uch 			sc->sa_sf0ih = 0;
    473  1.3      uch 		}
    474  1.1      uch 		sc->sa_state = UCBSND_IDLE;
    475  1.1      uch 
    476  1.6      uch 		return (0);
    477  1.1      uch 	}
    478  1.1      uch 
    479  1.6      uch 	return (0);
    480  1.1      uch }
    481  1.1      uch 
    482  1.1      uch /*
    483  1.1      uch  * global sound interface.
    484  1.1      uch  */
    485  1.1      uch void
    486  1.6      uch ucbsnd_sound_init(struct ucbsnd_softc *sc)
    487  1.1      uch {
    488  1.1      uch 	tx_sound_tag_t ts = &sc->sc_tag;
    489  1.1      uch 	tx_chipset_tag_t tc = sc->sc_tc;
    490  1.1      uch 
    491  1.1      uch 	ts->ts_v = sc;
    492  1.2      uch 	ts->ts_click	= __ucbsnd_sound_click;
    493  1.2      uch 	ts->ts_mute	= __ucbsnd_sound_mute;
    494  1.1      uch 
    495  1.1      uch 	tx_conf_register_sound(tc, ts);
    496  1.1      uch }
    497  1.1      uch 
    498  1.1      uch void
    499  1.6      uch __ucbsnd_sound_click(tx_sound_tag_t arg)
    500  1.1      uch {
    501  1.1      uch 	struct ucbsnd_softc *sc = (void*)arg;
    502  1.1      uch 
    503  1.2      uch 	if (!sc->sc_mute && sc->sa_state == UCBSND_IDLE) {
    504  1.3      uch 		sc->sa_transfer_mode = UCBSND_TRANSFERMODE_PIO;
    505  1.1      uch 		sc->sa_state = UCBSND_INIT;
    506  1.1      uch 		ucbsnd_exec_output((void*)sc);
    507  1.1      uch 	}
    508  1.1      uch }
    509  1.1      uch 
    510  1.2      uch void
    511  1.6      uch __ucbsnd_sound_mute(tx_sound_tag_t arg, int onoff)
    512  1.2      uch {
    513  1.2      uch 	struct ucbsnd_softc *sc = (void*)arg;
    514  1.6      uch 
    515  1.2      uch 	sc->sc_mute = onoff;
    516  1.3      uch }
    517  1.3      uch 
    518  1.3      uch /*
    519  1.3      uch  * device access
    520  1.3      uch  */
    521  1.3      uch extern struct cfdriver ucbsnd_cd;
    522  1.3      uch 
    523  1.3      uch int
    524  1.6      uch ucbsndopen(dev_t dev, int flags, int ifmt, struct proc *p)
    525  1.3      uch {
    526  1.3      uch 	int unit = AUDIOUNIT(dev);
    527  1.3      uch 	struct ucbsnd_softc *sc;
    528  1.4      uch 	int s;
    529  1.3      uch 
    530  1.3      uch 	if (unit >= ucbsnd_cd.cd_ndevs ||
    531  1.3      uch 	    (sc = ucbsnd_cd.cd_devs[unit]) == NULL)
    532  1.3      uch 		return (ENXIO);
    533  1.4      uch 
    534  1.4      uch 	s = splaudio();
    535  1.4      uch 	ringbuf_reset(&sc->sc_rb);
    536  1.4      uch 	splx(s);
    537  1.3      uch 
    538  1.3      uch 	return (0);
    539  1.3      uch }
    540  1.3      uch 
    541  1.3      uch int
    542  1.6      uch ucbsndclose(dev_t dev, int flags, int ifmt, struct proc *p)
    543  1.3      uch {
    544  1.3      uch 	int unit = AUDIOUNIT(dev);
    545  1.3      uch 	struct ucbsnd_softc *sc;
    546  1.3      uch 
    547  1.3      uch 	if (unit >= ucbsnd_cd.cd_ndevs ||
    548  1.3      uch 	    (sc = ucbsnd_cd.cd_devs[unit]) == NULL)
    549  1.3      uch 		return (ENXIO);
    550  1.3      uch 
    551  1.3      uch 	return (0);
    552  1.3      uch }
    553  1.3      uch 
    554  1.3      uch int
    555  1.6      uch ucbsndread(dev_t dev, struct uio *uio, int ioflag)
    556  1.3      uch {
    557  1.3      uch 	int unit = AUDIOUNIT(dev);
    558  1.3      uch 	struct ucbsnd_softc *sc;
    559  1.3      uch 	int error = 0;
    560  1.3      uch 
    561  1.3      uch 	if (unit >= ucbsnd_cd.cd_ndevs ||
    562  1.3      uch 	    (sc = ucbsnd_cd.cd_devs[unit]) == NULL)
    563  1.3      uch 		return (ENXIO);
    564  1.3      uch 	/* not supported yet */
    565  1.3      uch 
    566  1.3      uch 	return (error);
    567  1.3      uch }
    568  1.3      uch 
    569  1.3      uch int
    570  1.6      uch ucbsndwrite_subr(struct ucbsnd_softc *sc, u_int32_t *buf, size_t bufsize,
    571  1.6      uch     struct uio *uio)
    572  1.3      uch {
    573  1.3      uch 	int i, s, error;
    574  1.3      uch 
    575  1.3      uch 	error = uiomove(buf, bufsize, uio);
    576  1.3      uch 	/*
    577  1.3      uch 	 * inverse endian for UCB1200
    578  1.3      uch 	 */
    579  1.3      uch 	for (i = 0; i < bufsize / sizeof(int); i++)
    580  1.3      uch 		buf[i] = htobe32(buf[i]);
    581  1.7  thorpej 	mips_dcache_wbinv_range((vaddr_t)buf, bufsize);
    582  1.3      uch 
    583  1.3      uch 	ringbuf_producer_return(&sc->sc_rb, bufsize);
    584  1.3      uch 
    585  1.4      uch 	s = splaudio();
    586  1.3      uch 	if (sc->sa_state == UCBSND_IDLE && ringbuf_full(&sc->sc_rb)) {
    587  1.3      uch 		sc->sa_transfer_mode = UCBSND_TRANSFERMODE_DMA;
    588  1.3      uch 		sc->sa_state = UCBSND_INIT;
    589  1.3      uch 		ucbsnd_exec_output((void*)sc);
    590  1.3      uch 	}
    591  1.3      uch 	splx(s);
    592  1.3      uch 
    593  1.6      uch 	return (error);
    594  1.3      uch }
    595  1.3      uch 
    596  1.3      uch int
    597  1.6      uch ucbsndwrite(dev_t dev, struct uio *uio, int ioflag)
    598  1.3      uch {
    599  1.3      uch 	int unit = AUDIOUNIT(dev);
    600  1.3      uch 	struct ucbsnd_softc *sc;
    601  1.3      uch 	int len, error = 0;
    602  1.4      uch 	int i, n, s, rest;
    603  1.3      uch 	void *buf;
    604  1.3      uch 
    605  1.3      uch 	if (unit >= ucbsnd_cd.cd_ndevs ||
    606  1.3      uch 	    (sc = ucbsnd_cd.cd_devs[unit]) == NULL)
    607  1.3      uch 		return (ENXIO);
    608  1.3      uch 
    609  1.3      uch 	len = uio->uio_resid;
    610  1.3      uch 	n = (len + TX39_SIBDMA_SIZE - 1) / TX39_SIBDMA_SIZE;
    611  1.3      uch 	rest = len % TX39_SIBDMA_SIZE;
    612  1.3      uch 
    613  1.3      uch 	if (rest)
    614  1.3      uch 		--n;
    615  1.3      uch 
    616  1.3      uch 	for (i = 0; i < n; i++) {
    617  1.4      uch 		while (!(buf = ringbuf_producer_get(&sc->sc_rb))) {
    618  1.4      uch 			error = tsleep(&sc->sc_rb, PRIBIO, "ucbsnd", 1000);
    619  1.4      uch 			if (error)
    620  1.4      uch 				goto errout;
    621  1.4      uch 		}
    622  1.4      uch 
    623  1.3      uch 		error = ucbsndwrite_subr(sc, buf, TX39_SIBDMA_SIZE, uio);
    624  1.3      uch 		if (error)
    625  1.3      uch 			goto out;
    626  1.3      uch 	}
    627  1.3      uch 
    628  1.3      uch 	if (rest) {
    629  1.4      uch 		while (!(buf = ringbuf_producer_get(&sc->sc_rb))) {
    630  1.4      uch 			error = tsleep(&sc->sc_rb, PRIBIO, "ucbsnd", 1000);
    631  1.4      uch 			if (error)
    632  1.4      uch 				goto errout;
    633  1.4      uch 		}
    634  1.3      uch 
    635  1.3      uch 		error = ucbsndwrite_subr(sc, buf, rest, uio);
    636  1.3      uch 	}
    637  1.3      uch 
    638  1.3      uch  out:
    639  1.4      uch 	return (error);
    640  1.4      uch  errout:
    641  1.4      uch 	printf("%s: timeout. reset ring-buffer.\n", sc->sc_dev.dv_xname);
    642  1.4      uch 	s = splaudio();
    643  1.4      uch 	ringbuf_reset(&sc->sc_rb);
    644  1.4      uch 	splx(s);
    645  1.3      uch 
    646  1.3      uch 	return (error);
    647  1.3      uch }
    648  1.3      uch 
    649  1.3      uch int
    650  1.6      uch ucbsndioctl(dev_t dev, u_long cmd, caddr_t addr, int flag, struct proc *p)
    651  1.3      uch {
    652  1.3      uch 	int error = 0;
    653  1.3      uch 
    654  1.3      uch 	/* not coded yet */
    655  1.3      uch 
    656  1.3      uch 	return (error);
    657  1.3      uch }
    658  1.3      uch 
    659  1.3      uch int
    660  1.6      uch ucbsndpoll(dev_t dev, int events, struct proc *p)
    661  1.3      uch {
    662  1.3      uch 	int error = 0;
    663  1.3      uch 
    664  1.3      uch 	/* not coded yet */
    665  1.3      uch 
    666  1.3      uch 	return (error);
    667  1.3      uch }
    668  1.3      uch 
    669  1.5   simonb paddr_t
    670  1.6      uch ucbsndmmap(dev_t dev, off_t off, int prot)
    671  1.3      uch {
    672  1.3      uch 	int error = 0;
    673  1.3      uch 
    674  1.3      uch 	/* not coded yet */
    675  1.3      uch 
    676  1.3      uch 	return (error);
    677  1.3      uch }
    678  1.3      uch 
    679  1.3      uch /*
    680  1.3      uch  * Ring buffer.
    681  1.3      uch  */
    682  1.3      uch int
    683  1.6      uch ringbuf_allocate(struct ring_buf *rb, size_t blksize, int maxblk)
    684  1.3      uch {
    685  1.3      uch 	rb->rb_bufsize = blksize * maxblk;
    686  1.3      uch 	rb->rb_blksize = blksize;
    687  1.3      uch 	rb->rb_maxblks = maxblk;
    688  1.3      uch #if notyet
    689  1.3      uch 	rb->rb_buf = (u_int32_t)malloc(rb->rb_bufsize, M_DEVBUF, M_WAITOK);
    690  1.3      uch #else
    691  1.3      uch 	rb->rb_buf = (u_int32_t)dmabuf_static;
    692  1.3      uch #endif
    693  1.3      uch 	if (rb->rb_buf == 0) {
    694  1.3      uch 		printf("ringbuf_allocate: can't allocate buffer\n");
    695  1.6      uch 		return (1);
    696  1.3      uch 	}
    697  1.3      uch 	memset((char*)rb->rb_buf, 0, rb->rb_bufsize);
    698  1.3      uch #if notyet
    699  1.3      uch 	rb->rb_bufcnt = malloc(rb->rb_maxblks * sizeof(size_t), M_DEVBUF,
    700  1.6      uch 	    M_WAITOK);
    701  1.3      uch #else
    702  1.3      uch 	rb->rb_bufcnt = dmabufcnt_static;
    703  1.3      uch #endif
    704  1.3      uch 	if (rb->rb_bufcnt == 0) {
    705  1.3      uch 		printf("ringbuf_allocate: can't allocate buffer\n");
    706  1.6      uch 		return (1);
    707  1.3      uch 	}
    708  1.3      uch 	memset((char*)rb->rb_bufcnt, 0, rb->rb_maxblks * sizeof(size_t));
    709  1.3      uch 
    710  1.3      uch 	ringbuf_reset(rb);
    711  1.3      uch 
    712  1.6      uch 	return (0);
    713  1.3      uch }
    714  1.3      uch 
    715  1.3      uch void
    716  1.6      uch ringbuf_deallocate(struct ring_buf *rb)
    717  1.3      uch {
    718  1.3      uch #if notyet
    719  1.3      uch 	free((void*)rb->rb_buf, M_DEVBUF);
    720  1.3      uch 	free(rb->rb_bufcnt, M_DEVBUF);
    721  1.3      uch #endif
    722  1.3      uch }
    723  1.3      uch 
    724  1.3      uch void
    725  1.6      uch ringbuf_reset(struct ring_buf *rb)
    726  1.3      uch {
    727  1.3      uch 	rb->rb_outp = 0;
    728  1.3      uch 	rb->rb_inp = 0;
    729  1.3      uch }
    730  1.3      uch 
    731  1.3      uch int
    732  1.6      uch ringbuf_full(struct ring_buf *rb)
    733  1.3      uch {
    734  1.3      uch 	int ret;
    735  1.3      uch 
    736  1.3      uch 	ret = rb->rb_outp == rb->rb_maxblks;
    737  1.3      uch 
    738  1.6      uch 	return (ret);
    739  1.3      uch }
    740  1.3      uch 
    741  1.3      uch void*
    742  1.6      uch ringbuf_producer_get(struct ring_buf *rb)
    743  1.3      uch {
    744  1.3      uch 	u_int32_t ret;
    745  1.3      uch 	int s;
    746  1.3      uch 
    747  1.4      uch 	s = splaudio();
    748  1.3      uch 	ret = ringbuf_full(rb) ? 0 :
    749  1.6      uch 	    rb->rb_buf + rb->rb_inp * rb->rb_blksize;
    750  1.3      uch 	splx(s);
    751  1.3      uch 
    752  1.6      uch 	return (void *)ret;
    753  1.3      uch }
    754  1.3      uch 
    755  1.3      uch void
    756  1.6      uch ringbuf_producer_return(struct ring_buf *rb, size_t cnt)
    757  1.3      uch {
    758  1.3      uch 	int s;
    759  1.3      uch 
    760  1.3      uch 	assert(cnt <= rb->rb_blksize);
    761  1.3      uch 
    762  1.4      uch 	s = splaudio();
    763  1.3      uch 	rb->rb_outp++;
    764  1.3      uch 
    765  1.3      uch 	rb->rb_bufcnt[rb->rb_inp] = cnt;
    766  1.3      uch 	rb->rb_inp = (rb->rb_inp + 1) % rb->rb_maxblks;
    767  1.3      uch 	splx(s);
    768  1.3      uch }
    769  1.3      uch 
    770  1.3      uch void*
    771  1.6      uch ringbuf_consumer_get(struct ring_buf *rb, size_t *cntp)
    772  1.3      uch {
    773  1.3      uch 	u_int32_t p;
    774  1.3      uch 	int idx;
    775  1.3      uch 
    776  1.3      uch 	if (rb->rb_outp == 0)
    777  1.6      uch 		return (0);
    778  1.3      uch 
    779  1.3      uch 	idx = (rb->rb_inp - rb->rb_outp + rb->rb_maxblks) % rb->rb_maxblks;
    780  1.3      uch 
    781  1.3      uch 	p = rb->rb_buf + idx * rb->rb_blksize;
    782  1.3      uch 	*cntp = rb->rb_bufcnt[idx];
    783  1.3      uch 
    784  1.6      uch 	return (void *)p;
    785  1.3      uch }
    786  1.3      uch 
    787  1.3      uch void
    788  1.6      uch ringbuf_consumer_return(struct ring_buf *rb)
    789  1.3      uch {
    790  1.3      uch 
    791  1.3      uch 	if (rb->rb_outp > 0)
    792  1.3      uch 		rb->rb_outp--;
    793  1.2      uch }
    794