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