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