Home | History | Annotate | Line # | Download | only in dev
ucbsnd.c revision 1.6
      1  1.6     uch /*	$NetBSD: ucbsnd.c,v 1.6 2001/09/15 12:47:08 uch 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 #define UCBSNDDEBUG
     46  1.1     uch 
     47  1.1     uch #include "opt_tx39_debug.h"
     48  1.1     uch #include "opt_use_poll.h"
     49  1.1     uch 
     50  1.1     uch #include <sys/param.h>
     51  1.1     uch #include <sys/systm.h>
     52  1.3     uch #include <sys/conf.h>
     53  1.3     uch #include <sys/malloc.h>
     54  1.1     uch #include <sys/device.h>
     55  1.3     uch #include <sys/proc.h>
     56  1.3     uch #include <sys/endian.h>
     57  1.1     uch 
     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.3     uch cdev_decl(ucbsnd);
    154  1.3     uch 
    155  1.6     uch int	ucbsnd_match(struct device*, struct cfdata*, void*);
    156  1.6     uch void	ucbsnd_attach(struct device*, struct device*, void*);
    157  1.1     uch 
    158  1.6     uch int	ucbsnd_exec_output(void*);
    159  1.6     uch int	ucbsnd_busy(void*);
    160  1.1     uch 
    161  1.6     uch void	ucbsnd_sound_init(struct ucbsnd_softc*);
    162  1.6     uch void	__ucbsnd_sound_click(tx_sound_tag_t);
    163  1.6     uch void	__ucbsnd_sound_mute(tx_sound_tag_t, int);
    164  1.6     uch 
    165  1.6     uch int	ucbsndwrite_subr(struct ucbsnd_softc *, u_int32_t *, size_t,
    166  1.6     uch 	    struct uio *);
    167  1.6     uch 
    168  1.6     uch int	ringbuf_allocate(struct ring_buf*, size_t, int);
    169  1.6     uch void	ringbuf_deallocate(struct ring_buf*);
    170  1.6     uch void	ringbuf_reset(struct ring_buf*);
    171  1.6     uch int	ringbuf_full(struct ring_buf*);
    172  1.6     uch void	*ringbuf_producer_get(struct ring_buf*);
    173  1.6     uch void	ringbuf_producer_return(struct ring_buf*, size_t);
    174  1.6     uch void	*ringbuf_consumer_get(struct ring_buf*, size_t*);
    175  1.6     uch void	ringbuf_consumer_return(struct ring_buf*);
    176  1.3     uch 
    177  1.1     uch struct cfattach ucbsnd_ca = {
    178  1.1     uch 	sizeof(struct ucbsnd_softc), ucbsnd_match, ucbsnd_attach
    179  1.1     uch };
    180  1.1     uch 
    181  1.1     uch int
    182  1.6     uch ucbsnd_match(struct device *parent, struct cfdata *cf, void *aux)
    183  1.1     uch {
    184  1.6     uch 
    185  1.6     uch 	return (1);
    186  1.1     uch }
    187  1.1     uch 
    188  1.1     uch void
    189  1.6     uch ucbsnd_attach(struct device *parent, struct device *self, void *aux)
    190  1.1     uch {
    191  1.1     uch 	struct ucb1200_attach_args *ucba = aux;
    192  1.1     uch 	struct ucbsnd_softc *sc = (void*)self;
    193  1.1     uch 	tx_chipset_tag_t tc;
    194  1.1     uch 
    195  1.1     uch 	tc = sc->sc_tc = ucba->ucba_tc;
    196  1.1     uch 	sc->sc_sib = ucba->ucba_sib;
    197  1.1     uch 	sc->sc_ucb = ucba->ucba_ucb;
    198  1.2     uch 
    199  1.2     uch 	/* register sound functions */
    200  1.1     uch 	ucbsnd_sound_init(sc);
    201  1.2     uch 
    202  1.1     uch 	sc->sa_snd_rate = ucba->ucba_snd_rate;
    203  1.1     uch 	sc->sa_tel_rate = ucba->ucba_tel_rate;
    204  1.1     uch 
    205  1.3     uch 	sc->sa_snd_attenuation = UCBSND_DEFAULT_ATTENUATION;
    206  1.1     uch #define KHZ(a) ((a) / 1000), (((a) % 1000))
    207  1.1     uch 	printf(": audio %d.%03d kHz telecom %d.%03d kHz",
    208  1.6     uch 	    KHZ((tx39sib_clock(sc->sc_sib) * 2) /
    209  1.6     uch 		(sc->sa_snd_rate * 64)),
    210  1.6     uch 	    KHZ((tx39sib_clock(sc->sc_sib) * 2) /
    211  1.6     uch 		(sc->sa_tel_rate * 64)));
    212  1.1     uch 
    213  1.1     uch 	ucb1200_state_install(parent, ucbsnd_busy, self,
    214  1.6     uch 	    UCB1200_SND_MODULE);
    215  1.1     uch 
    216  1.3     uch 	ringbuf_allocate(&sc->sc_rb, TX39_SIBDMA_SIZE, UCBSND_BUFBLOCK);
    217  1.3     uch 
    218  1.1     uch 	printf("\n");
    219  1.1     uch }
    220  1.1     uch 
    221  1.1     uch int
    222  1.6     uch ucbsnd_busy(void *arg)
    223  1.1     uch {
    224  1.1     uch 	struct ucbsnd_softc *sc = arg;
    225  1.1     uch 
    226  1.6     uch 	return (sc->sa_state != UCBSND_IDLE);
    227  1.1     uch }
    228  1.1     uch 
    229  1.1     uch int
    230  1.6     uch ucbsnd_exec_output(void *arg)
    231  1.1     uch {
    232  1.1     uch 	struct ucbsnd_softc *sc = arg;
    233  1.1     uch 	tx_chipset_tag_t tc = sc->sc_tc;
    234  1.1     uch 	txreg_t reg;
    235  1.3     uch 	u_int32_t *buf;
    236  1.3     uch 	size_t bufcnt;
    237  1.1     uch 
    238  1.1     uch 	switch (sc->sa_state) {
    239  1.1     uch 	default:
    240  1.1     uch 		panic("ucbsnd_exec_output: invalid state %d", sc->sa_state);
    241  1.1     uch 		/* NOTREACHED */
    242  1.1     uch 		break;
    243  1.1     uch 
    244  1.1     uch 	case UCBSND_IDLE:
    245  1.1     uch 		/* nothing to do */
    246  1.6     uch 		return (0);
    247  1.1     uch 
    248  1.1     uch 	case UCBSND_INIT:
    249  1.1     uch 		sc->sa_sf0ih = tx_intr_establish(
    250  1.1     uch 			tc, MAKEINTR(1, TX39_INTRSTATUS1_SIBSF0INT),
    251  1.1     uch 			IST_EDGE, IPL_TTY, ucbsnd_exec_output, sc);
    252  1.1     uch 
    253  1.1     uch 		sc->sa_state = UCBSND_ENABLE_SAMPLERATE;
    254  1.6     uch 		return (0);
    255  1.1     uch 
    256  1.1     uch 	case UCBSND_ENABLE_SAMPLERATE:
    257  1.1     uch 		/* Enable UCB1200 side sample rate */
    258  1.1     uch 		reg = TX39_SIBSF0_WRITE;
    259  1.1     uch 		reg = TX39_SIBSF0_REGADDR_SET(reg, UCB1200_AUDIOCTRLA_REG);
    260  1.1     uch 		reg = TX39_SIBSF0_REGDATA_SET(reg, sc->sa_snd_rate);
    261  1.1     uch 		tx_conf_write(tc, TX39_SIBSF0CTRL_REG, reg);
    262  1.3     uch 
    263  1.1     uch 		sc->sa_state = UCBSND_ENABLE_OUTPUTPATH;
    264  1.6     uch 		return (0);
    265  1.3     uch 
    266  1.1     uch 	case UCBSND_ENABLE_OUTPUTPATH:
    267  1.1     uch 		/* Enable UCB1200 side */
    268  1.1     uch 		reg = TX39_SIBSF0_WRITE;
    269  1.1     uch 		reg = TX39_SIBSF0_REGADDR_SET(reg, UCB1200_AUDIOCTRLB_REG);
    270  1.3     uch 		reg = TX39_SIBSF0_REGDATA_SET(reg, sc->sa_snd_attenuation |
    271  1.6     uch 		    UCB1200_AUDIOCTRLB_OUTEN);
    272  1.1     uch 		tx_conf_write(tc, TX39_SIBSF0CTRL_REG, reg);
    273  1.1     uch 
    274  1.1     uch 		/* Enable SIB side */
    275  1.1     uch 		reg = tx_conf_read(tc, TX39_SIBCTRL_REG);
    276  1.1     uch 		tx_conf_write(tc, TX39_SIBCTRL_REG,
    277  1.6     uch 		    reg | TX39_SIBCTRL_ENSND);
    278  1.1     uch 
    279  1.1     uch 		sc->sa_state = UCBSND_ENABLE_SPEAKER0;
    280  1.1     uch 		sc->sa_retry = 10;
    281  1.6     uch 		return (0);
    282  1.1     uch 	case UCBSND_ENABLE_SPEAKER0:
    283  1.1     uch 		/* Speaker on */
    284  1.1     uch 
    285  1.1     uch 		reg = TX39_SIBSF0_REGADDR_SET(0, UCB1200_IO_DATA_REG);
    286  1.1     uch 		tx_conf_write(tc, TX39_SIBSF0CTRL_REG, reg);
    287  1.1     uch 
    288  1.1     uch 		sc->sa_state = UCBSND_ENABLE_SPEAKER1;
    289  1.6     uch 		return (0);
    290  1.1     uch 
    291  1.1     uch 	case UCBSND_ENABLE_SPEAKER1:
    292  1.1     uch 		reg = tx_conf_read(tc, TX39_SIBSF0STAT_REG);
    293  1.1     uch 		if ((TX39_SIBSF0_REGADDR(reg) != UCB1200_IO_DATA_REG) &&
    294  1.1     uch 		    --sc->sa_retry > 0) {
    295  1.1     uch 
    296  1.1     uch 			sc->sa_state = UCBSND_ENABLE_SPEAKER0;
    297  1.6     uch 			return (0);
    298  1.1     uch 		}
    299  1.1     uch 
    300  1.1     uch 		if (sc->sa_retry <= 0) {
    301  1.1     uch 			printf("ucbsnd_exec_output: subframe0 busy\n");
    302  1.1     uch 
    303  1.1     uch 			sc->sa_state = UCBSND_IDLE;
    304  1.6     uch 			return (0);
    305  1.1     uch 		}
    306  1.1     uch 
    307  1.1     uch 		reg |= TX39_SIBSF0_WRITE;
    308  1.1     uch 		reg |= UCB1200_IO_DATA_SPEAKER;
    309  1.1     uch 		tx_conf_write(tc, TX39_SIBSF0CTRL_REG, reg);
    310  1.1     uch 
    311  1.3     uch 		/*
    312  1.3     uch 		 * Begin to transfer.
    313  1.3     uch 		 */
    314  1.3     uch 		switch (sc->sa_transfer_mode) {
    315  1.3     uch 		case UCBSND_TRANSFERMODE_DMA:
    316  1.3     uch 			sc->sa_state = UCBSND_DMASTART;
    317  1.3     uch 			sc->sa_dmacnt = 0;
    318  1.3     uch 			break;
    319  1.3     uch 		case UCBSND_TRANSFERMODE_PIO:
    320  1.3     uch 			sc->sa_state = UCBSND_TRANSITION_PIO;
    321  1.3     uch 			break;
    322  1.3     uch 		}
    323  1.3     uch 
    324  1.6     uch 		return (0);
    325  1.3     uch 	case UCBSND_DMASTART:
    326  1.3     uch 		/* get data */
    327  1.3     uch 		if (sc->sa_dmacnt) /* return previous buffer */
    328  1.3     uch 			ringbuf_consumer_return(&sc->sc_rb);
    329  1.3     uch 		buf = ringbuf_consumer_get(&sc->sc_rb, &bufcnt);
    330  1.3     uch 		if (buf == 0) {
    331  1.3     uch 			sc->sa_state = UCBSND_DMAEND;
    332  1.6     uch 			return (0);
    333  1.3     uch 		}
    334  1.3     uch 
    335  1.3     uch 		if (sc->sa_dmacnt == 0) {
    336  1.3     uch 			/* change interrupt source */
    337  1.3     uch 			if (sc->sa_sf0ih) {
    338  1.3     uch 				tx_intr_disestablish(tc, sc->sa_sf0ih);
    339  1.3     uch 				sc->sa_sf0ih = 0;
    340  1.3     uch 			}
    341  1.3     uch 			sc->sa_sndih = tx_intr_establish(
    342  1.3     uch 				tc, MAKEINTR(1, TX39_INTRSTATUS1_SND1_0INT),
    343  1.3     uch 				IST_EDGE, IPL_TTY, ucbsnd_exec_output, sc);
    344  1.3     uch 		} else {
    345  1.3     uch 			wakeup(&sc->sc_rb);
    346  1.3     uch 		}
    347  1.3     uch 
    348  1.3     uch 		/* set DMA buffer address */
    349  1.3     uch 		tx_conf_write(tc, TX39_SIBSNDTXSTART_REG,
    350  1.6     uch 		    MIPS_KSEG0_TO_PHYS(buf));
    351  1.3     uch 
    352  1.3     uch 		/* set DMA buffer size */
    353  1.3     uch 		tx_conf_write(tc, TX39_SIBSIZE_REG,
    354  1.6     uch 		    TX39_SIBSIZE_SNDSIZE_SET(0, bufcnt));
    355  1.3     uch 
    356  1.3     uch 		tx_conf_write(tc, TX39_SIBSF0CTRL_REG, TX39_SIBSF0_SNDVALID);
    357  1.3     uch 
    358  1.3     uch 		/* kick DMA */
    359  1.3     uch 		reg = tx_conf_read(tc, TX39_SIBDMACTRL_REG);
    360  1.3     uch 		reg |= TX39_SIBDMACTRL_ENDMATXSND;
    361  1.3     uch 		tx_conf_write(tc, TX39_SIBDMACTRL_REG, reg);
    362  1.3     uch 
    363  1.3     uch 		/* set next */
    364  1.3     uch 		sc->sa_dmacnt += bufcnt;
    365  1.3     uch 
    366  1.3     uch 		break;
    367  1.1     uch 
    368  1.3     uch 	case UCBSND_DMAEND:
    369  1.3     uch 		sc->sa_state = UCBSND_TRANSITION_DISABLE;
    370  1.3     uch 		break;
    371  1.1     uch 	case UCBSND_TRANSITION_PIO:
    372  1.1     uch 		/* change interrupt source */
    373  1.3     uch 		if (sc->sa_sf0ih) {
    374  1.3     uch 			tx_intr_disestablish(tc, sc->sa_sf0ih);
    375  1.3     uch 			sc->sa_sf0ih = 0;
    376  1.3     uch 		}
    377  1.1     uch 		sc->sa_sndih = tx_intr_establish(
    378  1.1     uch 			tc, MAKEINTR(1, TX39_INTRSTATUS1_SNDININT),
    379  1.1     uch 			IST_EDGE, IPL_TTY, ucbsnd_exec_output, sc);
    380  1.1     uch 
    381  1.1     uch 		sc->sa_state = UCBSND_PIO;
    382  1.2     uch 		sc->sa_cnt = 0;
    383  1.6     uch 		return (0);
    384  1.1     uch 
    385  1.1     uch 	case UCBSND_PIO:
    386  1.3     uch 	{
    387  1.3     uch 		/* PIO test routine */
    388  1.3     uch 		int dummy_data = sc->sa_cnt * 3;
    389  1.3     uch 		tx_conf_write(tc, TX39_SIBSNDHOLD_REG,
    390  1.6     uch 		    dummy_data << 16 | dummy_data);
    391  1.1     uch 		tx_conf_write(tc, TX39_SIBSF0CTRL_REG, TX39_SIBSF0_SNDVALID);
    392  1.3     uch 		if (sc->sa_cnt++ > 50) {
    393  1.1     uch 			sc->sa_state = UCBSND_TRANSITION_DISABLE;
    394  1.3     uch 		}
    395  1.6     uch 		return (0);
    396  1.3     uch 	}
    397  1.1     uch 	case UCBSND_TRANSITION_DISABLE:
    398  1.1     uch 		/* change interrupt source */
    399  1.3     uch 		if (sc->sa_sndih) {
    400  1.3     uch 			tx_intr_disestablish(tc, sc->sa_sndih);
    401  1.3     uch 			sc->sa_sndih = 0;
    402  1.3     uch 		}
    403  1.1     uch 		sc->sa_sf0ih = tx_intr_establish(
    404  1.1     uch 			tc, MAKEINTR(1, TX39_INTRSTATUS1_SIBSF0INT),
    405  1.1     uch 			IST_EDGE, IPL_TTY, ucbsnd_exec_output, sc);
    406  1.1     uch 
    407  1.1     uch 		sc->sa_state = UCBSND_DISABLE_OUTPUTPATH;
    408  1.6     uch 		return (0);
    409  1.1     uch 
    410  1.1     uch 	case UCBSND_DISABLE_OUTPUTPATH:
    411  1.1     uch 		/* disable codec output path and mute */
    412  1.1     uch 		reg = TX39_SIBSF0_WRITE;
    413  1.1     uch 		reg = TX39_SIBSF0_REGADDR_SET(reg, UCB1200_AUDIOCTRLB_REG);
    414  1.1     uch 		reg = TX39_SIBSF0_REGDATA_SET(reg, UCB1200_AUDIOCTRLB_MUTE);
    415  1.1     uch 		tx_conf_write(tc, TX39_SIBSF0CTRL_REG, reg);
    416  1.1     uch 
    417  1.1     uch 		sc->sa_state = UCBSND_DISABLE_SPEAKER0;
    418  1.1     uch 		sc->sa_retry = 10;
    419  1.6     uch 		return (0);
    420  1.1     uch 
    421  1.1     uch 	case UCBSND_DISABLE_SPEAKER0:
    422  1.1     uch 		/* Speaker off */
    423  1.1     uch 		reg = TX39_SIBSF0_REGADDR_SET(0, UCB1200_IO_DATA_REG);
    424  1.1     uch 		tx_conf_write(tc, TX39_SIBSF0CTRL_REG, reg);
    425  1.1     uch 
    426  1.1     uch 		sc->sa_state = UCBSND_DISABLE_SPEAKER1;
    427  1.6     uch 		return (0);
    428  1.1     uch 
    429  1.1     uch 	case UCBSND_DISABLE_SPEAKER1:
    430  1.1     uch 		reg = tx_conf_read(tc, TX39_SIBSF0STAT_REG);
    431  1.1     uch 		if ((TX39_SIBSF0_REGADDR(reg) != UCB1200_IO_DATA_REG) &&
    432  1.1     uch 		    --sc->sa_retry > 0) {
    433  1.1     uch 
    434  1.1     uch 			sc->sa_state = UCBSND_DISABLE_SPEAKER0;
    435  1.6     uch 			return (0);
    436  1.1     uch 		}
    437  1.1     uch 
    438  1.1     uch 		if (sc->sa_retry <= 0) {
    439  1.1     uch 			printf("ucbsnd_exec_output: subframe0 busy\n");
    440  1.1     uch 
    441  1.1     uch 			sc->sa_state = UCBSND_IDLE;
    442  1.6     uch 			return (0);
    443  1.1     uch 		}
    444  1.1     uch 
    445  1.1     uch 		reg |= TX39_SIBSF0_WRITE;
    446  1.1     uch 		reg &= ~UCB1200_IO_DATA_SPEAKER;
    447  1.1     uch 		tx_conf_write(tc, TX39_SIBSF0CTRL_REG, reg);
    448  1.1     uch 
    449  1.1     uch 		sc->sa_state = UCBSND_DISABLE_SIB;
    450  1.6     uch 		return (0);
    451  1.1     uch 
    452  1.1     uch 	case UCBSND_DISABLE_SIB:
    453  1.1     uch 		/* Disable SIB side */
    454  1.1     uch 		reg = tx_conf_read(tc, TX39_SIBCTRL_REG);
    455  1.1     uch 		reg &= ~TX39_SIBCTRL_ENSND;
    456  1.1     uch 		tx_conf_write(tc, TX39_SIBCTRL_REG, reg);
    457  1.1     uch 
    458  1.1     uch 		/* end audio disable sequence */
    459  1.3     uch 		if (sc->sa_sf0ih) {
    460  1.3     uch 			tx_intr_disestablish(tc, sc->sa_sf0ih);
    461  1.3     uch 			sc->sa_sf0ih = 0;
    462  1.3     uch 		}
    463  1.1     uch 		sc->sa_state = UCBSND_IDLE;
    464  1.1     uch 
    465  1.6     uch 		return (0);
    466  1.1     uch 	}
    467  1.1     uch 
    468  1.6     uch 	return (0);
    469  1.1     uch }
    470  1.1     uch 
    471  1.1     uch /*
    472  1.1     uch  * global sound interface.
    473  1.1     uch  */
    474  1.1     uch void
    475  1.6     uch ucbsnd_sound_init(struct ucbsnd_softc *sc)
    476  1.1     uch {
    477  1.1     uch 	tx_sound_tag_t ts = &sc->sc_tag;
    478  1.1     uch 	tx_chipset_tag_t tc = sc->sc_tc;
    479  1.1     uch 
    480  1.1     uch 	ts->ts_v = sc;
    481  1.2     uch 	ts->ts_click	= __ucbsnd_sound_click;
    482  1.2     uch 	ts->ts_mute	= __ucbsnd_sound_mute;
    483  1.1     uch 
    484  1.1     uch 	tx_conf_register_sound(tc, ts);
    485  1.1     uch }
    486  1.1     uch 
    487  1.1     uch void
    488  1.6     uch __ucbsnd_sound_click(tx_sound_tag_t arg)
    489  1.1     uch {
    490  1.1     uch 	struct ucbsnd_softc *sc = (void*)arg;
    491  1.1     uch 
    492  1.2     uch 	if (!sc->sc_mute && sc->sa_state == UCBSND_IDLE) {
    493  1.3     uch 		sc->sa_transfer_mode = UCBSND_TRANSFERMODE_PIO;
    494  1.1     uch 		sc->sa_state = UCBSND_INIT;
    495  1.1     uch 		ucbsnd_exec_output((void*)sc);
    496  1.1     uch 	}
    497  1.1     uch }
    498  1.1     uch 
    499  1.2     uch void
    500  1.6     uch __ucbsnd_sound_mute(tx_sound_tag_t arg, int onoff)
    501  1.2     uch {
    502  1.2     uch 	struct ucbsnd_softc *sc = (void*)arg;
    503  1.6     uch 
    504  1.2     uch 	sc->sc_mute = onoff;
    505  1.3     uch }
    506  1.3     uch 
    507  1.3     uch /*
    508  1.3     uch  * device access
    509  1.3     uch  */
    510  1.3     uch extern struct cfdriver ucbsnd_cd;
    511  1.3     uch 
    512  1.3     uch int
    513  1.6     uch ucbsndopen(dev_t dev, int flags, int ifmt, struct proc *p)
    514  1.3     uch {
    515  1.3     uch 	int unit = AUDIOUNIT(dev);
    516  1.3     uch 	struct ucbsnd_softc *sc;
    517  1.4     uch 	int s;
    518  1.3     uch 
    519  1.3     uch 	if (unit >= ucbsnd_cd.cd_ndevs ||
    520  1.3     uch 	    (sc = ucbsnd_cd.cd_devs[unit]) == NULL)
    521  1.3     uch 		return (ENXIO);
    522  1.4     uch 
    523  1.4     uch 	s = splaudio();
    524  1.4     uch 	ringbuf_reset(&sc->sc_rb);
    525  1.4     uch 	splx(s);
    526  1.3     uch 
    527  1.3     uch 	return (0);
    528  1.3     uch }
    529  1.3     uch 
    530  1.3     uch int
    531  1.6     uch ucbsndclose(dev_t dev, int flags, int ifmt, struct proc *p)
    532  1.3     uch {
    533  1.3     uch 	int unit = AUDIOUNIT(dev);
    534  1.3     uch 	struct ucbsnd_softc *sc;
    535  1.3     uch 
    536  1.3     uch 	if (unit >= ucbsnd_cd.cd_ndevs ||
    537  1.3     uch 	    (sc = ucbsnd_cd.cd_devs[unit]) == NULL)
    538  1.3     uch 		return (ENXIO);
    539  1.3     uch 
    540  1.3     uch 	return (0);
    541  1.3     uch }
    542  1.3     uch 
    543  1.3     uch int
    544  1.6     uch ucbsndread(dev_t dev, struct uio *uio, int ioflag)
    545  1.3     uch {
    546  1.3     uch 	int unit = AUDIOUNIT(dev);
    547  1.3     uch 	struct ucbsnd_softc *sc;
    548  1.3     uch 	int error = 0;
    549  1.3     uch 
    550  1.3     uch 	if (unit >= ucbsnd_cd.cd_ndevs ||
    551  1.3     uch 	    (sc = ucbsnd_cd.cd_devs[unit]) == NULL)
    552  1.3     uch 		return (ENXIO);
    553  1.3     uch 	/* not supported yet */
    554  1.3     uch 
    555  1.3     uch 	return (error);
    556  1.3     uch }
    557  1.3     uch 
    558  1.3     uch int
    559  1.6     uch ucbsndwrite_subr(struct ucbsnd_softc *sc, u_int32_t *buf, size_t bufsize,
    560  1.6     uch     struct uio *uio)
    561  1.3     uch {
    562  1.3     uch 	int i, s, error;
    563  1.3     uch 
    564  1.3     uch 	error = uiomove(buf, bufsize, uio);
    565  1.3     uch 	/*
    566  1.3     uch 	 * inverse endian for UCB1200
    567  1.3     uch 	 */
    568  1.3     uch 	for (i = 0; i < bufsize / sizeof(int); i++)
    569  1.3     uch 		buf[i] = htobe32(buf[i]);
    570  1.3     uch 	MachFlushCache();
    571  1.3     uch 
    572  1.3     uch 	ringbuf_producer_return(&sc->sc_rb, bufsize);
    573  1.3     uch 
    574  1.4     uch 	s = splaudio();
    575  1.3     uch 	if (sc->sa_state == UCBSND_IDLE && ringbuf_full(&sc->sc_rb)) {
    576  1.3     uch 		sc->sa_transfer_mode = UCBSND_TRANSFERMODE_DMA;
    577  1.3     uch 		sc->sa_state = UCBSND_INIT;
    578  1.3     uch 		ucbsnd_exec_output((void*)sc);
    579  1.3     uch 	}
    580  1.3     uch 	splx(s);
    581  1.3     uch 
    582  1.6     uch 	return (error);
    583  1.3     uch }
    584  1.3     uch 
    585  1.3     uch int
    586  1.6     uch ucbsndwrite(dev_t dev, struct uio *uio, int ioflag)
    587  1.3     uch {
    588  1.3     uch 	int unit = AUDIOUNIT(dev);
    589  1.3     uch 	struct ucbsnd_softc *sc;
    590  1.3     uch 	int len, error = 0;
    591  1.4     uch 	int i, n, s, rest;
    592  1.3     uch 	void *buf;
    593  1.3     uch 
    594  1.3     uch 	if (unit >= ucbsnd_cd.cd_ndevs ||
    595  1.3     uch 	    (sc = ucbsnd_cd.cd_devs[unit]) == NULL)
    596  1.3     uch 		return (ENXIO);
    597  1.3     uch 
    598  1.3     uch 	len = uio->uio_resid;
    599  1.3     uch 	n = (len + TX39_SIBDMA_SIZE - 1) / TX39_SIBDMA_SIZE;
    600  1.3     uch 	rest = len % TX39_SIBDMA_SIZE;
    601  1.3     uch 
    602  1.3     uch 	if (rest)
    603  1.3     uch 		--n;
    604  1.3     uch 
    605  1.3     uch 	for (i = 0; i < n; i++) {
    606  1.4     uch 		while (!(buf = ringbuf_producer_get(&sc->sc_rb))) {
    607  1.4     uch 			error = tsleep(&sc->sc_rb, PRIBIO, "ucbsnd", 1000);
    608  1.4     uch 			if (error)
    609  1.4     uch 				goto errout;
    610  1.4     uch 		}
    611  1.4     uch 
    612  1.3     uch 		error = ucbsndwrite_subr(sc, buf, TX39_SIBDMA_SIZE, uio);
    613  1.3     uch 		if (error)
    614  1.3     uch 			goto out;
    615  1.3     uch 	}
    616  1.3     uch 
    617  1.3     uch 	if (rest) {
    618  1.4     uch 		while (!(buf = ringbuf_producer_get(&sc->sc_rb))) {
    619  1.4     uch 			error = tsleep(&sc->sc_rb, PRIBIO, "ucbsnd", 1000);
    620  1.4     uch 			if (error)
    621  1.4     uch 				goto errout;
    622  1.4     uch 		}
    623  1.3     uch 
    624  1.3     uch 		error = ucbsndwrite_subr(sc, buf, rest, uio);
    625  1.3     uch 	}
    626  1.3     uch 
    627  1.3     uch  out:
    628  1.4     uch 	return (error);
    629  1.4     uch  errout:
    630  1.4     uch 	printf("%s: timeout. reset ring-buffer.\n", sc->sc_dev.dv_xname);
    631  1.4     uch 	s = splaudio();
    632  1.4     uch 	ringbuf_reset(&sc->sc_rb);
    633  1.4     uch 	splx(s);
    634  1.3     uch 
    635  1.3     uch 	return (error);
    636  1.3     uch }
    637  1.3     uch 
    638  1.3     uch int
    639  1.6     uch ucbsndioctl(dev_t dev, u_long cmd, caddr_t addr, int flag, struct proc *p)
    640  1.3     uch {
    641  1.3     uch 	int error = 0;
    642  1.3     uch 
    643  1.3     uch 	/* not coded yet */
    644  1.3     uch 
    645  1.3     uch 	return (error);
    646  1.3     uch }
    647  1.3     uch 
    648  1.3     uch int
    649  1.6     uch ucbsndpoll(dev_t dev, int events, struct proc *p)
    650  1.3     uch {
    651  1.3     uch 	int error = 0;
    652  1.3     uch 
    653  1.3     uch 	/* not coded yet */
    654  1.3     uch 
    655  1.3     uch 	return (error);
    656  1.3     uch }
    657  1.3     uch 
    658  1.5  simonb paddr_t
    659  1.6     uch ucbsndmmap(dev_t dev, off_t off, int prot)
    660  1.3     uch {
    661  1.3     uch 	int error = 0;
    662  1.3     uch 
    663  1.3     uch 	/* not coded yet */
    664  1.3     uch 
    665  1.3     uch 	return (error);
    666  1.3     uch }
    667  1.3     uch 
    668  1.3     uch /*
    669  1.3     uch  * Ring buffer.
    670  1.3     uch  */
    671  1.3     uch int
    672  1.6     uch ringbuf_allocate(struct ring_buf *rb, size_t blksize, int maxblk)
    673  1.3     uch {
    674  1.3     uch 	rb->rb_bufsize = blksize * maxblk;
    675  1.3     uch 	rb->rb_blksize = blksize;
    676  1.3     uch 	rb->rb_maxblks = maxblk;
    677  1.3     uch #if notyet
    678  1.3     uch 	rb->rb_buf = (u_int32_t)malloc(rb->rb_bufsize, M_DEVBUF, M_WAITOK);
    679  1.3     uch #else
    680  1.3     uch 	rb->rb_buf = (u_int32_t)dmabuf_static;
    681  1.3     uch #endif
    682  1.3     uch 	if (rb->rb_buf == 0) {
    683  1.3     uch 		printf("ringbuf_allocate: can't allocate buffer\n");
    684  1.6     uch 		return (1);
    685  1.3     uch 	}
    686  1.3     uch 	memset((char*)rb->rb_buf, 0, rb->rb_bufsize);
    687  1.3     uch #if notyet
    688  1.3     uch 	rb->rb_bufcnt = malloc(rb->rb_maxblks * sizeof(size_t), M_DEVBUF,
    689  1.6     uch 	    M_WAITOK);
    690  1.3     uch #else
    691  1.3     uch 	rb->rb_bufcnt = dmabufcnt_static;
    692  1.3     uch #endif
    693  1.3     uch 	if (rb->rb_bufcnt == 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_bufcnt, 0, rb->rb_maxblks * sizeof(size_t));
    698  1.3     uch 
    699  1.3     uch 	ringbuf_reset(rb);
    700  1.3     uch 
    701  1.6     uch 	return (0);
    702  1.3     uch }
    703  1.3     uch 
    704  1.3     uch void
    705  1.6     uch ringbuf_deallocate(struct ring_buf *rb)
    706  1.3     uch {
    707  1.3     uch #if notyet
    708  1.3     uch 	free((void*)rb->rb_buf, M_DEVBUF);
    709  1.3     uch 	free(rb->rb_bufcnt, M_DEVBUF);
    710  1.3     uch #endif
    711  1.3     uch }
    712  1.3     uch 
    713  1.3     uch void
    714  1.6     uch ringbuf_reset(struct ring_buf *rb)
    715  1.3     uch {
    716  1.3     uch 	rb->rb_outp = 0;
    717  1.3     uch 	rb->rb_inp = 0;
    718  1.3     uch }
    719  1.3     uch 
    720  1.3     uch int
    721  1.6     uch ringbuf_full(struct ring_buf *rb)
    722  1.3     uch {
    723  1.3     uch 	int ret;
    724  1.3     uch 
    725  1.3     uch 	ret = rb->rb_outp == rb->rb_maxblks;
    726  1.3     uch 
    727  1.6     uch 	return (ret);
    728  1.3     uch }
    729  1.3     uch 
    730  1.3     uch void*
    731  1.6     uch ringbuf_producer_get(struct ring_buf *rb)
    732  1.3     uch {
    733  1.3     uch 	u_int32_t ret;
    734  1.3     uch 	int s;
    735  1.3     uch 
    736  1.4     uch 	s = splaudio();
    737  1.3     uch 	ret = ringbuf_full(rb) ? 0 :
    738  1.6     uch 	    rb->rb_buf + rb->rb_inp * rb->rb_blksize;
    739  1.3     uch 	splx(s);
    740  1.3     uch 
    741  1.6     uch 	return (void *)ret;
    742  1.3     uch }
    743  1.3     uch 
    744  1.3     uch void
    745  1.6     uch ringbuf_producer_return(struct ring_buf *rb, size_t cnt)
    746  1.3     uch {
    747  1.3     uch 	int s;
    748  1.3     uch 
    749  1.3     uch 	assert(cnt <= rb->rb_blksize);
    750  1.3     uch 
    751  1.4     uch 	s = splaudio();
    752  1.3     uch 	rb->rb_outp++;
    753  1.3     uch 
    754  1.3     uch 	rb->rb_bufcnt[rb->rb_inp] = cnt;
    755  1.3     uch 	rb->rb_inp = (rb->rb_inp + 1) % rb->rb_maxblks;
    756  1.3     uch 	splx(s);
    757  1.3     uch }
    758  1.3     uch 
    759  1.3     uch void*
    760  1.6     uch ringbuf_consumer_get(struct ring_buf *rb, size_t *cntp)
    761  1.3     uch {
    762  1.3     uch 	u_int32_t p;
    763  1.3     uch 	int idx;
    764  1.3     uch 
    765  1.3     uch 	if (rb->rb_outp == 0)
    766  1.6     uch 		return (0);
    767  1.3     uch 
    768  1.3     uch 	idx = (rb->rb_inp - rb->rb_outp + rb->rb_maxblks) % rb->rb_maxblks;
    769  1.3     uch 
    770  1.3     uch 	p = rb->rb_buf + idx * rb->rb_blksize;
    771  1.3     uch 	*cntp = rb->rb_bufcnt[idx];
    772  1.3     uch 
    773  1.6     uch 	return (void *)p;
    774  1.3     uch }
    775  1.3     uch 
    776  1.3     uch void
    777  1.6     uch ringbuf_consumer_return(struct ring_buf *rb)
    778  1.3     uch {
    779  1.3     uch 
    780  1.3     uch 	if (rb->rb_outp > 0)
    781  1.3     uch 		rb->rb_outp--;
    782  1.2     uch }
    783