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