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