audio.c revision 1.28.2.17 1 1.28.2.17 martin /* $NetBSD: audio.c,v 1.28.2.17 2020/12/19 13:48:27 martin Exp $ */
2 1.2 isaki
3 1.2 isaki /*-
4 1.2 isaki * Copyright (c) 2008 The NetBSD Foundation, Inc.
5 1.2 isaki * All rights reserved.
6 1.2 isaki *
7 1.2 isaki * This code is derived from software contributed to The NetBSD Foundation
8 1.2 isaki * by Andrew Doran.
9 1.2 isaki *
10 1.2 isaki * Redistribution and use in source and binary forms, with or without
11 1.2 isaki * modification, are permitted provided that the following conditions
12 1.2 isaki * are met:
13 1.2 isaki * 1. Redistributions of source code must retain the above copyright
14 1.2 isaki * notice, this list of conditions and the following disclaimer.
15 1.2 isaki * 2. Redistributions in binary form must reproduce the above copyright
16 1.2 isaki * notice, this list of conditions and the following disclaimer in the
17 1.2 isaki * documentation and/or other materials provided with the distribution.
18 1.2 isaki *
19 1.2 isaki * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.2 isaki * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.2 isaki * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.2 isaki * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.2 isaki * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.2 isaki * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.2 isaki * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.2 isaki * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.2 isaki * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.2 isaki * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.2 isaki * POSSIBILITY OF SUCH DAMAGE.
30 1.2 isaki */
31 1.2 isaki
32 1.2 isaki /*
33 1.2 isaki * Copyright (c) 1991-1993 Regents of the University of California.
34 1.2 isaki * All rights reserved.
35 1.2 isaki *
36 1.2 isaki * Redistribution and use in source and binary forms, with or without
37 1.2 isaki * modification, are permitted provided that the following conditions
38 1.2 isaki * are met:
39 1.2 isaki * 1. Redistributions of source code must retain the above copyright
40 1.2 isaki * notice, this list of conditions and the following disclaimer.
41 1.2 isaki * 2. Redistributions in binary form must reproduce the above copyright
42 1.2 isaki * notice, this list of conditions and the following disclaimer in the
43 1.2 isaki * documentation and/or other materials provided with the distribution.
44 1.2 isaki * 3. All advertising materials mentioning features or use of this software
45 1.2 isaki * must display the following acknowledgement:
46 1.2 isaki * This product includes software developed by the Computer Systems
47 1.2 isaki * Engineering Group at Lawrence Berkeley Laboratory.
48 1.2 isaki * 4. Neither the name of the University nor of the Laboratory may be used
49 1.2 isaki * to endorse or promote products derived from this software without
50 1.2 isaki * specific prior written permission.
51 1.2 isaki *
52 1.2 isaki * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
53 1.2 isaki * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
54 1.2 isaki * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
55 1.2 isaki * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
56 1.2 isaki * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
57 1.2 isaki * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
58 1.2 isaki * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
59 1.2 isaki * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
60 1.2 isaki * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
61 1.2 isaki * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
62 1.2 isaki * SUCH DAMAGE.
63 1.2 isaki */
64 1.2 isaki
65 1.2 isaki /*
66 1.2 isaki * Locking: there are three locks per device.
67 1.2 isaki *
68 1.2 isaki * - sc_lock, provided by the underlying driver. This is an adaptive lock,
69 1.2 isaki * returned in the second parameter to hw_if->get_locks(). It is known
70 1.2 isaki * as the "thread lock".
71 1.2 isaki *
72 1.2 isaki * It serializes access to state in all places except the
73 1.2 isaki * driver's interrupt service routine. This lock is taken from process
74 1.2 isaki * context (example: access to /dev/audio). It is also taken from soft
75 1.2 isaki * interrupt handlers in this module, primarily to serialize delivery of
76 1.2 isaki * wakeups. This lock may be used/provided by modules external to the
77 1.2 isaki * audio subsystem, so take care not to introduce a lock order problem.
78 1.2 isaki * LONG TERM SLEEPS MUST NOT OCCUR WITH THIS LOCK HELD.
79 1.2 isaki *
80 1.2 isaki * - sc_intr_lock, provided by the underlying driver. This may be either a
81 1.2 isaki * spinlock (at IPL_SCHED or IPL_VM) or an adaptive lock (IPL_NONE or
82 1.2 isaki * IPL_SOFT*), returned in the first parameter to hw_if->get_locks(). It
83 1.2 isaki * is known as the "interrupt lock".
84 1.2 isaki *
85 1.2 isaki * It provides atomic access to the device's hardware state, and to audio
86 1.2 isaki * channel data that may be accessed by the hardware driver's ISR.
87 1.2 isaki * In all places outside the ISR, sc_lock must be held before taking
88 1.2 isaki * sc_intr_lock. This is to ensure that groups of hardware operations are
89 1.2 isaki * made atomically. SLEEPS CANNOT OCCUR WITH THIS LOCK HELD.
90 1.2 isaki *
91 1.2 isaki * - sc_exlock, private to this module. This is a variable protected by
92 1.2 isaki * sc_lock. It is known as the "critical section".
93 1.2 isaki * Some operations release sc_lock in order to allocate memory, to wait
94 1.2 isaki * for in-flight I/O to complete, to copy to/from user context, etc.
95 1.2 isaki * sc_exlock provides a critical section even under the circumstance.
96 1.2 isaki * "+" in following list indicates the interfaces which necessary to be
97 1.2 isaki * protected by sc_exlock.
98 1.2 isaki *
99 1.2 isaki * List of hardware interface methods, and which locks are held when each
100 1.2 isaki * is called by this module:
101 1.2 isaki *
102 1.2 isaki * METHOD INTR THREAD NOTES
103 1.2 isaki * ----------------------- ------- ------- -------------------------
104 1.2 isaki * open x x +
105 1.2 isaki * close x x +
106 1.2 isaki * query_format - x
107 1.2 isaki * set_format - x
108 1.2 isaki * round_blocksize - x
109 1.2 isaki * commit_settings - x
110 1.2 isaki * init_output x x
111 1.2 isaki * init_input x x
112 1.2 isaki * start_output x x +
113 1.2 isaki * start_input x x +
114 1.2 isaki * halt_output x x +
115 1.2 isaki * halt_input x x +
116 1.2 isaki * speaker_ctl x x
117 1.2 isaki * getdev - x
118 1.2 isaki * set_port - x +
119 1.2 isaki * get_port - x +
120 1.2 isaki * query_devinfo - x
121 1.28.2.12 martin * allocm - - +
122 1.28.2.12 martin * freem - - +
123 1.2 isaki * round_buffersize - x
124 1.14 isaki * get_props - x Called at attach time
125 1.2 isaki * trigger_output x x +
126 1.2 isaki * trigger_input x x +
127 1.2 isaki * dev_ioctl - x
128 1.2 isaki * get_locks - - Called at attach time
129 1.2 isaki *
130 1.9 isaki * In addition, there is an additional lock.
131 1.2 isaki *
132 1.2 isaki * - track->lock. This is an atomic variable and is similar to the
133 1.2 isaki * "interrupt lock". This is one for each track. If any thread context
134 1.2 isaki * (and software interrupt context) and hardware interrupt context who
135 1.2 isaki * want to access some variables on this track, they must acquire this
136 1.2 isaki * lock before. It protects track's consistency between hardware
137 1.2 isaki * interrupt context and others.
138 1.2 isaki */
139 1.2 isaki
140 1.2 isaki #include <sys/cdefs.h>
141 1.28.2.17 martin __KERNEL_RCSID(0, "$NetBSD: audio.c,v 1.28.2.17 2020/12/19 13:48:27 martin Exp $");
142 1.2 isaki
143 1.2 isaki #ifdef _KERNEL_OPT
144 1.2 isaki #include "audio.h"
145 1.2 isaki #include "midi.h"
146 1.2 isaki #endif
147 1.2 isaki
148 1.2 isaki #if NAUDIO > 0
149 1.2 isaki
150 1.2 isaki #ifdef _KERNEL
151 1.2 isaki
152 1.2 isaki #include <sys/types.h>
153 1.2 isaki #include <sys/param.h>
154 1.2 isaki #include <sys/atomic.h>
155 1.2 isaki #include <sys/audioio.h>
156 1.2 isaki #include <sys/conf.h>
157 1.2 isaki #include <sys/cpu.h>
158 1.2 isaki #include <sys/device.h>
159 1.2 isaki #include <sys/fcntl.h>
160 1.2 isaki #include <sys/file.h>
161 1.2 isaki #include <sys/filedesc.h>
162 1.2 isaki #include <sys/intr.h>
163 1.2 isaki #include <sys/ioctl.h>
164 1.2 isaki #include <sys/kauth.h>
165 1.2 isaki #include <sys/kernel.h>
166 1.2 isaki #include <sys/kmem.h>
167 1.2 isaki #include <sys/malloc.h>
168 1.2 isaki #include <sys/mman.h>
169 1.2 isaki #include <sys/module.h>
170 1.2 isaki #include <sys/poll.h>
171 1.2 isaki #include <sys/proc.h>
172 1.2 isaki #include <sys/queue.h>
173 1.2 isaki #include <sys/select.h>
174 1.2 isaki #include <sys/signalvar.h>
175 1.2 isaki #include <sys/stat.h>
176 1.2 isaki #include <sys/sysctl.h>
177 1.2 isaki #include <sys/systm.h>
178 1.2 isaki #include <sys/syslog.h>
179 1.2 isaki #include <sys/vnode.h>
180 1.2 isaki
181 1.2 isaki #include <dev/audio/audio_if.h>
182 1.2 isaki #include <dev/audio/audiovar.h>
183 1.2 isaki #include <dev/audio/audiodef.h>
184 1.2 isaki #include <dev/audio/linear.h>
185 1.2 isaki #include <dev/audio/mulaw.h>
186 1.2 isaki
187 1.2 isaki #include <machine/endian.h>
188 1.2 isaki
189 1.2 isaki #include <uvm/uvm.h>
190 1.2 isaki
191 1.2 isaki #include "ioconf.h"
192 1.2 isaki #endif /* _KERNEL */
193 1.2 isaki
194 1.2 isaki /*
195 1.2 isaki * 0: No debug logs
196 1.2 isaki * 1: action changes like open/close/set_format...
197 1.2 isaki * 2: + normal operations like read/write/ioctl...
198 1.2 isaki * 3: + TRACEs except interrupt
199 1.2 isaki * 4: + TRACEs including interrupt
200 1.2 isaki */
201 1.2 isaki //#define AUDIO_DEBUG 1
202 1.2 isaki
203 1.2 isaki #if defined(AUDIO_DEBUG)
204 1.2 isaki
205 1.2 isaki int audiodebug = AUDIO_DEBUG;
206 1.2 isaki static void audio_vtrace(struct audio_softc *sc, const char *, const char *,
207 1.2 isaki const char *, va_list);
208 1.2 isaki static void audio_trace(struct audio_softc *sc, const char *, const char *, ...)
209 1.2 isaki __printflike(3, 4);
210 1.2 isaki static void audio_tracet(const char *, audio_track_t *, const char *, ...)
211 1.2 isaki __printflike(3, 4);
212 1.2 isaki static void audio_tracef(const char *, audio_file_t *, const char *, ...)
213 1.2 isaki __printflike(3, 4);
214 1.2 isaki
215 1.2 isaki /* XXX sloppy memory logger */
216 1.2 isaki static void audio_mlog_init(void);
217 1.2 isaki static void audio_mlog_free(void);
218 1.2 isaki static void audio_mlog_softintr(void *);
219 1.2 isaki extern void audio_mlog_flush(void);
220 1.2 isaki extern void audio_mlog_printf(const char *, ...);
221 1.2 isaki
222 1.2 isaki static int mlog_refs; /* reference counter */
223 1.2 isaki static char *mlog_buf[2]; /* double buffer */
224 1.2 isaki static int mlog_buflen; /* buffer length */
225 1.2 isaki static int mlog_used; /* used length */
226 1.2 isaki static int mlog_full; /* number of dropped lines by buffer full */
227 1.2 isaki static int mlog_drop; /* number of dropped lines by busy */
228 1.2 isaki static volatile uint32_t mlog_inuse; /* in-use */
229 1.2 isaki static int mlog_wpage; /* active page */
230 1.2 isaki static void *mlog_sih; /* softint handle */
231 1.2 isaki
232 1.2 isaki static void
233 1.2 isaki audio_mlog_init(void)
234 1.2 isaki {
235 1.2 isaki mlog_refs++;
236 1.2 isaki if (mlog_refs > 1)
237 1.2 isaki return;
238 1.2 isaki mlog_buflen = 4096;
239 1.2 isaki mlog_buf[0] = kmem_zalloc(mlog_buflen, KM_SLEEP);
240 1.2 isaki mlog_buf[1] = kmem_zalloc(mlog_buflen, KM_SLEEP);
241 1.2 isaki mlog_used = 0;
242 1.2 isaki mlog_full = 0;
243 1.2 isaki mlog_drop = 0;
244 1.2 isaki mlog_inuse = 0;
245 1.2 isaki mlog_wpage = 0;
246 1.2 isaki mlog_sih = softint_establish(SOFTINT_SERIAL, audio_mlog_softintr, NULL);
247 1.2 isaki if (mlog_sih == NULL)
248 1.2 isaki printf("%s: softint_establish failed\n", __func__);
249 1.2 isaki }
250 1.2 isaki
251 1.2 isaki static void
252 1.2 isaki audio_mlog_free(void)
253 1.2 isaki {
254 1.2 isaki mlog_refs--;
255 1.2 isaki if (mlog_refs > 0)
256 1.2 isaki return;
257 1.2 isaki
258 1.2 isaki audio_mlog_flush();
259 1.2 isaki if (mlog_sih)
260 1.2 isaki softint_disestablish(mlog_sih);
261 1.2 isaki kmem_free(mlog_buf[0], mlog_buflen);
262 1.2 isaki kmem_free(mlog_buf[1], mlog_buflen);
263 1.2 isaki }
264 1.2 isaki
265 1.2 isaki /*
266 1.2 isaki * Flush memory buffer.
267 1.2 isaki * It must not be called from hardware interrupt context.
268 1.2 isaki */
269 1.2 isaki void
270 1.2 isaki audio_mlog_flush(void)
271 1.2 isaki {
272 1.2 isaki if (mlog_refs == 0)
273 1.2 isaki return;
274 1.2 isaki
275 1.2 isaki /* Nothing to do if already in use ? */
276 1.2 isaki if (atomic_swap_32(&mlog_inuse, 1) == 1)
277 1.2 isaki return;
278 1.2 isaki
279 1.2 isaki int rpage = mlog_wpage;
280 1.2 isaki mlog_wpage ^= 1;
281 1.2 isaki mlog_buf[mlog_wpage][0] = '\0';
282 1.2 isaki mlog_used = 0;
283 1.2 isaki
284 1.2 isaki atomic_swap_32(&mlog_inuse, 0);
285 1.2 isaki
286 1.2 isaki if (mlog_buf[rpage][0] != '\0') {
287 1.2 isaki printf("%s", mlog_buf[rpage]);
288 1.2 isaki if (mlog_drop > 0)
289 1.2 isaki printf("mlog_drop %d\n", mlog_drop);
290 1.2 isaki if (mlog_full > 0)
291 1.2 isaki printf("mlog_full %d\n", mlog_full);
292 1.2 isaki }
293 1.2 isaki mlog_full = 0;
294 1.2 isaki mlog_drop = 0;
295 1.2 isaki }
296 1.2 isaki
297 1.2 isaki static void
298 1.2 isaki audio_mlog_softintr(void *cookie)
299 1.2 isaki {
300 1.2 isaki audio_mlog_flush();
301 1.2 isaki }
302 1.2 isaki
303 1.2 isaki void
304 1.2 isaki audio_mlog_printf(const char *fmt, ...)
305 1.2 isaki {
306 1.2 isaki int len;
307 1.2 isaki va_list ap;
308 1.2 isaki
309 1.2 isaki if (atomic_swap_32(&mlog_inuse, 1) == 1) {
310 1.2 isaki /* already inuse */
311 1.2 isaki mlog_drop++;
312 1.2 isaki return;
313 1.2 isaki }
314 1.2 isaki
315 1.2 isaki va_start(ap, fmt);
316 1.2 isaki len = vsnprintf(
317 1.2 isaki mlog_buf[mlog_wpage] + mlog_used,
318 1.2 isaki mlog_buflen - mlog_used,
319 1.2 isaki fmt, ap);
320 1.2 isaki va_end(ap);
321 1.2 isaki
322 1.2 isaki mlog_used += len;
323 1.2 isaki if (mlog_buflen - mlog_used <= 1) {
324 1.2 isaki mlog_full++;
325 1.2 isaki }
326 1.2 isaki
327 1.2 isaki atomic_swap_32(&mlog_inuse, 0);
328 1.2 isaki
329 1.2 isaki if (mlog_sih)
330 1.2 isaki softint_schedule(mlog_sih);
331 1.2 isaki }
332 1.2 isaki
333 1.2 isaki /* trace functions */
334 1.2 isaki static void
335 1.2 isaki audio_vtrace(struct audio_softc *sc, const char *funcname, const char *header,
336 1.2 isaki const char *fmt, va_list ap)
337 1.2 isaki {
338 1.2 isaki char buf[256];
339 1.2 isaki int n;
340 1.2 isaki
341 1.2 isaki n = 0;
342 1.2 isaki buf[0] = '\0';
343 1.2 isaki n += snprintf(buf + n, sizeof(buf) - n, "%s@%d %s",
344 1.2 isaki funcname, device_unit(sc->sc_dev), header);
345 1.2 isaki n += vsnprintf(buf + n, sizeof(buf) - n, fmt, ap);
346 1.2 isaki
347 1.2 isaki if (cpu_intr_p()) {
348 1.2 isaki audio_mlog_printf("%s\n", buf);
349 1.2 isaki } else {
350 1.2 isaki audio_mlog_flush();
351 1.2 isaki printf("%s\n", buf);
352 1.2 isaki }
353 1.2 isaki }
354 1.2 isaki
355 1.2 isaki static void
356 1.2 isaki audio_trace(struct audio_softc *sc, const char *funcname, const char *fmt, ...)
357 1.2 isaki {
358 1.2 isaki va_list ap;
359 1.2 isaki
360 1.2 isaki va_start(ap, fmt);
361 1.2 isaki audio_vtrace(sc, funcname, "", fmt, ap);
362 1.2 isaki va_end(ap);
363 1.2 isaki }
364 1.2 isaki
365 1.2 isaki static void
366 1.2 isaki audio_tracet(const char *funcname, audio_track_t *track, const char *fmt, ...)
367 1.2 isaki {
368 1.2 isaki char hdr[16];
369 1.2 isaki va_list ap;
370 1.2 isaki
371 1.2 isaki snprintf(hdr, sizeof(hdr), "#%d ", track->id);
372 1.2 isaki va_start(ap, fmt);
373 1.2 isaki audio_vtrace(track->mixer->sc, funcname, hdr, fmt, ap);
374 1.2 isaki va_end(ap);
375 1.2 isaki }
376 1.2 isaki
377 1.2 isaki static void
378 1.2 isaki audio_tracef(const char *funcname, audio_file_t *file, const char *fmt, ...)
379 1.2 isaki {
380 1.2 isaki char hdr[32];
381 1.2 isaki char phdr[16], rhdr[16];
382 1.2 isaki va_list ap;
383 1.2 isaki
384 1.2 isaki phdr[0] = '\0';
385 1.2 isaki rhdr[0] = '\0';
386 1.2 isaki if (file->ptrack)
387 1.2 isaki snprintf(phdr, sizeof(phdr), "#%d", file->ptrack->id);
388 1.2 isaki if (file->rtrack)
389 1.2 isaki snprintf(rhdr, sizeof(rhdr), "#%d", file->rtrack->id);
390 1.2 isaki snprintf(hdr, sizeof(hdr), "{%s,%s} ", phdr, rhdr);
391 1.2 isaki
392 1.2 isaki va_start(ap, fmt);
393 1.2 isaki audio_vtrace(file->sc, funcname, hdr, fmt, ap);
394 1.2 isaki va_end(ap);
395 1.2 isaki }
396 1.2 isaki
397 1.2 isaki #define DPRINTF(n, fmt...) do { \
398 1.2 isaki if (audiodebug >= (n)) { \
399 1.2 isaki audio_mlog_flush(); \
400 1.2 isaki printf(fmt); \
401 1.2 isaki } \
402 1.2 isaki } while (0)
403 1.2 isaki #define TRACE(n, fmt...) do { \
404 1.2 isaki if (audiodebug >= (n)) audio_trace(sc, __func__, fmt); \
405 1.2 isaki } while (0)
406 1.2 isaki #define TRACET(n, t, fmt...) do { \
407 1.2 isaki if (audiodebug >= (n)) audio_tracet(__func__, t, fmt); \
408 1.2 isaki } while (0)
409 1.2 isaki #define TRACEF(n, f, fmt...) do { \
410 1.2 isaki if (audiodebug >= (n)) audio_tracef(__func__, f, fmt); \
411 1.2 isaki } while (0)
412 1.2 isaki
413 1.2 isaki struct audio_track_debugbuf {
414 1.2 isaki char usrbuf[32];
415 1.2 isaki char codec[32];
416 1.2 isaki char chvol[32];
417 1.2 isaki char chmix[32];
418 1.2 isaki char freq[32];
419 1.2 isaki char outbuf[32];
420 1.2 isaki };
421 1.2 isaki
422 1.2 isaki static void
423 1.2 isaki audio_track_bufstat(audio_track_t *track, struct audio_track_debugbuf *buf)
424 1.2 isaki {
425 1.2 isaki
426 1.2 isaki memset(buf, 0, sizeof(*buf));
427 1.2 isaki
428 1.2 isaki snprintf(buf->outbuf, sizeof(buf->outbuf), " out=%d/%d/%d",
429 1.2 isaki track->outbuf.head, track->outbuf.used, track->outbuf.capacity);
430 1.2 isaki if (track->freq.filter)
431 1.2 isaki snprintf(buf->freq, sizeof(buf->freq), " f=%d/%d/%d",
432 1.2 isaki track->freq.srcbuf.head,
433 1.2 isaki track->freq.srcbuf.used,
434 1.2 isaki track->freq.srcbuf.capacity);
435 1.2 isaki if (track->chmix.filter)
436 1.2 isaki snprintf(buf->chmix, sizeof(buf->chmix), " m=%d",
437 1.2 isaki track->chmix.srcbuf.used);
438 1.2 isaki if (track->chvol.filter)
439 1.2 isaki snprintf(buf->chvol, sizeof(buf->chvol), " v=%d",
440 1.2 isaki track->chvol.srcbuf.used);
441 1.2 isaki if (track->codec.filter)
442 1.2 isaki snprintf(buf->codec, sizeof(buf->codec), " e=%d",
443 1.2 isaki track->codec.srcbuf.used);
444 1.2 isaki snprintf(buf->usrbuf, sizeof(buf->usrbuf), " usr=%d/%d/H%d",
445 1.2 isaki track->usrbuf.head, track->usrbuf.used, track->usrbuf_usedhigh);
446 1.2 isaki }
447 1.2 isaki #else
448 1.2 isaki #define DPRINTF(n, fmt...) do { } while (0)
449 1.2 isaki #define TRACE(n, fmt, ...) do { } while (0)
450 1.2 isaki #define TRACET(n, t, fmt, ...) do { } while (0)
451 1.2 isaki #define TRACEF(n, f, fmt, ...) do { } while (0)
452 1.2 isaki #endif
453 1.2 isaki
454 1.2 isaki #define SPECIFIED(x) ((x) != ~0)
455 1.2 isaki #define SPECIFIED_CH(x) ((x) != (u_char)~0)
456 1.2 isaki
457 1.28.2.15 martin /*
458 1.28.2.15 martin * Default hardware blocksize in msec.
459 1.28.2.15 martin *
460 1.28.2.15 martin * We use 10 msec for most modern platforms. This period is good enough to
461 1.28.2.15 martin * play audio and video synchronizely.
462 1.28.2.15 martin * In contrast, for very old platforms, this is usually too short and too
463 1.28.2.15 martin * severe. Also such platforms usually can not play video confortably, so
464 1.28.2.15 martin * it's not so important to make the blocksize shorter. If the platform
465 1.28.2.15 martin * defines its own value as __AUDIO_BLK_MS in its <machine/param.h>, it
466 1.28.2.15 martin * uses this instead.
467 1.28.2.15 martin *
468 1.28.2.15 martin * In either case, you can overwrite AUDIO_BLK_MS by your kernel
469 1.28.2.15 martin * configuration file if you wish.
470 1.28.2.15 martin */
471 1.28.2.15 martin #if !defined(AUDIO_BLK_MS)
472 1.28.2.15 martin # if defined(__AUDIO_BLK_MS)
473 1.28.2.15 martin # define AUDIO_BLK_MS __AUDIO_BLK_MS
474 1.28.2.15 martin # else
475 1.28.2.15 martin # define AUDIO_BLK_MS (10)
476 1.28.2.15 martin # endif
477 1.28.2.15 martin #endif
478 1.28.2.15 martin
479 1.2 isaki /* Device timeout in msec */
480 1.2 isaki #define AUDIO_TIMEOUT (3000)
481 1.2 isaki
482 1.2 isaki /* #define AUDIO_PM_IDLE */
483 1.2 isaki #ifdef AUDIO_PM_IDLE
484 1.2 isaki int audio_idle_timeout = 30;
485 1.2 isaki #endif
486 1.2 isaki
487 1.28.2.12 martin /* Number of elements of async mixer's pid */
488 1.28.2.12 martin #define AM_CAPACITY (4)
489 1.28.2.12 martin
490 1.2 isaki struct portname {
491 1.2 isaki const char *name;
492 1.2 isaki int mask;
493 1.2 isaki };
494 1.2 isaki
495 1.2 isaki static int audiomatch(device_t, cfdata_t, void *);
496 1.2 isaki static void audioattach(device_t, device_t, void *);
497 1.2 isaki static int audiodetach(device_t, int);
498 1.2 isaki static int audioactivate(device_t, enum devact);
499 1.2 isaki static void audiochilddet(device_t, device_t);
500 1.2 isaki static int audiorescan(device_t, const char *, const int *);
501 1.2 isaki
502 1.2 isaki static int audio_modcmd(modcmd_t, void *);
503 1.2 isaki
504 1.2 isaki #ifdef AUDIO_PM_IDLE
505 1.2 isaki static void audio_idle(void *);
506 1.2 isaki static void audio_activity(device_t, devactive_t);
507 1.2 isaki #endif
508 1.2 isaki
509 1.2 isaki static bool audio_suspend(device_t dv, const pmf_qual_t *);
510 1.2 isaki static bool audio_resume(device_t dv, const pmf_qual_t *);
511 1.2 isaki static void audio_volume_down(device_t);
512 1.2 isaki static void audio_volume_up(device_t);
513 1.2 isaki static void audio_volume_toggle(device_t);
514 1.2 isaki
515 1.2 isaki static void audio_mixer_capture(struct audio_softc *);
516 1.2 isaki static void audio_mixer_restore(struct audio_softc *);
517 1.2 isaki
518 1.2 isaki static void audio_softintr_rd(void *);
519 1.2 isaki static void audio_softintr_wr(void *);
520 1.2 isaki
521 1.28.2.12 martin static int audio_exlock_mutex_enter(struct audio_softc *);
522 1.28.2.12 martin static void audio_exlock_mutex_exit(struct audio_softc *);
523 1.28.2.12 martin static int audio_exlock_enter(struct audio_softc *);
524 1.28.2.12 martin static void audio_exlock_exit(struct audio_softc *);
525 1.28.2.9 martin static struct audio_softc *audio_file_enter(audio_file_t *, struct psref *);
526 1.28.2.9 martin static void audio_file_exit(struct audio_softc *, struct psref *);
527 1.2 isaki static int audio_track_waitio(struct audio_softc *, audio_track_t *);
528 1.2 isaki
529 1.2 isaki static int audioclose(struct file *);
530 1.2 isaki static int audioread(struct file *, off_t *, struct uio *, kauth_cred_t, int);
531 1.2 isaki static int audiowrite(struct file *, off_t *, struct uio *, kauth_cred_t, int);
532 1.2 isaki static int audioioctl(struct file *, u_long, void *);
533 1.2 isaki static int audiopoll(struct file *, int);
534 1.2 isaki static int audiokqfilter(struct file *, struct knote *);
535 1.2 isaki static int audiommap(struct file *, off_t *, size_t, int, int *, int *,
536 1.2 isaki struct uvm_object **, int *);
537 1.2 isaki static int audiostat(struct file *, struct stat *);
538 1.2 isaki
539 1.2 isaki static void filt_audiowrite_detach(struct knote *);
540 1.2 isaki static int filt_audiowrite_event(struct knote *, long);
541 1.2 isaki static void filt_audioread_detach(struct knote *);
542 1.2 isaki static int filt_audioread_event(struct knote *, long);
543 1.2 isaki
544 1.2 isaki static int audio_open(dev_t, struct audio_softc *, int, int, struct lwp *,
545 1.21 isaki audio_file_t **);
546 1.2 isaki static int audio_close(struct audio_softc *, audio_file_t *);
547 1.28.2.9 martin static int audio_unlink(struct audio_softc *, audio_file_t *);
548 1.2 isaki static int audio_read(struct audio_softc *, struct uio *, int, audio_file_t *);
549 1.2 isaki static int audio_write(struct audio_softc *, struct uio *, int, audio_file_t *);
550 1.2 isaki static void audio_file_clear(struct audio_softc *, audio_file_t *);
551 1.2 isaki static int audio_ioctl(dev_t, struct audio_softc *, u_long, void *, int,
552 1.2 isaki struct lwp *, audio_file_t *);
553 1.2 isaki static int audio_poll(struct audio_softc *, int, struct lwp *, audio_file_t *);
554 1.2 isaki static int audio_kqfilter(struct audio_softc *, audio_file_t *, struct knote *);
555 1.2 isaki static int audio_mmap(struct audio_softc *, off_t *, size_t, int, int *, int *,
556 1.2 isaki struct uvm_object **, int *, audio_file_t *);
557 1.2 isaki
558 1.2 isaki static int audioctl_open(dev_t, struct audio_softc *, int, int, struct lwp *);
559 1.2 isaki
560 1.2 isaki static void audio_pintr(void *);
561 1.2 isaki static void audio_rintr(void *);
562 1.2 isaki
563 1.2 isaki static int audio_query_devinfo(struct audio_softc *, mixer_devinfo_t *);
564 1.2 isaki
565 1.2 isaki static __inline int audio_track_readablebytes(const audio_track_t *);
566 1.2 isaki static int audio_file_setinfo(struct audio_softc *, audio_file_t *,
567 1.2 isaki const struct audio_info *);
568 1.28.2.11 martin static int audio_track_setinfo_check(audio_track_t *,
569 1.28.2.11 martin audio_format2_t *, const struct audio_prinfo *);
570 1.2 isaki static void audio_track_setinfo_water(audio_track_t *,
571 1.2 isaki const struct audio_info *);
572 1.2 isaki static int audio_hw_setinfo(struct audio_softc *, const struct audio_info *,
573 1.2 isaki struct audio_info *);
574 1.2 isaki static int audio_hw_set_format(struct audio_softc *, int,
575 1.2 isaki audio_format2_t *, audio_format2_t *,
576 1.2 isaki audio_filter_reg_t *, audio_filter_reg_t *);
577 1.2 isaki static int audiogetinfo(struct audio_softc *, struct audio_info *, int,
578 1.2 isaki audio_file_t *);
579 1.2 isaki static bool audio_can_playback(struct audio_softc *);
580 1.2 isaki static bool audio_can_capture(struct audio_softc *);
581 1.2 isaki static int audio_check_params(audio_format2_t *);
582 1.2 isaki static int audio_mixers_init(struct audio_softc *sc, int,
583 1.2 isaki const audio_format2_t *, const audio_format2_t *,
584 1.2 isaki const audio_filter_reg_t *, const audio_filter_reg_t *);
585 1.2 isaki static int audio_select_freq(const struct audio_format *);
586 1.28.2.12 martin static int audio_hw_probe(struct audio_softc *, audio_format2_t *, int);
587 1.2 isaki static int audio_hw_validate_format(struct audio_softc *, int,
588 1.2 isaki const audio_format2_t *);
589 1.2 isaki static int audio_mixers_set_format(struct audio_softc *,
590 1.2 isaki const struct audio_info *);
591 1.2 isaki static void audio_mixers_get_format(struct audio_softc *, struct audio_info *);
592 1.2 isaki static int audio_sysctl_blk_ms(SYSCTLFN_PROTO);
593 1.2 isaki static int audio_sysctl_multiuser(SYSCTLFN_PROTO);
594 1.2 isaki #if defined(AUDIO_DEBUG)
595 1.2 isaki static int audio_sysctl_debug(SYSCTLFN_PROTO);
596 1.2 isaki static void audio_format2_tostr(char *, size_t, const audio_format2_t *);
597 1.2 isaki static void audio_print_format2(const char *, const audio_format2_t *) __unused;
598 1.2 isaki #endif
599 1.2 isaki
600 1.2 isaki static void *audio_realloc(void *, size_t);
601 1.2 isaki static int audio_realloc_usrbuf(audio_track_t *, int);
602 1.2 isaki static void audio_free_usrbuf(audio_track_t *);
603 1.2 isaki
604 1.2 isaki static audio_track_t *audio_track_create(struct audio_softc *,
605 1.2 isaki audio_trackmixer_t *);
606 1.2 isaki static void audio_track_destroy(audio_track_t *);
607 1.2 isaki static audio_filter_t audio_track_get_codec(audio_track_t *,
608 1.2 isaki const audio_format2_t *, const audio_format2_t *);
609 1.2 isaki static int audio_track_set_format(audio_track_t *, audio_format2_t *);
610 1.2 isaki static void audio_track_play(audio_track_t *);
611 1.2 isaki static int audio_track_drain(struct audio_softc *, audio_track_t *);
612 1.2 isaki static void audio_track_record(audio_track_t *);
613 1.2 isaki static void audio_track_clear(struct audio_softc *, audio_track_t *);
614 1.2 isaki
615 1.2 isaki static int audio_mixer_init(struct audio_softc *, int,
616 1.2 isaki const audio_format2_t *, const audio_filter_reg_t *);
617 1.2 isaki static void audio_mixer_destroy(struct audio_softc *, audio_trackmixer_t *);
618 1.2 isaki static void audio_pmixer_start(struct audio_softc *, bool);
619 1.2 isaki static void audio_pmixer_process(struct audio_softc *);
620 1.23 isaki static void audio_pmixer_agc(audio_trackmixer_t *, int);
621 1.2 isaki static int audio_pmixer_mix_track(audio_trackmixer_t *, audio_track_t *, int);
622 1.2 isaki static void audio_pmixer_output(struct audio_softc *);
623 1.2 isaki static int audio_pmixer_halt(struct audio_softc *);
624 1.2 isaki static void audio_rmixer_start(struct audio_softc *);
625 1.2 isaki static void audio_rmixer_process(struct audio_softc *);
626 1.2 isaki static void audio_rmixer_input(struct audio_softc *);
627 1.2 isaki static int audio_rmixer_halt(struct audio_softc *);
628 1.2 isaki
629 1.2 isaki static void mixer_init(struct audio_softc *);
630 1.2 isaki static int mixer_open(dev_t, struct audio_softc *, int, int, struct lwp *);
631 1.2 isaki static int mixer_close(struct audio_softc *, audio_file_t *);
632 1.2 isaki static int mixer_ioctl(struct audio_softc *, u_long, void *, int, struct lwp *);
633 1.28.2.12 martin static void mixer_async_add(struct audio_softc *, pid_t);
634 1.28.2.12 martin static void mixer_async_remove(struct audio_softc *, pid_t);
635 1.2 isaki static void mixer_signal(struct audio_softc *);
636 1.2 isaki
637 1.2 isaki static int au_portof(struct audio_softc *, char *, int);
638 1.2 isaki
639 1.2 isaki static void au_setup_ports(struct audio_softc *, struct au_mixer_ports *,
640 1.2 isaki mixer_devinfo_t *, const struct portname *);
641 1.2 isaki static int au_set_lr_value(struct audio_softc *, mixer_ctrl_t *, int, int);
642 1.2 isaki static int au_get_lr_value(struct audio_softc *, mixer_ctrl_t *, int *, int *);
643 1.2 isaki static int au_set_gain(struct audio_softc *, struct au_mixer_ports *, int, int);
644 1.2 isaki static void au_get_gain(struct audio_softc *, struct au_mixer_ports *,
645 1.2 isaki u_int *, u_char *);
646 1.2 isaki static int au_set_port(struct audio_softc *, struct au_mixer_ports *, u_int);
647 1.2 isaki static int au_get_port(struct audio_softc *, struct au_mixer_ports *);
648 1.2 isaki static int au_set_monitor_gain(struct audio_softc *, int);
649 1.2 isaki static int au_get_monitor_gain(struct audio_softc *);
650 1.2 isaki static int audio_get_port(struct audio_softc *, mixer_ctrl_t *);
651 1.2 isaki static int audio_set_port(struct audio_softc *, mixer_ctrl_t *);
652 1.2 isaki
653 1.2 isaki static __inline struct audio_params
654 1.2 isaki format2_to_params(const audio_format2_t *f2)
655 1.2 isaki {
656 1.2 isaki audio_params_t p;
657 1.2 isaki
658 1.2 isaki /* validbits/precision <-> precision/stride */
659 1.2 isaki p.sample_rate = f2->sample_rate;
660 1.2 isaki p.channels = f2->channels;
661 1.2 isaki p.encoding = f2->encoding;
662 1.2 isaki p.validbits = f2->precision;
663 1.2 isaki p.precision = f2->stride;
664 1.2 isaki return p;
665 1.2 isaki }
666 1.2 isaki
667 1.2 isaki static __inline audio_format2_t
668 1.2 isaki params_to_format2(const struct audio_params *p)
669 1.2 isaki {
670 1.2 isaki audio_format2_t f2;
671 1.2 isaki
672 1.2 isaki /* precision/stride <-> validbits/precision */
673 1.2 isaki f2.sample_rate = p->sample_rate;
674 1.2 isaki f2.channels = p->channels;
675 1.2 isaki f2.encoding = p->encoding;
676 1.2 isaki f2.precision = p->validbits;
677 1.2 isaki f2.stride = p->precision;
678 1.2 isaki return f2;
679 1.2 isaki }
680 1.2 isaki
681 1.2 isaki /* Return true if this track is a playback track. */
682 1.2 isaki static __inline bool
683 1.2 isaki audio_track_is_playback(const audio_track_t *track)
684 1.2 isaki {
685 1.2 isaki
686 1.2 isaki return ((track->mode & AUMODE_PLAY) != 0);
687 1.2 isaki }
688 1.2 isaki
689 1.2 isaki /* Return true if this track is a recording track. */
690 1.2 isaki static __inline bool
691 1.2 isaki audio_track_is_record(const audio_track_t *track)
692 1.2 isaki {
693 1.2 isaki
694 1.2 isaki return ((track->mode & AUMODE_RECORD) != 0);
695 1.2 isaki }
696 1.2 isaki
697 1.2 isaki #if 0 /* XXX Not used yet */
698 1.2 isaki /*
699 1.2 isaki * Convert 0..255 volume used in userland to internal presentation 0..256.
700 1.2 isaki */
701 1.2 isaki static __inline u_int
702 1.2 isaki audio_volume_to_inner(u_int v)
703 1.2 isaki {
704 1.2 isaki
705 1.2 isaki return v < 127 ? v : v + 1;
706 1.2 isaki }
707 1.2 isaki
708 1.2 isaki /*
709 1.2 isaki * Convert 0..256 internal presentation to 0..255 volume used in userland.
710 1.2 isaki */
711 1.2 isaki static __inline u_int
712 1.2 isaki audio_volume_to_outer(u_int v)
713 1.2 isaki {
714 1.2 isaki
715 1.2 isaki return v < 127 ? v : v - 1;
716 1.2 isaki }
717 1.2 isaki #endif /* 0 */
718 1.2 isaki
719 1.2 isaki static dev_type_open(audioopen);
720 1.2 isaki /* XXXMRG use more dev_type_xxx */
721 1.2 isaki
722 1.2 isaki const struct cdevsw audio_cdevsw = {
723 1.2 isaki .d_open = audioopen,
724 1.2 isaki .d_close = noclose,
725 1.2 isaki .d_read = noread,
726 1.2 isaki .d_write = nowrite,
727 1.2 isaki .d_ioctl = noioctl,
728 1.2 isaki .d_stop = nostop,
729 1.2 isaki .d_tty = notty,
730 1.2 isaki .d_poll = nopoll,
731 1.2 isaki .d_mmap = nommap,
732 1.2 isaki .d_kqfilter = nokqfilter,
733 1.2 isaki .d_discard = nodiscard,
734 1.2 isaki .d_flag = D_OTHER | D_MPSAFE
735 1.2 isaki };
736 1.2 isaki
737 1.2 isaki const struct fileops audio_fileops = {
738 1.2 isaki .fo_name = "audio",
739 1.2 isaki .fo_read = audioread,
740 1.2 isaki .fo_write = audiowrite,
741 1.2 isaki .fo_ioctl = audioioctl,
742 1.2 isaki .fo_fcntl = fnullop_fcntl,
743 1.2 isaki .fo_stat = audiostat,
744 1.2 isaki .fo_poll = audiopoll,
745 1.2 isaki .fo_close = audioclose,
746 1.2 isaki .fo_mmap = audiommap,
747 1.2 isaki .fo_kqfilter = audiokqfilter,
748 1.2 isaki .fo_restart = fnullop_restart
749 1.2 isaki };
750 1.2 isaki
751 1.2 isaki /* The default audio mode: 8 kHz mono mu-law */
752 1.2 isaki static const struct audio_params audio_default = {
753 1.2 isaki .sample_rate = 8000,
754 1.2 isaki .encoding = AUDIO_ENCODING_ULAW,
755 1.2 isaki .precision = 8,
756 1.2 isaki .validbits = 8,
757 1.2 isaki .channels = 1,
758 1.2 isaki };
759 1.2 isaki
760 1.2 isaki static const char *encoding_names[] = {
761 1.2 isaki "none",
762 1.2 isaki AudioEmulaw,
763 1.2 isaki AudioEalaw,
764 1.2 isaki "pcm16",
765 1.2 isaki "pcm8",
766 1.2 isaki AudioEadpcm,
767 1.2 isaki AudioEslinear_le,
768 1.2 isaki AudioEslinear_be,
769 1.2 isaki AudioEulinear_le,
770 1.2 isaki AudioEulinear_be,
771 1.2 isaki AudioEslinear,
772 1.2 isaki AudioEulinear,
773 1.2 isaki AudioEmpeg_l1_stream,
774 1.2 isaki AudioEmpeg_l1_packets,
775 1.2 isaki AudioEmpeg_l1_system,
776 1.2 isaki AudioEmpeg_l2_stream,
777 1.2 isaki AudioEmpeg_l2_packets,
778 1.2 isaki AudioEmpeg_l2_system,
779 1.2 isaki AudioEac3,
780 1.2 isaki };
781 1.2 isaki
782 1.2 isaki /*
783 1.2 isaki * Returns encoding name corresponding to AUDIO_ENCODING_*.
784 1.2 isaki * Note that it may return a local buffer because it is mainly for debugging.
785 1.2 isaki */
786 1.2 isaki const char *
787 1.2 isaki audio_encoding_name(int encoding)
788 1.2 isaki {
789 1.2 isaki static char buf[16];
790 1.2 isaki
791 1.2 isaki if (0 <= encoding && encoding < __arraycount(encoding_names)) {
792 1.2 isaki return encoding_names[encoding];
793 1.2 isaki } else {
794 1.2 isaki snprintf(buf, sizeof(buf), "enc=%d", encoding);
795 1.2 isaki return buf;
796 1.2 isaki }
797 1.2 isaki }
798 1.2 isaki
799 1.2 isaki /*
800 1.2 isaki * Supported encodings used by AUDIO_GETENC.
801 1.2 isaki * index and flags are set by code.
802 1.2 isaki * XXX is there any needs for SLINEAR_OE:>=16/ULINEAR_OE:>=16 ?
803 1.2 isaki */
804 1.2 isaki static const audio_encoding_t audio_encodings[] = {
805 1.2 isaki { 0, AudioEmulaw, AUDIO_ENCODING_ULAW, 8, 0 },
806 1.2 isaki { 0, AudioEalaw, AUDIO_ENCODING_ALAW, 8, 0 },
807 1.2 isaki { 0, AudioEslinear, AUDIO_ENCODING_SLINEAR, 8, 0 },
808 1.2 isaki { 0, AudioEulinear, AUDIO_ENCODING_ULINEAR, 8, 0 },
809 1.2 isaki { 0, AudioEslinear_le, AUDIO_ENCODING_SLINEAR_LE, 16, 0 },
810 1.2 isaki { 0, AudioEulinear_le, AUDIO_ENCODING_ULINEAR_LE, 16, 0 },
811 1.2 isaki { 0, AudioEslinear_be, AUDIO_ENCODING_SLINEAR_BE, 16, 0 },
812 1.2 isaki { 0, AudioEulinear_be, AUDIO_ENCODING_ULINEAR_BE, 16, 0 },
813 1.2 isaki #if defined(AUDIO_SUPPORT_LINEAR24)
814 1.2 isaki { 0, AudioEslinear_le, AUDIO_ENCODING_SLINEAR_LE, 24, 0 },
815 1.2 isaki { 0, AudioEulinear_le, AUDIO_ENCODING_ULINEAR_LE, 24, 0 },
816 1.2 isaki { 0, AudioEslinear_be, AUDIO_ENCODING_SLINEAR_BE, 24, 0 },
817 1.2 isaki { 0, AudioEulinear_be, AUDIO_ENCODING_ULINEAR_BE, 24, 0 },
818 1.2 isaki #endif
819 1.2 isaki { 0, AudioEslinear_le, AUDIO_ENCODING_SLINEAR_LE, 32, 0 },
820 1.2 isaki { 0, AudioEulinear_le, AUDIO_ENCODING_ULINEAR_LE, 32, 0 },
821 1.2 isaki { 0, AudioEslinear_be, AUDIO_ENCODING_SLINEAR_BE, 32, 0 },
822 1.2 isaki { 0, AudioEulinear_be, AUDIO_ENCODING_ULINEAR_BE, 32, 0 },
823 1.2 isaki };
824 1.2 isaki
825 1.2 isaki static const struct portname itable[] = {
826 1.2 isaki { AudioNmicrophone, AUDIO_MICROPHONE },
827 1.2 isaki { AudioNline, AUDIO_LINE_IN },
828 1.2 isaki { AudioNcd, AUDIO_CD },
829 1.2 isaki { 0, 0 }
830 1.2 isaki };
831 1.2 isaki static const struct portname otable[] = {
832 1.2 isaki { AudioNspeaker, AUDIO_SPEAKER },
833 1.2 isaki { AudioNheadphone, AUDIO_HEADPHONE },
834 1.2 isaki { AudioNline, AUDIO_LINE_OUT },
835 1.2 isaki { 0, 0 }
836 1.2 isaki };
837 1.2 isaki
838 1.28.2.9 martin static struct psref_class *audio_psref_class __read_mostly;
839 1.28.2.9 martin
840 1.2 isaki CFATTACH_DECL3_NEW(audio, sizeof(struct audio_softc),
841 1.2 isaki audiomatch, audioattach, audiodetach, audioactivate, audiorescan,
842 1.2 isaki audiochilddet, DVF_DETACH_SHUTDOWN);
843 1.2 isaki
844 1.2 isaki static int
845 1.2 isaki audiomatch(device_t parent, cfdata_t match, void *aux)
846 1.2 isaki {
847 1.2 isaki struct audio_attach_args *sa;
848 1.2 isaki
849 1.2 isaki sa = aux;
850 1.2 isaki DPRINTF(1, "%s: type=%d sa=%p hw=%p\n",
851 1.2 isaki __func__, sa->type, sa, sa->hwif);
852 1.2 isaki return (sa->type == AUDIODEV_TYPE_AUDIO) ? 1 : 0;
853 1.2 isaki }
854 1.2 isaki
855 1.2 isaki static void
856 1.2 isaki audioattach(device_t parent, device_t self, void *aux)
857 1.2 isaki {
858 1.2 isaki struct audio_softc *sc;
859 1.2 isaki struct audio_attach_args *sa;
860 1.2 isaki const struct audio_hw_if *hw_if;
861 1.2 isaki audio_format2_t phwfmt;
862 1.2 isaki audio_format2_t rhwfmt;
863 1.2 isaki audio_filter_reg_t pfil;
864 1.2 isaki audio_filter_reg_t rfil;
865 1.2 isaki const struct sysctlnode *node;
866 1.2 isaki void *hdlp;
867 1.13 isaki bool has_playback;
868 1.13 isaki bool has_capture;
869 1.13 isaki bool has_indep;
870 1.13 isaki bool has_fulldup;
871 1.2 isaki int mode;
872 1.2 isaki int error;
873 1.2 isaki
874 1.2 isaki sc = device_private(self);
875 1.2 isaki sc->sc_dev = self;
876 1.2 isaki sa = (struct audio_attach_args *)aux;
877 1.2 isaki hw_if = sa->hwif;
878 1.2 isaki hdlp = sa->hdl;
879 1.2 isaki
880 1.2 isaki if (hw_if == NULL || hw_if->get_locks == NULL) {
881 1.2 isaki panic("audioattach: missing hw_if method");
882 1.2 isaki }
883 1.2 isaki
884 1.2 isaki hw_if->get_locks(hdlp, &sc->sc_intr_lock, &sc->sc_lock);
885 1.2 isaki
886 1.2 isaki #ifdef DIAGNOSTIC
887 1.2 isaki if (hw_if->query_format == NULL ||
888 1.2 isaki hw_if->set_format == NULL ||
889 1.2 isaki (hw_if->start_output == NULL && hw_if->trigger_output == NULL) ||
890 1.2 isaki (hw_if->start_input == NULL && hw_if->trigger_input == NULL) ||
891 1.2 isaki hw_if->halt_output == NULL ||
892 1.2 isaki hw_if->halt_input == NULL ||
893 1.2 isaki hw_if->getdev == NULL ||
894 1.2 isaki hw_if->set_port == NULL ||
895 1.2 isaki hw_if->get_port == NULL ||
896 1.2 isaki hw_if->query_devinfo == NULL ||
897 1.2 isaki hw_if->get_props == NULL) {
898 1.2 isaki aprint_error(": missing method\n");
899 1.2 isaki return;
900 1.2 isaki }
901 1.2 isaki #endif
902 1.2 isaki
903 1.2 isaki sc->hw_if = hw_if;
904 1.2 isaki sc->hw_hdl = hdlp;
905 1.2 isaki sc->hw_dev = parent;
906 1.2 isaki
907 1.28.2.12 martin sc->sc_exlock = 1;
908 1.2 isaki sc->sc_blk_ms = AUDIO_BLK_MS;
909 1.2 isaki SLIST_INIT(&sc->sc_files);
910 1.2 isaki cv_init(&sc->sc_exlockcv, "audiolk");
911 1.28.2.12 martin sc->sc_am_capacity = 0;
912 1.28.2.12 martin sc->sc_am_used = 0;
913 1.28.2.12 martin sc->sc_am = NULL;
914 1.2 isaki
915 1.2 isaki mutex_enter(sc->sc_lock);
916 1.14 isaki sc->sc_props = hw_if->get_props(sc->hw_hdl);
917 1.2 isaki mutex_exit(sc->sc_lock);
918 1.2 isaki
919 1.14 isaki /* MMAP is now supported by upper layer. */
920 1.14 isaki sc->sc_props |= AUDIO_PROP_MMAP;
921 1.14 isaki
922 1.14 isaki has_playback = (sc->sc_props & AUDIO_PROP_PLAYBACK);
923 1.14 isaki has_capture = (sc->sc_props & AUDIO_PROP_CAPTURE);
924 1.14 isaki has_indep = (sc->sc_props & AUDIO_PROP_INDEPENDENT);
925 1.14 isaki has_fulldup = (sc->sc_props & AUDIO_PROP_FULLDUPLEX);
926 1.13 isaki
927 1.13 isaki KASSERT(has_playback || has_capture);
928 1.13 isaki /* Unidirectional device must have neither FULLDUP nor INDEPENDENT. */
929 1.13 isaki if (!has_playback || !has_capture) {
930 1.13 isaki KASSERT(!has_indep);
931 1.13 isaki KASSERT(!has_fulldup);
932 1.13 isaki }
933 1.2 isaki
934 1.2 isaki mode = 0;
935 1.13 isaki if (has_playback) {
936 1.13 isaki aprint_normal(": playback");
937 1.2 isaki mode |= AUMODE_PLAY;
938 1.2 isaki }
939 1.13 isaki if (has_capture) {
940 1.13 isaki aprint_normal("%c capture", has_playback ? ',' : ':');
941 1.2 isaki mode |= AUMODE_RECORD;
942 1.2 isaki }
943 1.13 isaki if (has_playback && has_capture) {
944 1.13 isaki if (has_fulldup)
945 1.13 isaki aprint_normal(", full duplex");
946 1.13 isaki else
947 1.13 isaki aprint_normal(", half duplex");
948 1.13 isaki
949 1.13 isaki if (has_indep)
950 1.13 isaki aprint_normal(", independent");
951 1.13 isaki }
952 1.2 isaki
953 1.2 isaki aprint_naive("\n");
954 1.2 isaki aprint_normal("\n");
955 1.2 isaki
956 1.2 isaki /* probe hw params */
957 1.2 isaki memset(&phwfmt, 0, sizeof(phwfmt));
958 1.2 isaki memset(&rhwfmt, 0, sizeof(rhwfmt));
959 1.2 isaki memset(&pfil, 0, sizeof(pfil));
960 1.2 isaki memset(&rfil, 0, sizeof(rfil));
961 1.28.2.12 martin if (has_indep) {
962 1.28.2.12 martin int perror, rerror;
963 1.28.2.12 martin
964 1.28.2.12 martin /* On independent devices, probe separately. */
965 1.28.2.12 martin perror = audio_hw_probe(sc, &phwfmt, AUMODE_PLAY);
966 1.28.2.12 martin rerror = audio_hw_probe(sc, &rhwfmt, AUMODE_RECORD);
967 1.28.2.12 martin if (perror && rerror) {
968 1.28.2.12 martin aprint_error_dev(self, "audio_hw_probe failed, "
969 1.28.2.12 martin "perror = %d, rerror = %d\n", perror, rerror);
970 1.28.2.12 martin goto bad;
971 1.28.2.12 martin }
972 1.28.2.12 martin if (perror) {
973 1.28.2.12 martin mode &= ~AUMODE_PLAY;
974 1.28.2.12 martin aprint_error_dev(self, "audio_hw_probe failed with "
975 1.28.2.12 martin "%d, playback disabled\n", perror);
976 1.28.2.12 martin }
977 1.28.2.12 martin if (rerror) {
978 1.28.2.12 martin mode &= ~AUMODE_RECORD;
979 1.28.2.12 martin aprint_error_dev(self, "audio_hw_probe failed with "
980 1.28.2.12 martin "%d, capture disabled\n", rerror);
981 1.28.2.12 martin }
982 1.28.2.12 martin } else {
983 1.28.2.12 martin /*
984 1.28.2.12 martin * On non independent devices or uni-directional devices,
985 1.28.2.12 martin * probe once (simultaneously).
986 1.28.2.12 martin */
987 1.28.2.12 martin audio_format2_t *fmt = has_playback ? &phwfmt : &rhwfmt;
988 1.28.2.12 martin error = audio_hw_probe(sc, fmt, mode);
989 1.28.2.12 martin if (error) {
990 1.28.2.12 martin aprint_error_dev(self, "audio_hw_probe failed, "
991 1.28.2.12 martin "error = %d\n", error);
992 1.28.2.12 martin goto bad;
993 1.28.2.12 martin }
994 1.28.2.12 martin if (has_playback && has_capture)
995 1.28.2.12 martin rhwfmt = phwfmt;
996 1.2 isaki }
997 1.28.2.12 martin
998 1.2 isaki /* Init hardware. */
999 1.2 isaki /* hw_probe() also validates [pr]hwfmt. */
1000 1.2 isaki error = audio_hw_set_format(sc, mode, &phwfmt, &rhwfmt, &pfil, &rfil);
1001 1.2 isaki if (error) {
1002 1.4 nakayama aprint_error_dev(self, "audio_hw_set_format failed, "
1003 1.4 nakayama "error = %d\n", error);
1004 1.2 isaki goto bad;
1005 1.2 isaki }
1006 1.2 isaki
1007 1.2 isaki /*
1008 1.2 isaki * Init track mixers. If at least one direction is available on
1009 1.2 isaki * attach time, we assume a success.
1010 1.2 isaki */
1011 1.2 isaki error = audio_mixers_init(sc, mode, &phwfmt, &rhwfmt, &pfil, &rfil);
1012 1.4 nakayama if (sc->sc_pmixer == NULL && sc->sc_rmixer == NULL) {
1013 1.4 nakayama aprint_error_dev(self, "audio_mixers_init failed, "
1014 1.4 nakayama "error = %d\n", error);
1015 1.2 isaki goto bad;
1016 1.4 nakayama }
1017 1.2 isaki
1018 1.28.2.9 martin sc->sc_psz = pserialize_create();
1019 1.28.2.9 martin psref_target_init(&sc->sc_psref, audio_psref_class);
1020 1.28.2.9 martin
1021 1.2 isaki selinit(&sc->sc_wsel);
1022 1.2 isaki selinit(&sc->sc_rsel);
1023 1.2 isaki
1024 1.2 isaki /* Initial parameter of /dev/sound */
1025 1.2 isaki sc->sc_sound_pparams = params_to_format2(&audio_default);
1026 1.2 isaki sc->sc_sound_rparams = params_to_format2(&audio_default);
1027 1.2 isaki sc->sc_sound_ppause = false;
1028 1.2 isaki sc->sc_sound_rpause = false;
1029 1.2 isaki
1030 1.2 isaki /* XXX TODO: consider about sc_ai */
1031 1.2 isaki
1032 1.2 isaki mixer_init(sc);
1033 1.2 isaki TRACE(2, "inputs ports=0x%x, input master=%d, "
1034 1.2 isaki "output ports=0x%x, output master=%d",
1035 1.2 isaki sc->sc_inports.allports, sc->sc_inports.master,
1036 1.2 isaki sc->sc_outports.allports, sc->sc_outports.master);
1037 1.2 isaki
1038 1.2 isaki sysctl_createv(&sc->sc_log, 0, NULL, &node,
1039 1.2 isaki 0,
1040 1.2 isaki CTLTYPE_NODE, device_xname(sc->sc_dev),
1041 1.2 isaki SYSCTL_DESCR("audio test"),
1042 1.2 isaki NULL, 0,
1043 1.2 isaki NULL, 0,
1044 1.2 isaki CTL_HW,
1045 1.2 isaki CTL_CREATE, CTL_EOL);
1046 1.2 isaki
1047 1.2 isaki if (node != NULL) {
1048 1.2 isaki sysctl_createv(&sc->sc_log, 0, NULL, NULL,
1049 1.2 isaki CTLFLAG_READWRITE,
1050 1.2 isaki CTLTYPE_INT, "blk_ms",
1051 1.2 isaki SYSCTL_DESCR("blocksize in msec"),
1052 1.2 isaki audio_sysctl_blk_ms, 0, (void *)sc, 0,
1053 1.2 isaki CTL_HW, node->sysctl_num, CTL_CREATE, CTL_EOL);
1054 1.2 isaki
1055 1.2 isaki sysctl_createv(&sc->sc_log, 0, NULL, NULL,
1056 1.2 isaki CTLFLAG_READWRITE,
1057 1.2 isaki CTLTYPE_BOOL, "multiuser",
1058 1.2 isaki SYSCTL_DESCR("allow multiple user access"),
1059 1.2 isaki audio_sysctl_multiuser, 0, (void *)sc, 0,
1060 1.2 isaki CTL_HW, node->sysctl_num, CTL_CREATE, CTL_EOL);
1061 1.2 isaki
1062 1.2 isaki #if defined(AUDIO_DEBUG)
1063 1.2 isaki sysctl_createv(&sc->sc_log, 0, NULL, NULL,
1064 1.2 isaki CTLFLAG_READWRITE,
1065 1.2 isaki CTLTYPE_INT, "debug",
1066 1.2 isaki SYSCTL_DESCR("debug level (0..4)"),
1067 1.2 isaki audio_sysctl_debug, 0, (void *)sc, 0,
1068 1.2 isaki CTL_HW, node->sysctl_num, CTL_CREATE, CTL_EOL);
1069 1.2 isaki #endif
1070 1.2 isaki }
1071 1.2 isaki
1072 1.2 isaki #ifdef AUDIO_PM_IDLE
1073 1.2 isaki callout_init(&sc->sc_idle_counter, 0);
1074 1.2 isaki callout_setfunc(&sc->sc_idle_counter, audio_idle, self);
1075 1.2 isaki #endif
1076 1.2 isaki
1077 1.2 isaki if (!pmf_device_register(self, audio_suspend, audio_resume))
1078 1.2 isaki aprint_error_dev(self, "couldn't establish power handler\n");
1079 1.2 isaki #ifdef AUDIO_PM_IDLE
1080 1.2 isaki if (!device_active_register(self, audio_activity))
1081 1.2 isaki aprint_error_dev(self, "couldn't register activity handler\n");
1082 1.2 isaki #endif
1083 1.2 isaki
1084 1.2 isaki if (!pmf_event_register(self, PMFE_AUDIO_VOLUME_DOWN,
1085 1.2 isaki audio_volume_down, true))
1086 1.2 isaki aprint_error_dev(self, "couldn't add volume down handler\n");
1087 1.2 isaki if (!pmf_event_register(self, PMFE_AUDIO_VOLUME_UP,
1088 1.2 isaki audio_volume_up, true))
1089 1.2 isaki aprint_error_dev(self, "couldn't add volume up handler\n");
1090 1.2 isaki if (!pmf_event_register(self, PMFE_AUDIO_VOLUME_TOGGLE,
1091 1.2 isaki audio_volume_toggle, true))
1092 1.2 isaki aprint_error_dev(self, "couldn't add volume toggle handler\n");
1093 1.2 isaki
1094 1.2 isaki #ifdef AUDIO_PM_IDLE
1095 1.2 isaki callout_schedule(&sc->sc_idle_counter, audio_idle_timeout * hz);
1096 1.2 isaki #endif
1097 1.2 isaki
1098 1.2 isaki #if defined(AUDIO_DEBUG)
1099 1.2 isaki audio_mlog_init();
1100 1.2 isaki #endif
1101 1.2 isaki
1102 1.2 isaki audiorescan(self, "audio", NULL);
1103 1.28.2.12 martin sc->sc_exlock = 0;
1104 1.2 isaki return;
1105 1.2 isaki
1106 1.2 isaki bad:
1107 1.2 isaki /* Clearing hw_if means that device is attached but disabled. */
1108 1.2 isaki sc->hw_if = NULL;
1109 1.28.2.12 martin sc->sc_exlock = 0;
1110 1.2 isaki aprint_error_dev(sc->sc_dev, "disabled\n");
1111 1.2 isaki return;
1112 1.2 isaki }
1113 1.2 isaki
1114 1.2 isaki /*
1115 1.2 isaki * Initialize hardware mixer.
1116 1.2 isaki * This function is called from audioattach().
1117 1.2 isaki */
1118 1.2 isaki static void
1119 1.2 isaki mixer_init(struct audio_softc *sc)
1120 1.2 isaki {
1121 1.2 isaki mixer_devinfo_t mi;
1122 1.2 isaki int iclass, mclass, oclass, rclass;
1123 1.2 isaki int record_master_found, record_source_found;
1124 1.2 isaki
1125 1.2 isaki iclass = mclass = oclass = rclass = -1;
1126 1.2 isaki sc->sc_inports.index = -1;
1127 1.2 isaki sc->sc_inports.master = -1;
1128 1.2 isaki sc->sc_inports.nports = 0;
1129 1.2 isaki sc->sc_inports.isenum = false;
1130 1.2 isaki sc->sc_inports.allports = 0;
1131 1.2 isaki sc->sc_inports.isdual = false;
1132 1.2 isaki sc->sc_inports.mixerout = -1;
1133 1.2 isaki sc->sc_inports.cur_port = -1;
1134 1.2 isaki sc->sc_outports.index = -1;
1135 1.2 isaki sc->sc_outports.master = -1;
1136 1.2 isaki sc->sc_outports.nports = 0;
1137 1.2 isaki sc->sc_outports.isenum = false;
1138 1.2 isaki sc->sc_outports.allports = 0;
1139 1.2 isaki sc->sc_outports.isdual = false;
1140 1.2 isaki sc->sc_outports.mixerout = -1;
1141 1.2 isaki sc->sc_outports.cur_port = -1;
1142 1.2 isaki sc->sc_monitor_port = -1;
1143 1.2 isaki /*
1144 1.2 isaki * Read through the underlying driver's list, picking out the class
1145 1.2 isaki * names from the mixer descriptions. We'll need them to decode the
1146 1.2 isaki * mixer descriptions on the next pass through the loop.
1147 1.2 isaki */
1148 1.2 isaki mutex_enter(sc->sc_lock);
1149 1.2 isaki for(mi.index = 0; ; mi.index++) {
1150 1.2 isaki if (audio_query_devinfo(sc, &mi) != 0)
1151 1.2 isaki break;
1152 1.2 isaki /*
1153 1.2 isaki * The type of AUDIO_MIXER_CLASS merely introduces a class.
1154 1.2 isaki * All the other types describe an actual mixer.
1155 1.2 isaki */
1156 1.2 isaki if (mi.type == AUDIO_MIXER_CLASS) {
1157 1.2 isaki if (strcmp(mi.label.name, AudioCinputs) == 0)
1158 1.2 isaki iclass = mi.mixer_class;
1159 1.2 isaki if (strcmp(mi.label.name, AudioCmonitor) == 0)
1160 1.2 isaki mclass = mi.mixer_class;
1161 1.2 isaki if (strcmp(mi.label.name, AudioCoutputs) == 0)
1162 1.2 isaki oclass = mi.mixer_class;
1163 1.2 isaki if (strcmp(mi.label.name, AudioCrecord) == 0)
1164 1.2 isaki rclass = mi.mixer_class;
1165 1.2 isaki }
1166 1.2 isaki }
1167 1.2 isaki mutex_exit(sc->sc_lock);
1168 1.2 isaki
1169 1.2 isaki /* Allocate save area. Ensure non-zero allocation. */
1170 1.2 isaki sc->sc_nmixer_states = mi.index;
1171 1.2 isaki sc->sc_mixer_state = kmem_zalloc(sizeof(mixer_ctrl_t) *
1172 1.2 isaki (sc->sc_nmixer_states + 1), KM_SLEEP);
1173 1.2 isaki
1174 1.2 isaki /*
1175 1.2 isaki * This is where we assign each control in the "audio" model, to the
1176 1.2 isaki * underlying "mixer" control. We walk through the whole list once,
1177 1.2 isaki * assigning likely candidates as we come across them.
1178 1.2 isaki */
1179 1.2 isaki record_master_found = 0;
1180 1.2 isaki record_source_found = 0;
1181 1.2 isaki mutex_enter(sc->sc_lock);
1182 1.2 isaki for(mi.index = 0; ; mi.index++) {
1183 1.2 isaki if (audio_query_devinfo(sc, &mi) != 0)
1184 1.2 isaki break;
1185 1.2 isaki KASSERT(mi.index < sc->sc_nmixer_states);
1186 1.2 isaki if (mi.type == AUDIO_MIXER_CLASS)
1187 1.2 isaki continue;
1188 1.2 isaki if (mi.mixer_class == iclass) {
1189 1.2 isaki /*
1190 1.2 isaki * AudioCinputs is only a fallback, when we don't
1191 1.2 isaki * find what we're looking for in AudioCrecord, so
1192 1.2 isaki * check the flags before accepting one of these.
1193 1.2 isaki */
1194 1.2 isaki if (strcmp(mi.label.name, AudioNmaster) == 0
1195 1.2 isaki && record_master_found == 0)
1196 1.2 isaki sc->sc_inports.master = mi.index;
1197 1.2 isaki if (strcmp(mi.label.name, AudioNsource) == 0
1198 1.2 isaki && record_source_found == 0) {
1199 1.2 isaki if (mi.type == AUDIO_MIXER_ENUM) {
1200 1.2 isaki int i;
1201 1.2 isaki for(i = 0; i < mi.un.e.num_mem; i++)
1202 1.2 isaki if (strcmp(mi.un.e.member[i].label.name,
1203 1.2 isaki AudioNmixerout) == 0)
1204 1.2 isaki sc->sc_inports.mixerout =
1205 1.2 isaki mi.un.e.member[i].ord;
1206 1.2 isaki }
1207 1.2 isaki au_setup_ports(sc, &sc->sc_inports, &mi,
1208 1.2 isaki itable);
1209 1.2 isaki }
1210 1.2 isaki if (strcmp(mi.label.name, AudioNdac) == 0 &&
1211 1.2 isaki sc->sc_outports.master == -1)
1212 1.2 isaki sc->sc_outports.master = mi.index;
1213 1.2 isaki } else if (mi.mixer_class == mclass) {
1214 1.2 isaki if (strcmp(mi.label.name, AudioNmonitor) == 0)
1215 1.2 isaki sc->sc_monitor_port = mi.index;
1216 1.2 isaki } else if (mi.mixer_class == oclass) {
1217 1.2 isaki if (strcmp(mi.label.name, AudioNmaster) == 0)
1218 1.2 isaki sc->sc_outports.master = mi.index;
1219 1.2 isaki if (strcmp(mi.label.name, AudioNselect) == 0)
1220 1.2 isaki au_setup_ports(sc, &sc->sc_outports, &mi,
1221 1.2 isaki otable);
1222 1.2 isaki } else if (mi.mixer_class == rclass) {
1223 1.2 isaki /*
1224 1.2 isaki * These are the preferred mixers for the audio record
1225 1.2 isaki * controls, so set the flags here, but don't check.
1226 1.2 isaki */
1227 1.2 isaki if (strcmp(mi.label.name, AudioNmaster) == 0) {
1228 1.2 isaki sc->sc_inports.master = mi.index;
1229 1.2 isaki record_master_found = 1;
1230 1.2 isaki }
1231 1.2 isaki #if 1 /* Deprecated. Use AudioNmaster. */
1232 1.2 isaki if (strcmp(mi.label.name, AudioNrecord) == 0) {
1233 1.2 isaki sc->sc_inports.master = mi.index;
1234 1.2 isaki record_master_found = 1;
1235 1.2 isaki }
1236 1.2 isaki if (strcmp(mi.label.name, AudioNvolume) == 0) {
1237 1.2 isaki sc->sc_inports.master = mi.index;
1238 1.2 isaki record_master_found = 1;
1239 1.2 isaki }
1240 1.2 isaki #endif
1241 1.2 isaki if (strcmp(mi.label.name, AudioNsource) == 0) {
1242 1.2 isaki if (mi.type == AUDIO_MIXER_ENUM) {
1243 1.2 isaki int i;
1244 1.2 isaki for(i = 0; i < mi.un.e.num_mem; i++)
1245 1.2 isaki if (strcmp(mi.un.e.member[i].label.name,
1246 1.2 isaki AudioNmixerout) == 0)
1247 1.2 isaki sc->sc_inports.mixerout =
1248 1.2 isaki mi.un.e.member[i].ord;
1249 1.2 isaki }
1250 1.2 isaki au_setup_ports(sc, &sc->sc_inports, &mi,
1251 1.2 isaki itable);
1252 1.2 isaki record_source_found = 1;
1253 1.2 isaki }
1254 1.2 isaki }
1255 1.2 isaki }
1256 1.2 isaki mutex_exit(sc->sc_lock);
1257 1.2 isaki }
1258 1.2 isaki
1259 1.2 isaki static int
1260 1.2 isaki audioactivate(device_t self, enum devact act)
1261 1.2 isaki {
1262 1.2 isaki struct audio_softc *sc = device_private(self);
1263 1.2 isaki
1264 1.2 isaki switch (act) {
1265 1.2 isaki case DVACT_DEACTIVATE:
1266 1.2 isaki mutex_enter(sc->sc_lock);
1267 1.2 isaki sc->sc_dying = true;
1268 1.2 isaki cv_broadcast(&sc->sc_exlockcv);
1269 1.2 isaki mutex_exit(sc->sc_lock);
1270 1.2 isaki return 0;
1271 1.2 isaki default:
1272 1.2 isaki return EOPNOTSUPP;
1273 1.2 isaki }
1274 1.2 isaki }
1275 1.2 isaki
1276 1.2 isaki static int
1277 1.2 isaki audiodetach(device_t self, int flags)
1278 1.2 isaki {
1279 1.2 isaki struct audio_softc *sc;
1280 1.28.2.9 martin struct audio_file *file;
1281 1.2 isaki int error;
1282 1.2 isaki
1283 1.2 isaki sc = device_private(self);
1284 1.2 isaki TRACE(2, "flags=%d", flags);
1285 1.2 isaki
1286 1.2 isaki /* device is not initialized */
1287 1.2 isaki if (sc->hw_if == NULL)
1288 1.2 isaki return 0;
1289 1.2 isaki
1290 1.2 isaki /* Start draining existing accessors of the device. */
1291 1.2 isaki error = config_detach_children(self, flags);
1292 1.2 isaki if (error)
1293 1.2 isaki return error;
1294 1.2 isaki
1295 1.28.2.9 martin /* delete sysctl nodes */
1296 1.28.2.9 martin sysctl_teardown(&sc->sc_log);
1297 1.28.2.9 martin
1298 1.2 isaki mutex_enter(sc->sc_lock);
1299 1.2 isaki sc->sc_dying = true;
1300 1.2 isaki cv_broadcast(&sc->sc_exlockcv);
1301 1.2 isaki if (sc->sc_pmixer)
1302 1.2 isaki cv_broadcast(&sc->sc_pmixer->outcv);
1303 1.2 isaki if (sc->sc_rmixer)
1304 1.2 isaki cv_broadcast(&sc->sc_rmixer->outcv);
1305 1.2 isaki
1306 1.28.2.9 martin /* Prevent new users */
1307 1.28.2.9 martin SLIST_FOREACH(file, &sc->sc_files, entry) {
1308 1.28.2.9 martin atomic_store_relaxed(&file->dying, true);
1309 1.28.2.9 martin }
1310 1.28.2.9 martin
1311 1.28.2.9 martin /*
1312 1.28.2.9 martin * Wait for existing users to drain.
1313 1.28.2.9 martin * - pserialize_perform waits for all pserialize_read sections on
1314 1.28.2.9 martin * all CPUs; after this, no more new psref_acquire can happen.
1315 1.28.2.9 martin * - psref_target_destroy waits for all extant acquired psrefs to
1316 1.28.2.9 martin * be psref_released.
1317 1.28.2.9 martin */
1318 1.28.2.9 martin pserialize_perform(sc->sc_psz);
1319 1.28.2.9 martin mutex_exit(sc->sc_lock);
1320 1.28.2.9 martin psref_target_destroy(&sc->sc_psref, audio_psref_class);
1321 1.19 isaki
1322 1.28.2.9 martin /*
1323 1.28.2.9 martin * We are now guaranteed that there are no calls to audio fileops
1324 1.28.2.9 martin * that hold sc, and any new calls with files that were for sc will
1325 1.28.2.9 martin * fail. Thus, we now have exclusive access to the softc.
1326 1.28.2.9 martin */
1327 1.28.2.12 martin sc->sc_exlock = 1;
1328 1.2 isaki
1329 1.2 isaki /*
1330 1.28.2.9 martin * Nuke all open instances.
1331 1.28.2.9 martin * Here, we no longer need any locks to traverse sc_files.
1332 1.2 isaki */
1333 1.28.2.9 martin while ((file = SLIST_FIRST(&sc->sc_files)) != NULL) {
1334 1.28.2.9 martin audio_unlink(sc, file);
1335 1.28.2.9 martin }
1336 1.2 isaki
1337 1.2 isaki pmf_event_deregister(self, PMFE_AUDIO_VOLUME_DOWN,
1338 1.2 isaki audio_volume_down, true);
1339 1.2 isaki pmf_event_deregister(self, PMFE_AUDIO_VOLUME_UP,
1340 1.2 isaki audio_volume_up, true);
1341 1.2 isaki pmf_event_deregister(self, PMFE_AUDIO_VOLUME_TOGGLE,
1342 1.2 isaki audio_volume_toggle, true);
1343 1.2 isaki
1344 1.2 isaki #ifdef AUDIO_PM_IDLE
1345 1.2 isaki callout_halt(&sc->sc_idle_counter, sc->sc_lock);
1346 1.2 isaki
1347 1.2 isaki device_active_deregister(self, audio_activity);
1348 1.2 isaki #endif
1349 1.2 isaki
1350 1.2 isaki pmf_device_deregister(self);
1351 1.2 isaki
1352 1.2 isaki /* Free resources */
1353 1.2 isaki if (sc->sc_pmixer) {
1354 1.2 isaki audio_mixer_destroy(sc, sc->sc_pmixer);
1355 1.2 isaki kmem_free(sc->sc_pmixer, sizeof(*sc->sc_pmixer));
1356 1.2 isaki }
1357 1.2 isaki if (sc->sc_rmixer) {
1358 1.2 isaki audio_mixer_destroy(sc, sc->sc_rmixer);
1359 1.2 isaki kmem_free(sc->sc_rmixer, sizeof(*sc->sc_rmixer));
1360 1.2 isaki }
1361 1.28.2.12 martin if (sc->sc_am)
1362 1.28.2.12 martin kern_free(sc->sc_am);
1363 1.2 isaki
1364 1.2 isaki seldestroy(&sc->sc_wsel);
1365 1.2 isaki seldestroy(&sc->sc_rsel);
1366 1.2 isaki
1367 1.2 isaki #ifdef AUDIO_PM_IDLE
1368 1.2 isaki callout_destroy(&sc->sc_idle_counter);
1369 1.2 isaki #endif
1370 1.2 isaki
1371 1.2 isaki cv_destroy(&sc->sc_exlockcv);
1372 1.2 isaki
1373 1.2 isaki #if defined(AUDIO_DEBUG)
1374 1.2 isaki audio_mlog_free();
1375 1.2 isaki #endif
1376 1.2 isaki
1377 1.2 isaki return 0;
1378 1.2 isaki }
1379 1.2 isaki
1380 1.2 isaki static void
1381 1.2 isaki audiochilddet(device_t self, device_t child)
1382 1.2 isaki {
1383 1.2 isaki
1384 1.2 isaki /* we hold no child references, so do nothing */
1385 1.2 isaki }
1386 1.2 isaki
1387 1.2 isaki static int
1388 1.2 isaki audiosearch(device_t parent, cfdata_t cf, const int *locs, void *aux)
1389 1.2 isaki {
1390 1.2 isaki
1391 1.2 isaki if (config_match(parent, cf, aux))
1392 1.2 isaki config_attach_loc(parent, cf, locs, aux, NULL);
1393 1.2 isaki
1394 1.2 isaki return 0;
1395 1.2 isaki }
1396 1.2 isaki
1397 1.2 isaki static int
1398 1.2 isaki audiorescan(device_t self, const char *ifattr, const int *flags)
1399 1.2 isaki {
1400 1.2 isaki struct audio_softc *sc = device_private(self);
1401 1.2 isaki
1402 1.2 isaki if (!ifattr_match(ifattr, "audio"))
1403 1.2 isaki return 0;
1404 1.2 isaki
1405 1.2 isaki config_search_loc(audiosearch, sc->sc_dev, "audio", NULL, NULL);
1406 1.2 isaki
1407 1.2 isaki return 0;
1408 1.2 isaki }
1409 1.2 isaki
1410 1.2 isaki /*
1411 1.2 isaki * Called from hardware driver. This is where the MI audio driver gets
1412 1.2 isaki * probed/attached to the hardware driver.
1413 1.2 isaki */
1414 1.2 isaki device_t
1415 1.2 isaki audio_attach_mi(const struct audio_hw_if *ahwp, void *hdlp, device_t dev)
1416 1.2 isaki {
1417 1.2 isaki struct audio_attach_args arg;
1418 1.2 isaki
1419 1.2 isaki #ifdef DIAGNOSTIC
1420 1.2 isaki if (ahwp == NULL) {
1421 1.2 isaki aprint_error("audio_attach_mi: NULL\n");
1422 1.2 isaki return 0;
1423 1.2 isaki }
1424 1.2 isaki #endif
1425 1.2 isaki arg.type = AUDIODEV_TYPE_AUDIO;
1426 1.2 isaki arg.hwif = ahwp;
1427 1.2 isaki arg.hdl = hdlp;
1428 1.2 isaki return config_found(dev, &arg, audioprint);
1429 1.2 isaki }
1430 1.2 isaki
1431 1.2 isaki /*
1432 1.28.2.12 martin * Enter critical section and also keep sc_lock.
1433 1.28.2.12 martin * If successful, returns 0 with sc_lock held. Otherwise returns errno.
1434 1.28.2.8 martin * Must be called without sc_lock held.
1435 1.2 isaki */
1436 1.2 isaki static int
1437 1.28.2.12 martin audio_exlock_mutex_enter(struct audio_softc *sc)
1438 1.2 isaki {
1439 1.2 isaki int error;
1440 1.2 isaki
1441 1.2 isaki mutex_enter(sc->sc_lock);
1442 1.2 isaki if (sc->sc_dying) {
1443 1.2 isaki mutex_exit(sc->sc_lock);
1444 1.2 isaki return EIO;
1445 1.2 isaki }
1446 1.2 isaki
1447 1.2 isaki while (__predict_false(sc->sc_exlock != 0)) {
1448 1.2 isaki error = cv_wait_sig(&sc->sc_exlockcv, sc->sc_lock);
1449 1.2 isaki if (sc->sc_dying)
1450 1.2 isaki error = EIO;
1451 1.2 isaki if (error) {
1452 1.2 isaki mutex_exit(sc->sc_lock);
1453 1.2 isaki return error;
1454 1.2 isaki }
1455 1.2 isaki }
1456 1.2 isaki
1457 1.2 isaki /* Acquire */
1458 1.2 isaki sc->sc_exlock = 1;
1459 1.2 isaki return 0;
1460 1.2 isaki }
1461 1.2 isaki
1462 1.2 isaki /*
1463 1.28.2.12 martin * Exit critical section and exit sc_lock.
1464 1.2 isaki * Must be called with sc_lock held.
1465 1.2 isaki */
1466 1.2 isaki static void
1467 1.28.2.12 martin audio_exlock_mutex_exit(struct audio_softc *sc)
1468 1.2 isaki {
1469 1.2 isaki
1470 1.2 isaki KASSERT(mutex_owned(sc->sc_lock));
1471 1.2 isaki
1472 1.2 isaki sc->sc_exlock = 0;
1473 1.2 isaki cv_broadcast(&sc->sc_exlockcv);
1474 1.2 isaki mutex_exit(sc->sc_lock);
1475 1.2 isaki }
1476 1.2 isaki
1477 1.2 isaki /*
1478 1.28.2.12 martin * Enter critical section.
1479 1.28.2.12 martin * If successful, it returns 0. Otherwise returns errno.
1480 1.28.2.12 martin * Must be called without sc_lock held.
1481 1.28.2.12 martin * This function returns without sc_lock held.
1482 1.28.2.12 martin */
1483 1.28.2.12 martin static int
1484 1.28.2.12 martin audio_exlock_enter(struct audio_softc *sc)
1485 1.28.2.12 martin {
1486 1.28.2.12 martin int error;
1487 1.28.2.12 martin
1488 1.28.2.12 martin error = audio_exlock_mutex_enter(sc);
1489 1.28.2.12 martin if (error)
1490 1.28.2.12 martin return error;
1491 1.28.2.12 martin mutex_exit(sc->sc_lock);
1492 1.28.2.12 martin return 0;
1493 1.28.2.12 martin }
1494 1.28.2.12 martin
1495 1.28.2.12 martin /*
1496 1.28.2.12 martin * Exit critical section.
1497 1.28.2.12 martin * Must be called without sc_lock held.
1498 1.28.2.12 martin */
1499 1.28.2.12 martin static void
1500 1.28.2.12 martin audio_exlock_exit(struct audio_softc *sc)
1501 1.28.2.12 martin {
1502 1.28.2.12 martin
1503 1.28.2.12 martin mutex_enter(sc->sc_lock);
1504 1.28.2.12 martin audio_exlock_mutex_exit(sc);
1505 1.28.2.12 martin }
1506 1.28.2.12 martin
1507 1.28.2.12 martin /*
1508 1.28.2.9 martin * Acquire sc from file, and increment the psref count.
1509 1.28.2.9 martin * If successful, returns sc. Otherwise returns NULL.
1510 1.28.2.9 martin */
1511 1.28.2.9 martin struct audio_softc *
1512 1.28.2.9 martin audio_file_enter(audio_file_t *file, struct psref *refp)
1513 1.28.2.9 martin {
1514 1.28.2.9 martin int s;
1515 1.28.2.9 martin bool dying;
1516 1.28.2.9 martin
1517 1.28.2.9 martin /* psref(9) forbids to migrate CPUs */
1518 1.28.2.9 martin curlwp_bind();
1519 1.28.2.9 martin
1520 1.28.2.9 martin /* Block audiodetach while we acquire a reference */
1521 1.28.2.9 martin s = pserialize_read_enter();
1522 1.28.2.9 martin
1523 1.28.2.9 martin /* If close or audiodetach already ran, tough -- no more audio */
1524 1.28.2.9 martin dying = atomic_load_relaxed(&file->dying);
1525 1.28.2.9 martin if (dying) {
1526 1.28.2.9 martin pserialize_read_exit(s);
1527 1.28.2.9 martin return NULL;
1528 1.28.2.9 martin }
1529 1.28.2.9 martin
1530 1.28.2.9 martin /* Acquire a reference */
1531 1.28.2.9 martin psref_acquire(refp, &file->sc->sc_psref, audio_psref_class);
1532 1.28.2.9 martin
1533 1.28.2.9 martin /* Now sc won't go away until we drop the reference count */
1534 1.28.2.9 martin pserialize_read_exit(s);
1535 1.28.2.9 martin
1536 1.28.2.9 martin return file->sc;
1537 1.28.2.9 martin }
1538 1.28.2.9 martin
1539 1.28.2.9 martin /*
1540 1.28.2.9 martin * Decrement the psref count.
1541 1.28.2.9 martin */
1542 1.28.2.9 martin void
1543 1.28.2.9 martin audio_file_exit(struct audio_softc *sc, struct psref *refp)
1544 1.28.2.9 martin {
1545 1.28.2.9 martin
1546 1.28.2.9 martin psref_release(refp, &sc->sc_psref, audio_psref_class);
1547 1.28.2.9 martin }
1548 1.28.2.9 martin
1549 1.28.2.9 martin /*
1550 1.2 isaki * Wait for I/O to complete, releasing sc_lock.
1551 1.2 isaki * Must be called with sc_lock held.
1552 1.2 isaki */
1553 1.2 isaki static int
1554 1.2 isaki audio_track_waitio(struct audio_softc *sc, audio_track_t *track)
1555 1.2 isaki {
1556 1.2 isaki int error;
1557 1.2 isaki
1558 1.2 isaki KASSERT(track);
1559 1.2 isaki KASSERT(mutex_owned(sc->sc_lock));
1560 1.2 isaki
1561 1.2 isaki /* Wait for pending I/O to complete. */
1562 1.2 isaki error = cv_timedwait_sig(&track->mixer->outcv, sc->sc_lock,
1563 1.2 isaki mstohz(AUDIO_TIMEOUT));
1564 1.28.2.16 martin if (sc->sc_suspending) {
1565 1.28.2.16 martin /* If it's about to suspend, ignore timeout error. */
1566 1.28.2.16 martin if (error == EWOULDBLOCK) {
1567 1.28.2.16 martin TRACET(2, track, "timeout (suspending)");
1568 1.28.2.16 martin return 0;
1569 1.28.2.16 martin }
1570 1.28.2.16 martin }
1571 1.2 isaki if (sc->sc_dying) {
1572 1.2 isaki error = EIO;
1573 1.2 isaki }
1574 1.2 isaki if (error) {
1575 1.2 isaki TRACET(2, track, "cv_timedwait_sig failed %d", error);
1576 1.2 isaki if (error == EWOULDBLOCK)
1577 1.2 isaki device_printf(sc->sc_dev, "device timeout\n");
1578 1.2 isaki } else {
1579 1.2 isaki TRACET(3, track, "wakeup");
1580 1.2 isaki }
1581 1.2 isaki return error;
1582 1.2 isaki }
1583 1.2 isaki
1584 1.2 isaki /*
1585 1.2 isaki * Try to acquire track lock.
1586 1.2 isaki * It doesn't block if the track lock is already aquired.
1587 1.2 isaki * Returns true if the track lock was acquired, or false if the track
1588 1.2 isaki * lock was already acquired.
1589 1.2 isaki */
1590 1.2 isaki static __inline bool
1591 1.2 isaki audio_track_lock_tryenter(audio_track_t *track)
1592 1.2 isaki {
1593 1.2 isaki return (atomic_cas_uint(&track->lock, 0, 1) == 0);
1594 1.2 isaki }
1595 1.2 isaki
1596 1.2 isaki /*
1597 1.2 isaki * Acquire track lock.
1598 1.2 isaki */
1599 1.2 isaki static __inline void
1600 1.2 isaki audio_track_lock_enter(audio_track_t *track)
1601 1.2 isaki {
1602 1.2 isaki /* Don't sleep here. */
1603 1.2 isaki while (audio_track_lock_tryenter(track) == false)
1604 1.2 isaki ;
1605 1.2 isaki }
1606 1.2 isaki
1607 1.2 isaki /*
1608 1.2 isaki * Release track lock.
1609 1.2 isaki */
1610 1.2 isaki static __inline void
1611 1.2 isaki audio_track_lock_exit(audio_track_t *track)
1612 1.2 isaki {
1613 1.2 isaki atomic_swap_uint(&track->lock, 0);
1614 1.2 isaki }
1615 1.2 isaki
1616 1.2 isaki
1617 1.2 isaki static int
1618 1.2 isaki audioopen(dev_t dev, int flags, int ifmt, struct lwp *l)
1619 1.2 isaki {
1620 1.2 isaki struct audio_softc *sc;
1621 1.2 isaki int error;
1622 1.2 isaki
1623 1.2 isaki /* Find the device */
1624 1.2 isaki sc = device_lookup_private(&audio_cd, AUDIOUNIT(dev));
1625 1.2 isaki if (sc == NULL || sc->hw_if == NULL)
1626 1.2 isaki return ENXIO;
1627 1.2 isaki
1628 1.28.2.12 martin error = audio_exlock_enter(sc);
1629 1.2 isaki if (error)
1630 1.2 isaki return error;
1631 1.2 isaki
1632 1.2 isaki device_active(sc->sc_dev, DVA_SYSTEM);
1633 1.2 isaki switch (AUDIODEV(dev)) {
1634 1.2 isaki case SOUND_DEVICE:
1635 1.2 isaki case AUDIO_DEVICE:
1636 1.2 isaki error = audio_open(dev, sc, flags, ifmt, l, NULL);
1637 1.2 isaki break;
1638 1.2 isaki case AUDIOCTL_DEVICE:
1639 1.2 isaki error = audioctl_open(dev, sc, flags, ifmt, l);
1640 1.2 isaki break;
1641 1.2 isaki case MIXER_DEVICE:
1642 1.2 isaki error = mixer_open(dev, sc, flags, ifmt, l);
1643 1.2 isaki break;
1644 1.2 isaki default:
1645 1.2 isaki error = ENXIO;
1646 1.2 isaki break;
1647 1.2 isaki }
1648 1.28.2.12 martin audio_exlock_exit(sc);
1649 1.2 isaki
1650 1.2 isaki return error;
1651 1.2 isaki }
1652 1.2 isaki
1653 1.2 isaki static int
1654 1.2 isaki audioclose(struct file *fp)
1655 1.2 isaki {
1656 1.2 isaki struct audio_softc *sc;
1657 1.28.2.9 martin struct psref sc_ref;
1658 1.2 isaki audio_file_t *file;
1659 1.2 isaki int error;
1660 1.2 isaki dev_t dev;
1661 1.2 isaki
1662 1.2 isaki KASSERT(fp->f_audioctx);
1663 1.2 isaki file = fp->f_audioctx;
1664 1.2 isaki dev = file->dev;
1665 1.28.2.9 martin error = 0;
1666 1.2 isaki
1667 1.28.2.9 martin /*
1668 1.28.2.9 martin * audioclose() must
1669 1.28.2.9 martin * - unplug track from the trackmixer (and unplug anything from softc),
1670 1.28.2.9 martin * if sc exists.
1671 1.28.2.9 martin * - free all memory objects, regardless of sc.
1672 1.28.2.9 martin */
1673 1.2 isaki
1674 1.28.2.9 martin sc = audio_file_enter(file, &sc_ref);
1675 1.28.2.9 martin if (sc) {
1676 1.28.2.9 martin switch (AUDIODEV(dev)) {
1677 1.28.2.9 martin case SOUND_DEVICE:
1678 1.28.2.9 martin case AUDIO_DEVICE:
1679 1.28.2.9 martin error = audio_close(sc, file);
1680 1.28.2.9 martin break;
1681 1.28.2.9 martin case AUDIOCTL_DEVICE:
1682 1.28.2.9 martin error = 0;
1683 1.28.2.9 martin break;
1684 1.28.2.9 martin case MIXER_DEVICE:
1685 1.28.2.9 martin error = mixer_close(sc, file);
1686 1.28.2.9 martin break;
1687 1.28.2.9 martin default:
1688 1.28.2.9 martin error = ENXIO;
1689 1.28.2.9 martin break;
1690 1.28.2.9 martin }
1691 1.28.2.9 martin
1692 1.28.2.9 martin audio_file_exit(sc, &sc_ref);
1693 1.2 isaki }
1694 1.28.2.9 martin
1695 1.28.2.9 martin /* Free memory objects anyway */
1696 1.28.2.9 martin TRACEF(2, file, "free memory");
1697 1.28.2.9 martin if (file->ptrack)
1698 1.28.2.9 martin audio_track_destroy(file->ptrack);
1699 1.28.2.9 martin if (file->rtrack)
1700 1.28.2.9 martin audio_track_destroy(file->rtrack);
1701 1.28.2.9 martin kmem_free(file, sizeof(*file));
1702 1.28.2.7 martin fp->f_audioctx = NULL;
1703 1.2 isaki
1704 1.2 isaki return error;
1705 1.2 isaki }
1706 1.2 isaki
1707 1.2 isaki static int
1708 1.2 isaki audioread(struct file *fp, off_t *offp, struct uio *uio, kauth_cred_t cred,
1709 1.2 isaki int ioflag)
1710 1.2 isaki {
1711 1.2 isaki struct audio_softc *sc;
1712 1.28.2.9 martin struct psref sc_ref;
1713 1.2 isaki audio_file_t *file;
1714 1.2 isaki int error;
1715 1.2 isaki dev_t dev;
1716 1.2 isaki
1717 1.2 isaki KASSERT(fp->f_audioctx);
1718 1.2 isaki file = fp->f_audioctx;
1719 1.2 isaki dev = file->dev;
1720 1.2 isaki
1721 1.28.2.9 martin sc = audio_file_enter(file, &sc_ref);
1722 1.28.2.9 martin if (sc == NULL)
1723 1.28.2.9 martin return EIO;
1724 1.28.2.9 martin
1725 1.2 isaki if (fp->f_flag & O_NONBLOCK)
1726 1.2 isaki ioflag |= IO_NDELAY;
1727 1.2 isaki
1728 1.2 isaki switch (AUDIODEV(dev)) {
1729 1.2 isaki case SOUND_DEVICE:
1730 1.2 isaki case AUDIO_DEVICE:
1731 1.2 isaki error = audio_read(sc, uio, ioflag, file);
1732 1.2 isaki break;
1733 1.2 isaki case AUDIOCTL_DEVICE:
1734 1.2 isaki case MIXER_DEVICE:
1735 1.2 isaki error = ENODEV;
1736 1.2 isaki break;
1737 1.2 isaki default:
1738 1.2 isaki error = ENXIO;
1739 1.2 isaki break;
1740 1.2 isaki }
1741 1.2 isaki
1742 1.28.2.9 martin audio_file_exit(sc, &sc_ref);
1743 1.2 isaki return error;
1744 1.2 isaki }
1745 1.2 isaki
1746 1.2 isaki static int
1747 1.2 isaki audiowrite(struct file *fp, off_t *offp, struct uio *uio, kauth_cred_t cred,
1748 1.2 isaki int ioflag)
1749 1.2 isaki {
1750 1.2 isaki struct audio_softc *sc;
1751 1.28.2.9 martin struct psref sc_ref;
1752 1.2 isaki audio_file_t *file;
1753 1.2 isaki int error;
1754 1.2 isaki dev_t dev;
1755 1.2 isaki
1756 1.2 isaki KASSERT(fp->f_audioctx);
1757 1.2 isaki file = fp->f_audioctx;
1758 1.2 isaki dev = file->dev;
1759 1.2 isaki
1760 1.28.2.9 martin sc = audio_file_enter(file, &sc_ref);
1761 1.28.2.9 martin if (sc == NULL)
1762 1.28.2.9 martin return EIO;
1763 1.28.2.9 martin
1764 1.2 isaki if (fp->f_flag & O_NONBLOCK)
1765 1.2 isaki ioflag |= IO_NDELAY;
1766 1.2 isaki
1767 1.2 isaki switch (AUDIODEV(dev)) {
1768 1.2 isaki case SOUND_DEVICE:
1769 1.2 isaki case AUDIO_DEVICE:
1770 1.2 isaki error = audio_write(sc, uio, ioflag, file);
1771 1.2 isaki break;
1772 1.2 isaki case AUDIOCTL_DEVICE:
1773 1.2 isaki case MIXER_DEVICE:
1774 1.2 isaki error = ENODEV;
1775 1.2 isaki break;
1776 1.2 isaki default:
1777 1.2 isaki error = ENXIO;
1778 1.2 isaki break;
1779 1.2 isaki }
1780 1.2 isaki
1781 1.28.2.9 martin audio_file_exit(sc, &sc_ref);
1782 1.2 isaki return error;
1783 1.2 isaki }
1784 1.2 isaki
1785 1.2 isaki static int
1786 1.2 isaki audioioctl(struct file *fp, u_long cmd, void *addr)
1787 1.2 isaki {
1788 1.2 isaki struct audio_softc *sc;
1789 1.28.2.9 martin struct psref sc_ref;
1790 1.2 isaki audio_file_t *file;
1791 1.2 isaki struct lwp *l = curlwp;
1792 1.2 isaki int error;
1793 1.2 isaki dev_t dev;
1794 1.2 isaki
1795 1.2 isaki KASSERT(fp->f_audioctx);
1796 1.2 isaki file = fp->f_audioctx;
1797 1.2 isaki dev = file->dev;
1798 1.2 isaki
1799 1.28.2.9 martin sc = audio_file_enter(file, &sc_ref);
1800 1.28.2.9 martin if (sc == NULL)
1801 1.28.2.9 martin return EIO;
1802 1.28.2.9 martin
1803 1.2 isaki switch (AUDIODEV(dev)) {
1804 1.2 isaki case SOUND_DEVICE:
1805 1.2 isaki case AUDIO_DEVICE:
1806 1.2 isaki case AUDIOCTL_DEVICE:
1807 1.2 isaki mutex_enter(sc->sc_lock);
1808 1.2 isaki device_active(sc->sc_dev, DVA_SYSTEM);
1809 1.2 isaki mutex_exit(sc->sc_lock);
1810 1.2 isaki if (IOCGROUP(cmd) == IOCGROUP(AUDIO_MIXER_READ))
1811 1.2 isaki error = mixer_ioctl(sc, cmd, addr, fp->f_flag, l);
1812 1.2 isaki else
1813 1.2 isaki error = audio_ioctl(dev, sc, cmd, addr, fp->f_flag, l,
1814 1.2 isaki file);
1815 1.2 isaki break;
1816 1.2 isaki case MIXER_DEVICE:
1817 1.2 isaki error = mixer_ioctl(sc, cmd, addr, fp->f_flag, l);
1818 1.2 isaki break;
1819 1.2 isaki default:
1820 1.2 isaki error = ENXIO;
1821 1.2 isaki break;
1822 1.2 isaki }
1823 1.2 isaki
1824 1.28.2.9 martin audio_file_exit(sc, &sc_ref);
1825 1.2 isaki return error;
1826 1.2 isaki }
1827 1.2 isaki
1828 1.2 isaki static int
1829 1.2 isaki audiostat(struct file *fp, struct stat *st)
1830 1.2 isaki {
1831 1.28.2.9 martin struct audio_softc *sc;
1832 1.28.2.9 martin struct psref sc_ref;
1833 1.2 isaki audio_file_t *file;
1834 1.2 isaki
1835 1.2 isaki KASSERT(fp->f_audioctx);
1836 1.2 isaki file = fp->f_audioctx;
1837 1.2 isaki
1838 1.28.2.9 martin sc = audio_file_enter(file, &sc_ref);
1839 1.28.2.9 martin if (sc == NULL)
1840 1.28.2.9 martin return EIO;
1841 1.28.2.9 martin
1842 1.2 isaki memset(st, 0, sizeof(*st));
1843 1.2 isaki
1844 1.2 isaki st->st_dev = file->dev;
1845 1.2 isaki st->st_uid = kauth_cred_geteuid(fp->f_cred);
1846 1.2 isaki st->st_gid = kauth_cred_getegid(fp->f_cred);
1847 1.2 isaki st->st_mode = S_IFCHR;
1848 1.28.2.9 martin
1849 1.28.2.9 martin audio_file_exit(sc, &sc_ref);
1850 1.2 isaki return 0;
1851 1.2 isaki }
1852 1.2 isaki
1853 1.2 isaki static int
1854 1.2 isaki audiopoll(struct file *fp, int events)
1855 1.2 isaki {
1856 1.2 isaki struct audio_softc *sc;
1857 1.28.2.9 martin struct psref sc_ref;
1858 1.2 isaki audio_file_t *file;
1859 1.2 isaki struct lwp *l = curlwp;
1860 1.2 isaki int revents;
1861 1.2 isaki dev_t dev;
1862 1.2 isaki
1863 1.2 isaki KASSERT(fp->f_audioctx);
1864 1.2 isaki file = fp->f_audioctx;
1865 1.2 isaki dev = file->dev;
1866 1.2 isaki
1867 1.28.2.9 martin sc = audio_file_enter(file, &sc_ref);
1868 1.28.2.9 martin if (sc == NULL)
1869 1.28.2.9 martin return EIO;
1870 1.28.2.9 martin
1871 1.2 isaki switch (AUDIODEV(dev)) {
1872 1.2 isaki case SOUND_DEVICE:
1873 1.2 isaki case AUDIO_DEVICE:
1874 1.2 isaki revents = audio_poll(sc, events, l, file);
1875 1.2 isaki break;
1876 1.2 isaki case AUDIOCTL_DEVICE:
1877 1.2 isaki case MIXER_DEVICE:
1878 1.2 isaki revents = 0;
1879 1.2 isaki break;
1880 1.2 isaki default:
1881 1.2 isaki revents = POLLERR;
1882 1.2 isaki break;
1883 1.2 isaki }
1884 1.2 isaki
1885 1.28.2.9 martin audio_file_exit(sc, &sc_ref);
1886 1.2 isaki return revents;
1887 1.2 isaki }
1888 1.2 isaki
1889 1.2 isaki static int
1890 1.2 isaki audiokqfilter(struct file *fp, struct knote *kn)
1891 1.2 isaki {
1892 1.2 isaki struct audio_softc *sc;
1893 1.28.2.9 martin struct psref sc_ref;
1894 1.2 isaki audio_file_t *file;
1895 1.2 isaki dev_t dev;
1896 1.2 isaki int error;
1897 1.2 isaki
1898 1.2 isaki KASSERT(fp->f_audioctx);
1899 1.2 isaki file = fp->f_audioctx;
1900 1.2 isaki dev = file->dev;
1901 1.2 isaki
1902 1.28.2.9 martin sc = audio_file_enter(file, &sc_ref);
1903 1.28.2.9 martin if (sc == NULL)
1904 1.28.2.9 martin return EIO;
1905 1.28.2.9 martin
1906 1.2 isaki switch (AUDIODEV(dev)) {
1907 1.2 isaki case SOUND_DEVICE:
1908 1.2 isaki case AUDIO_DEVICE:
1909 1.2 isaki error = audio_kqfilter(sc, file, kn);
1910 1.2 isaki break;
1911 1.2 isaki case AUDIOCTL_DEVICE:
1912 1.2 isaki case MIXER_DEVICE:
1913 1.2 isaki error = ENODEV;
1914 1.2 isaki break;
1915 1.2 isaki default:
1916 1.2 isaki error = ENXIO;
1917 1.2 isaki break;
1918 1.2 isaki }
1919 1.2 isaki
1920 1.28.2.9 martin audio_file_exit(sc, &sc_ref);
1921 1.2 isaki return error;
1922 1.2 isaki }
1923 1.2 isaki
1924 1.2 isaki static int
1925 1.2 isaki audiommap(struct file *fp, off_t *offp, size_t len, int prot, int *flagsp,
1926 1.2 isaki int *advicep, struct uvm_object **uobjp, int *maxprotp)
1927 1.2 isaki {
1928 1.2 isaki struct audio_softc *sc;
1929 1.28.2.9 martin struct psref sc_ref;
1930 1.2 isaki audio_file_t *file;
1931 1.2 isaki dev_t dev;
1932 1.2 isaki int error;
1933 1.2 isaki
1934 1.2 isaki KASSERT(fp->f_audioctx);
1935 1.2 isaki file = fp->f_audioctx;
1936 1.2 isaki dev = file->dev;
1937 1.2 isaki
1938 1.28.2.9 martin sc = audio_file_enter(file, &sc_ref);
1939 1.28.2.9 martin if (sc == NULL)
1940 1.28.2.9 martin return EIO;
1941 1.28.2.9 martin
1942 1.2 isaki mutex_enter(sc->sc_lock);
1943 1.2 isaki device_active(sc->sc_dev, DVA_SYSTEM); /* XXXJDM */
1944 1.2 isaki mutex_exit(sc->sc_lock);
1945 1.2 isaki
1946 1.2 isaki switch (AUDIODEV(dev)) {
1947 1.2 isaki case SOUND_DEVICE:
1948 1.2 isaki case AUDIO_DEVICE:
1949 1.2 isaki error = audio_mmap(sc, offp, len, prot, flagsp, advicep,
1950 1.2 isaki uobjp, maxprotp, file);
1951 1.2 isaki break;
1952 1.2 isaki case AUDIOCTL_DEVICE:
1953 1.2 isaki case MIXER_DEVICE:
1954 1.2 isaki default:
1955 1.2 isaki error = ENOTSUP;
1956 1.2 isaki break;
1957 1.2 isaki }
1958 1.2 isaki
1959 1.28.2.9 martin audio_file_exit(sc, &sc_ref);
1960 1.2 isaki return error;
1961 1.2 isaki }
1962 1.2 isaki
1963 1.2 isaki
1964 1.2 isaki /* Exported interfaces for audiobell. */
1965 1.2 isaki
1966 1.2 isaki /*
1967 1.2 isaki * Open for audiobell.
1968 1.21 isaki * It stores allocated file to *filep.
1969 1.2 isaki * If successful returns 0, otherwise errno.
1970 1.2 isaki */
1971 1.2 isaki int
1972 1.21 isaki audiobellopen(dev_t dev, audio_file_t **filep)
1973 1.2 isaki {
1974 1.2 isaki struct audio_softc *sc;
1975 1.2 isaki int error;
1976 1.2 isaki
1977 1.2 isaki /* Find the device */
1978 1.2 isaki sc = device_lookup_private(&audio_cd, AUDIOUNIT(dev));
1979 1.2 isaki if (sc == NULL || sc->hw_if == NULL)
1980 1.2 isaki return ENXIO;
1981 1.2 isaki
1982 1.28.2.12 martin error = audio_exlock_enter(sc);
1983 1.2 isaki if (error)
1984 1.2 isaki return error;
1985 1.2 isaki
1986 1.2 isaki device_active(sc->sc_dev, DVA_SYSTEM);
1987 1.21 isaki error = audio_open(dev, sc, FWRITE, 0, curlwp, filep);
1988 1.2 isaki
1989 1.28.2.12 martin audio_exlock_exit(sc);
1990 1.2 isaki return error;
1991 1.2 isaki }
1992 1.2 isaki
1993 1.2 isaki /* Close for audiobell */
1994 1.2 isaki int
1995 1.2 isaki audiobellclose(audio_file_t *file)
1996 1.2 isaki {
1997 1.2 isaki struct audio_softc *sc;
1998 1.28.2.9 martin struct psref sc_ref;
1999 1.2 isaki int error;
2000 1.2 isaki
2001 1.28.2.9 martin sc = audio_file_enter(file, &sc_ref);
2002 1.28.2.9 martin if (sc == NULL)
2003 1.28.2.9 martin return EIO;
2004 1.2 isaki
2005 1.2 isaki error = audio_close(sc, file);
2006 1.2 isaki
2007 1.28.2.9 martin audio_file_exit(sc, &sc_ref);
2008 1.2 isaki
2009 1.28.2.9 martin KASSERT(file->ptrack);
2010 1.28.2.9 martin audio_track_destroy(file->ptrack);
2011 1.28.2.9 martin KASSERT(file->rtrack == NULL);
2012 1.28.2.9 martin kmem_free(file, sizeof(*file));
2013 1.2 isaki return error;
2014 1.2 isaki }
2015 1.2 isaki
2016 1.21 isaki /* Set sample rate for audiobell */
2017 1.21 isaki int
2018 1.21 isaki audiobellsetrate(audio_file_t *file, u_int sample_rate)
2019 1.21 isaki {
2020 1.21 isaki struct audio_softc *sc;
2021 1.28.2.9 martin struct psref sc_ref;
2022 1.21 isaki struct audio_info ai;
2023 1.21 isaki int error;
2024 1.21 isaki
2025 1.28.2.9 martin sc = audio_file_enter(file, &sc_ref);
2026 1.28.2.9 martin if (sc == NULL)
2027 1.28.2.9 martin return EIO;
2028 1.21 isaki
2029 1.21 isaki AUDIO_INITINFO(&ai);
2030 1.21 isaki ai.play.sample_rate = sample_rate;
2031 1.21 isaki
2032 1.28.2.12 martin error = audio_exlock_enter(sc);
2033 1.21 isaki if (error)
2034 1.28.2.9 martin goto done;
2035 1.21 isaki error = audio_file_setinfo(sc, file, &ai);
2036 1.28.2.12 martin audio_exlock_exit(sc);
2037 1.21 isaki
2038 1.28.2.9 martin done:
2039 1.28.2.9 martin audio_file_exit(sc, &sc_ref);
2040 1.21 isaki return error;
2041 1.21 isaki }
2042 1.21 isaki
2043 1.2 isaki /* Playback for audiobell */
2044 1.2 isaki int
2045 1.2 isaki audiobellwrite(audio_file_t *file, struct uio *uio)
2046 1.2 isaki {
2047 1.2 isaki struct audio_softc *sc;
2048 1.28.2.9 martin struct psref sc_ref;
2049 1.2 isaki int error;
2050 1.2 isaki
2051 1.28.2.9 martin sc = audio_file_enter(file, &sc_ref);
2052 1.28.2.9 martin if (sc == NULL)
2053 1.28.2.9 martin return EIO;
2054 1.28.2.9 martin
2055 1.2 isaki error = audio_write(sc, uio, 0, file);
2056 1.28.2.9 martin
2057 1.28.2.9 martin audio_file_exit(sc, &sc_ref);
2058 1.2 isaki return error;
2059 1.2 isaki }
2060 1.2 isaki
2061 1.2 isaki
2062 1.2 isaki /*
2063 1.2 isaki * Audio driver
2064 1.2 isaki */
2065 1.28.2.12 martin
2066 1.28.2.12 martin /*
2067 1.28.2.12 martin * Must be called with sc_exlock held and without sc_lock held.
2068 1.28.2.12 martin */
2069 1.2 isaki int
2070 1.2 isaki audio_open(dev_t dev, struct audio_softc *sc, int flags, int ifmt,
2071 1.21 isaki struct lwp *l, audio_file_t **bellfile)
2072 1.2 isaki {
2073 1.2 isaki struct audio_info ai;
2074 1.2 isaki struct file *fp;
2075 1.2 isaki audio_file_t *af;
2076 1.2 isaki audio_ring_t *hwbuf;
2077 1.2 isaki bool fullduplex;
2078 1.28.2.17 martin bool cred_held;
2079 1.28.2.17 martin bool hw_opened;
2080 1.28.2.17 martin bool rmixer_started;
2081 1.2 isaki int fd;
2082 1.2 isaki int error;
2083 1.2 isaki
2084 1.2 isaki KASSERT(sc->sc_exlock);
2085 1.2 isaki
2086 1.22 isaki TRACE(1, "%sdev=%s flags=0x%x po=%d ro=%d",
2087 1.2 isaki (audiodebug >= 3) ? "start " : "",
2088 1.22 isaki ISDEVSOUND(dev) ? "sound" : "audio",
2089 1.2 isaki flags, sc->sc_popens, sc->sc_ropens);
2090 1.2 isaki
2091 1.28.2.17 martin fp = NULL;
2092 1.28.2.17 martin cred_held = false;
2093 1.28.2.17 martin hw_opened = false;
2094 1.28.2.17 martin rmixer_started = false;
2095 1.28.2.17 martin
2096 1.2 isaki af = kmem_zalloc(sizeof(audio_file_t), KM_SLEEP);
2097 1.2 isaki af->sc = sc;
2098 1.2 isaki af->dev = dev;
2099 1.2 isaki if ((flags & FWRITE) != 0 && audio_can_playback(sc))
2100 1.2 isaki af->mode |= AUMODE_PLAY | AUMODE_PLAY_ALL;
2101 1.2 isaki if ((flags & FREAD) != 0 && audio_can_capture(sc))
2102 1.2 isaki af->mode |= AUMODE_RECORD;
2103 1.2 isaki if (af->mode == 0) {
2104 1.2 isaki error = ENXIO;
2105 1.28.2.17 martin goto bad;
2106 1.2 isaki }
2107 1.2 isaki
2108 1.14 isaki fullduplex = (sc->sc_props & AUDIO_PROP_FULLDUPLEX);
2109 1.2 isaki
2110 1.2 isaki /*
2111 1.2 isaki * On half duplex hardware,
2112 1.2 isaki * 1. if mode is (PLAY | REC), let mode PLAY.
2113 1.2 isaki * 2. if mode is PLAY, let mode PLAY if no rec tracks, otherwise error.
2114 1.2 isaki * 3. if mode is REC, let mode REC if no play tracks, otherwise error.
2115 1.2 isaki */
2116 1.2 isaki if (fullduplex == false) {
2117 1.2 isaki if ((af->mode & AUMODE_PLAY)) {
2118 1.2 isaki if (sc->sc_ropens != 0) {
2119 1.2 isaki TRACE(1, "record track already exists");
2120 1.2 isaki error = ENODEV;
2121 1.28.2.17 martin goto bad;
2122 1.2 isaki }
2123 1.2 isaki /* Play takes precedence */
2124 1.2 isaki af->mode &= ~AUMODE_RECORD;
2125 1.2 isaki }
2126 1.2 isaki if ((af->mode & AUMODE_RECORD)) {
2127 1.2 isaki if (sc->sc_popens != 0) {
2128 1.2 isaki TRACE(1, "play track already exists");
2129 1.2 isaki error = ENODEV;
2130 1.28.2.17 martin goto bad;
2131 1.2 isaki }
2132 1.2 isaki }
2133 1.2 isaki }
2134 1.2 isaki
2135 1.2 isaki /* Create tracks */
2136 1.2 isaki if ((af->mode & AUMODE_PLAY))
2137 1.2 isaki af->ptrack = audio_track_create(sc, sc->sc_pmixer);
2138 1.2 isaki if ((af->mode & AUMODE_RECORD))
2139 1.2 isaki af->rtrack = audio_track_create(sc, sc->sc_rmixer);
2140 1.2 isaki
2141 1.2 isaki /* Set parameters */
2142 1.2 isaki AUDIO_INITINFO(&ai);
2143 1.21 isaki if (bellfile) {
2144 1.21 isaki /* If audiobell, only sample_rate will be set later. */
2145 1.21 isaki ai.play.sample_rate = audio_default.sample_rate;
2146 1.21 isaki ai.play.encoding = AUDIO_ENCODING_SLINEAR_NE;
2147 1.21 isaki ai.play.channels = 1;
2148 1.21 isaki ai.play.precision = 16;
2149 1.2 isaki ai.play.pause = false;
2150 1.2 isaki } else if (ISDEVAUDIO(dev)) {
2151 1.2 isaki /* If /dev/audio, initialize everytime. */
2152 1.2 isaki ai.play.sample_rate = audio_default.sample_rate;
2153 1.2 isaki ai.play.encoding = audio_default.encoding;
2154 1.2 isaki ai.play.channels = audio_default.channels;
2155 1.2 isaki ai.play.precision = audio_default.precision;
2156 1.2 isaki ai.play.pause = false;
2157 1.2 isaki ai.record.sample_rate = audio_default.sample_rate;
2158 1.2 isaki ai.record.encoding = audio_default.encoding;
2159 1.2 isaki ai.record.channels = audio_default.channels;
2160 1.2 isaki ai.record.precision = audio_default.precision;
2161 1.2 isaki ai.record.pause = false;
2162 1.2 isaki } else {
2163 1.2 isaki /* If /dev/sound, take over the previous parameters. */
2164 1.2 isaki ai.play.sample_rate = sc->sc_sound_pparams.sample_rate;
2165 1.2 isaki ai.play.encoding = sc->sc_sound_pparams.encoding;
2166 1.2 isaki ai.play.channels = sc->sc_sound_pparams.channels;
2167 1.2 isaki ai.play.precision = sc->sc_sound_pparams.precision;
2168 1.2 isaki ai.play.pause = sc->sc_sound_ppause;
2169 1.2 isaki ai.record.sample_rate = sc->sc_sound_rparams.sample_rate;
2170 1.2 isaki ai.record.encoding = sc->sc_sound_rparams.encoding;
2171 1.2 isaki ai.record.channels = sc->sc_sound_rparams.channels;
2172 1.2 isaki ai.record.precision = sc->sc_sound_rparams.precision;
2173 1.2 isaki ai.record.pause = sc->sc_sound_rpause;
2174 1.2 isaki }
2175 1.2 isaki error = audio_file_setinfo(sc, af, &ai);
2176 1.2 isaki if (error)
2177 1.28.2.17 martin goto bad;
2178 1.2 isaki
2179 1.2 isaki if (sc->sc_popens + sc->sc_ropens == 0) {
2180 1.2 isaki /* First open */
2181 1.2 isaki
2182 1.2 isaki sc->sc_cred = kauth_cred_get();
2183 1.2 isaki kauth_cred_hold(sc->sc_cred);
2184 1.28.2.17 martin cred_held = true;
2185 1.2 isaki
2186 1.2 isaki if (sc->hw_if->open) {
2187 1.2 isaki int hwflags;
2188 1.2 isaki
2189 1.2 isaki /*
2190 1.2 isaki * Call hw_if->open() only at first open of
2191 1.2 isaki * combination of playback and recording.
2192 1.2 isaki * On full duplex hardware, the flags passed to
2193 1.2 isaki * hw_if->open() is always (FREAD | FWRITE)
2194 1.2 isaki * regardless of this open()'s flags.
2195 1.2 isaki * see also dev/isa/aria.c
2196 1.2 isaki * On half duplex hardware, the flags passed to
2197 1.2 isaki * hw_if->open() is either FREAD or FWRITE.
2198 1.2 isaki * see also arch/evbarm/mini2440/audio_mini2440.c
2199 1.2 isaki */
2200 1.2 isaki if (fullduplex) {
2201 1.2 isaki hwflags = FREAD | FWRITE;
2202 1.2 isaki } else {
2203 1.2 isaki /* Construct hwflags from af->mode. */
2204 1.2 isaki hwflags = 0;
2205 1.2 isaki if ((af->mode & AUMODE_PLAY) != 0)
2206 1.2 isaki hwflags |= FWRITE;
2207 1.2 isaki if ((af->mode & AUMODE_RECORD) != 0)
2208 1.2 isaki hwflags |= FREAD;
2209 1.2 isaki }
2210 1.2 isaki
2211 1.28.2.12 martin mutex_enter(sc->sc_lock);
2212 1.2 isaki mutex_enter(sc->sc_intr_lock);
2213 1.2 isaki error = sc->hw_if->open(sc->hw_hdl, hwflags);
2214 1.2 isaki mutex_exit(sc->sc_intr_lock);
2215 1.28.2.12 martin mutex_exit(sc->sc_lock);
2216 1.2 isaki if (error)
2217 1.28.2.17 martin goto bad;
2218 1.2 isaki }
2219 1.28.2.17 martin /*
2220 1.28.2.17 martin * Regardless of whether we called hw_if->open (whether
2221 1.28.2.17 martin * hw_if->open exists) or not, we move to the Opened phase
2222 1.28.2.17 martin * here. Therefore from this point, we have to call
2223 1.28.2.17 martin * hw_if->close (if exists) whenever abort.
2224 1.28.2.17 martin * Note that both of hw_if->{open,close} are optional.
2225 1.28.2.17 martin */
2226 1.28.2.17 martin hw_opened = true;
2227 1.2 isaki
2228 1.2 isaki /*
2229 1.2 isaki * Set speaker mode when a half duplex.
2230 1.2 isaki * XXX I'm not sure this is correct.
2231 1.2 isaki */
2232 1.2 isaki if (1/*XXX*/) {
2233 1.2 isaki if (sc->hw_if->speaker_ctl) {
2234 1.2 isaki int on;
2235 1.2 isaki if (af->ptrack) {
2236 1.2 isaki on = 1;
2237 1.2 isaki } else {
2238 1.2 isaki on = 0;
2239 1.2 isaki }
2240 1.28.2.12 martin mutex_enter(sc->sc_lock);
2241 1.2 isaki mutex_enter(sc->sc_intr_lock);
2242 1.2 isaki error = sc->hw_if->speaker_ctl(sc->hw_hdl, on);
2243 1.2 isaki mutex_exit(sc->sc_intr_lock);
2244 1.28.2.12 martin mutex_exit(sc->sc_lock);
2245 1.2 isaki if (error)
2246 1.28.2.17 martin goto bad;
2247 1.2 isaki }
2248 1.2 isaki }
2249 1.2 isaki } else if (sc->sc_multiuser == false) {
2250 1.2 isaki uid_t euid = kauth_cred_geteuid(kauth_cred_get());
2251 1.2 isaki if (euid != 0 && euid != kauth_cred_geteuid(sc->sc_cred)) {
2252 1.2 isaki error = EPERM;
2253 1.28.2.17 martin goto bad;
2254 1.2 isaki }
2255 1.2 isaki }
2256 1.2 isaki
2257 1.2 isaki /* Call init_output if this is the first playback open. */
2258 1.2 isaki if (af->ptrack && sc->sc_popens == 0) {
2259 1.2 isaki if (sc->hw_if->init_output) {
2260 1.2 isaki hwbuf = &sc->sc_pmixer->hwbuf;
2261 1.28.2.12 martin mutex_enter(sc->sc_lock);
2262 1.2 isaki mutex_enter(sc->sc_intr_lock);
2263 1.2 isaki error = sc->hw_if->init_output(sc->hw_hdl,
2264 1.2 isaki hwbuf->mem,
2265 1.2 isaki hwbuf->capacity *
2266 1.2 isaki hwbuf->fmt.channels * hwbuf->fmt.stride / NBBY);
2267 1.2 isaki mutex_exit(sc->sc_intr_lock);
2268 1.28.2.12 martin mutex_exit(sc->sc_lock);
2269 1.2 isaki if (error)
2270 1.28.2.17 martin goto bad;
2271 1.2 isaki }
2272 1.2 isaki }
2273 1.28.2.13 martin /*
2274 1.28.2.13 martin * Call init_input and start rmixer, if this is the first recording
2275 1.28.2.13 martin * open. See pause consideration notes.
2276 1.28.2.13 martin */
2277 1.2 isaki if (af->rtrack && sc->sc_ropens == 0) {
2278 1.2 isaki if (sc->hw_if->init_input) {
2279 1.2 isaki hwbuf = &sc->sc_rmixer->hwbuf;
2280 1.28.2.12 martin mutex_enter(sc->sc_lock);
2281 1.2 isaki mutex_enter(sc->sc_intr_lock);
2282 1.2 isaki error = sc->hw_if->init_input(sc->hw_hdl,
2283 1.2 isaki hwbuf->mem,
2284 1.2 isaki hwbuf->capacity *
2285 1.2 isaki hwbuf->fmt.channels * hwbuf->fmt.stride / NBBY);
2286 1.2 isaki mutex_exit(sc->sc_intr_lock);
2287 1.28.2.12 martin mutex_exit(sc->sc_lock);
2288 1.2 isaki if (error)
2289 1.28.2.17 martin goto bad;
2290 1.2 isaki }
2291 1.28.2.13 martin
2292 1.28.2.13 martin mutex_enter(sc->sc_lock);
2293 1.28.2.13 martin audio_rmixer_start(sc);
2294 1.28.2.13 martin mutex_exit(sc->sc_lock);
2295 1.28.2.17 martin rmixer_started = true;
2296 1.2 isaki }
2297 1.2 isaki
2298 1.28.2.17 martin if (bellfile) {
2299 1.28.2.17 martin *bellfile = af;
2300 1.28.2.17 martin } else {
2301 1.2 isaki error = fd_allocfile(&fp, &fd);
2302 1.2 isaki if (error)
2303 1.28.2.17 martin goto bad;
2304 1.28.2.17 martin
2305 1.28.2.17 martin error = fd_clone(fp, fd, flags, &audio_fileops, af);
2306 1.28.2.17 martin KASSERTMSG(error == EMOVEFD, "error=%d", error);
2307 1.2 isaki }
2308 1.2 isaki
2309 1.2 isaki /*
2310 1.2 isaki * Count up finally.
2311 1.2 isaki * Don't fail from here.
2312 1.2 isaki */
2313 1.28.2.12 martin mutex_enter(sc->sc_lock);
2314 1.2 isaki if (af->ptrack)
2315 1.2 isaki sc->sc_popens++;
2316 1.2 isaki if (af->rtrack)
2317 1.2 isaki sc->sc_ropens++;
2318 1.2 isaki mutex_enter(sc->sc_intr_lock);
2319 1.2 isaki SLIST_INSERT_HEAD(&sc->sc_files, af, entry);
2320 1.2 isaki mutex_exit(sc->sc_intr_lock);
2321 1.28.2.12 martin mutex_exit(sc->sc_lock);
2322 1.2 isaki
2323 1.2 isaki TRACEF(3, af, "done");
2324 1.2 isaki return error;
2325 1.2 isaki
2326 1.28.2.17 martin bad:
2327 1.28.2.17 martin if (fp) {
2328 1.28.2.17 martin fd_abort(curproc, fp, fd);
2329 1.28.2.17 martin }
2330 1.28.2.17 martin
2331 1.28.2.17 martin if (rmixer_started) {
2332 1.28.2.17 martin mutex_enter(sc->sc_lock);
2333 1.28.2.17 martin audio_rmixer_halt(sc);
2334 1.28.2.17 martin mutex_exit(sc->sc_lock);
2335 1.28.2.17 martin }
2336 1.28.2.17 martin
2337 1.28.2.17 martin if (hw_opened) {
2338 1.2 isaki if (sc->hw_if->close) {
2339 1.28.2.12 martin mutex_enter(sc->sc_lock);
2340 1.2 isaki mutex_enter(sc->sc_intr_lock);
2341 1.2 isaki sc->hw_if->close(sc->hw_hdl);
2342 1.2 isaki mutex_exit(sc->sc_intr_lock);
2343 1.28.2.12 martin mutex_exit(sc->sc_lock);
2344 1.2 isaki }
2345 1.2 isaki }
2346 1.28.2.17 martin if (cred_held) {
2347 1.28.2.17 martin kauth_cred_free(sc->sc_cred);
2348 1.28.2.17 martin }
2349 1.28.2.17 martin
2350 1.28.2.17 martin /*
2351 1.28.2.17 martin * Since track here is not yet linked to sc_files,
2352 1.28.2.17 martin * you can call track_destroy() without sc_intr_lock.
2353 1.28.2.17 martin */
2354 1.2 isaki if (af->rtrack) {
2355 1.2 isaki audio_track_destroy(af->rtrack);
2356 1.2 isaki af->rtrack = NULL;
2357 1.2 isaki }
2358 1.2 isaki if (af->ptrack) {
2359 1.2 isaki audio_track_destroy(af->ptrack);
2360 1.2 isaki af->ptrack = NULL;
2361 1.2 isaki }
2362 1.28.2.17 martin
2363 1.2 isaki kmem_free(af, sizeof(*af));
2364 1.2 isaki return error;
2365 1.2 isaki }
2366 1.2 isaki
2367 1.9 isaki /*
2368 1.28.2.8 martin * Must be called without sc_lock nor sc_exlock held.
2369 1.9 isaki */
2370 1.2 isaki int
2371 1.2 isaki audio_close(struct audio_softc *sc, audio_file_t *file)
2372 1.2 isaki {
2373 1.28.2.9 martin
2374 1.28.2.9 martin /* Protect entering new fileops to this file */
2375 1.28.2.9 martin atomic_store_relaxed(&file->dying, true);
2376 1.28.2.9 martin
2377 1.28.2.9 martin /*
2378 1.28.2.9 martin * Drain first.
2379 1.28.2.12 martin * It must be done before unlinking(acquiring exlock).
2380 1.28.2.9 martin */
2381 1.28.2.9 martin if (file->ptrack) {
2382 1.28.2.9 martin mutex_enter(sc->sc_lock);
2383 1.28.2.9 martin audio_track_drain(sc, file->ptrack);
2384 1.28.2.9 martin mutex_exit(sc->sc_lock);
2385 1.28.2.9 martin }
2386 1.28.2.9 martin
2387 1.28.2.9 martin return audio_unlink(sc, file);
2388 1.28.2.9 martin }
2389 1.28.2.9 martin
2390 1.28.2.9 martin /*
2391 1.28.2.9 martin * Unlink this file, but not freeing memory here.
2392 1.28.2.9 martin * Must be called without sc_lock nor sc_exlock held.
2393 1.28.2.9 martin */
2394 1.28.2.9 martin int
2395 1.28.2.9 martin audio_unlink(struct audio_softc *sc, audio_file_t *file)
2396 1.28.2.9 martin {
2397 1.2 isaki int error;
2398 1.2 isaki
2399 1.28.2.12 martin mutex_enter(sc->sc_lock);
2400 1.28.2.12 martin
2401 1.2 isaki TRACEF(1, file, "%spid=%d.%d po=%d ro=%d",
2402 1.2 isaki (audiodebug >= 3) ? "start " : "",
2403 1.2 isaki (int)curproc->p_pid, (int)curlwp->l_lid,
2404 1.2 isaki sc->sc_popens, sc->sc_ropens);
2405 1.2 isaki KASSERTMSG(sc->sc_popens + sc->sc_ropens > 0,
2406 1.2 isaki "sc->sc_popens=%d, sc->sc_ropens=%d",
2407 1.2 isaki sc->sc_popens, sc->sc_ropens);
2408 1.2 isaki
2409 1.2 isaki /*
2410 1.28.2.12 martin * Acquire exlock to protect counters.
2411 1.28.2.12 martin * Does not use audio_exlock_enter() due to sc_dying.
2412 1.2 isaki */
2413 1.28.2.9 martin while (__predict_false(sc->sc_exlock != 0)) {
2414 1.28.2.9 martin error = cv_timedwait_sig(&sc->sc_exlockcv, sc->sc_lock,
2415 1.28.2.9 martin mstohz(AUDIO_TIMEOUT));
2416 1.28.2.9 martin /* XXX what should I do on error? */
2417 1.28.2.9 martin if (error == EWOULDBLOCK) {
2418 1.28.2.9 martin mutex_exit(sc->sc_lock);
2419 1.28.2.9 martin device_printf(sc->sc_dev,
2420 1.28.2.9 martin "%s: cv_timedwait_sig failed %d", __func__, error);
2421 1.28.2.9 martin return error;
2422 1.28.2.9 martin }
2423 1.2 isaki }
2424 1.28.2.9 martin sc->sc_exlock = 1;
2425 1.2 isaki
2426 1.28.2.9 martin device_active(sc->sc_dev, DVA_SYSTEM);
2427 1.28.2.9 martin
2428 1.28.2.9 martin mutex_enter(sc->sc_intr_lock);
2429 1.28.2.9 martin SLIST_REMOVE(&sc->sc_files, file, audio_file, entry);
2430 1.28.2.9 martin mutex_exit(sc->sc_intr_lock);
2431 1.2 isaki
2432 1.2 isaki if (file->ptrack) {
2433 1.28.2.9 martin TRACET(3, file->ptrack, "dropframes=%" PRIu64,
2434 1.28.2.9 martin file->ptrack->dropframes);
2435 1.28.2.9 martin
2436 1.28.2.9 martin KASSERT(sc->sc_popens > 0);
2437 1.28.2.9 martin sc->sc_popens--;
2438 1.28.2.9 martin
2439 1.2 isaki /* Call hw halt_output if this is the last playback track. */
2440 1.28.2.9 martin if (sc->sc_popens == 0 && sc->sc_pbusy) {
2441 1.2 isaki error = audio_pmixer_halt(sc);
2442 1.2 isaki if (error) {
2443 1.2 isaki device_printf(sc->sc_dev,
2444 1.28.2.9 martin "halt_output failed with %d (ignored)\n",
2445 1.28.2.9 martin error);
2446 1.2 isaki }
2447 1.2 isaki }
2448 1.2 isaki
2449 1.20 isaki /* Restore mixing volume if all tracks are gone. */
2450 1.20 isaki if (sc->sc_popens == 0) {
2451 1.28.2.9 martin /* intr_lock is not necessary, but just manners. */
2452 1.20 isaki mutex_enter(sc->sc_intr_lock);
2453 1.20 isaki sc->sc_pmixer->volume = 256;
2454 1.23 isaki sc->sc_pmixer->voltimer = 0;
2455 1.20 isaki mutex_exit(sc->sc_intr_lock);
2456 1.20 isaki }
2457 1.2 isaki }
2458 1.2 isaki if (file->rtrack) {
2459 1.28.2.9 martin TRACET(3, file->rtrack, "dropframes=%" PRIu64,
2460 1.28.2.9 martin file->rtrack->dropframes);
2461 1.28.2.9 martin
2462 1.28.2.9 martin KASSERT(sc->sc_ropens > 0);
2463 1.28.2.9 martin sc->sc_ropens--;
2464 1.28.2.9 martin
2465 1.2 isaki /* Call hw halt_input if this is the last recording track. */
2466 1.28.2.9 martin if (sc->sc_ropens == 0 && sc->sc_rbusy) {
2467 1.2 isaki error = audio_rmixer_halt(sc);
2468 1.2 isaki if (error) {
2469 1.2 isaki device_printf(sc->sc_dev,
2470 1.28.2.9 martin "halt_input failed with %d (ignored)\n",
2471 1.28.2.9 martin error);
2472 1.2 isaki }
2473 1.2 isaki }
2474 1.2 isaki
2475 1.2 isaki }
2476 1.2 isaki
2477 1.2 isaki /* Call hw close if this is the last track. */
2478 1.2 isaki if (sc->sc_popens + sc->sc_ropens == 0) {
2479 1.2 isaki if (sc->hw_if->close) {
2480 1.2 isaki TRACE(2, "hw_if close");
2481 1.2 isaki mutex_enter(sc->sc_intr_lock);
2482 1.2 isaki sc->hw_if->close(sc->hw_hdl);
2483 1.2 isaki mutex_exit(sc->sc_intr_lock);
2484 1.2 isaki }
2485 1.28.2.12 martin }
2486 1.2 isaki
2487 1.28.2.12 martin mutex_exit(sc->sc_lock);
2488 1.28.2.12 martin if (sc->sc_popens + sc->sc_ropens == 0)
2489 1.2 isaki kauth_cred_free(sc->sc_cred);
2490 1.2 isaki
2491 1.2 isaki TRACE(3, "done");
2492 1.28.2.12 martin audio_exlock_exit(sc);
2493 1.28.2.7 martin
2494 1.2 isaki return 0;
2495 1.2 isaki }
2496 1.2 isaki
2497 1.28.2.8 martin /*
2498 1.28.2.8 martin * Must be called without sc_lock nor sc_exlock held.
2499 1.28.2.8 martin */
2500 1.2 isaki int
2501 1.2 isaki audio_read(struct audio_softc *sc, struct uio *uio, int ioflag,
2502 1.2 isaki audio_file_t *file)
2503 1.2 isaki {
2504 1.2 isaki audio_track_t *track;
2505 1.2 isaki audio_ring_t *usrbuf;
2506 1.2 isaki audio_ring_t *input;
2507 1.2 isaki int error;
2508 1.2 isaki
2509 1.24 isaki /*
2510 1.24 isaki * On half-duplex hardware, O_RDWR is treated as O_WRONLY.
2511 1.24 isaki * However read() system call itself can be called because it's
2512 1.24 isaki * opened with O_RDWR. So in this case, deny this read().
2513 1.24 isaki */
2514 1.2 isaki track = file->rtrack;
2515 1.24 isaki if (track == NULL) {
2516 1.24 isaki return EBADF;
2517 1.24 isaki }
2518 1.2 isaki
2519 1.2 isaki /* I think it's better than EINVAL. */
2520 1.2 isaki if (track->mmapped)
2521 1.2 isaki return EPERM;
2522 1.2 isaki
2523 1.24 isaki TRACET(2, track, "resid=%zd", uio->uio_resid);
2524 1.24 isaki
2525 1.28.2.13 martin #ifdef AUDIO_PM_IDLE
2526 1.28.2.12 martin error = audio_exlock_mutex_enter(sc);
2527 1.28.2.12 martin if (error)
2528 1.28.2.12 martin return error;
2529 1.28.2.12 martin
2530 1.2 isaki if (device_is_active(&sc->sc_dev) || sc->sc_idle)
2531 1.2 isaki device_active(&sc->sc_dev, DVA_SYSTEM);
2532 1.2 isaki
2533 1.28.2.13 martin /* In recording, unlike playback, read() never operates rmixer. */
2534 1.28.2.13 martin
2535 1.28.2.12 martin audio_exlock_mutex_exit(sc);
2536 1.28.2.13 martin #endif
2537 1.2 isaki
2538 1.28.2.12 martin usrbuf = &track->usrbuf;
2539 1.28.2.12 martin input = track->input;
2540 1.2 isaki error = 0;
2541 1.28.2.12 martin
2542 1.2 isaki while (uio->uio_resid > 0 && error == 0) {
2543 1.2 isaki int bytes;
2544 1.2 isaki
2545 1.2 isaki TRACET(3, track,
2546 1.2 isaki "while resid=%zd input=%d/%d/%d usrbuf=%d/%d/H%d",
2547 1.2 isaki uio->uio_resid,
2548 1.2 isaki input->head, input->used, input->capacity,
2549 1.2 isaki usrbuf->head, usrbuf->used, track->usrbuf_usedhigh);
2550 1.2 isaki
2551 1.2 isaki /* Wait when buffers are empty. */
2552 1.2 isaki mutex_enter(sc->sc_lock);
2553 1.2 isaki for (;;) {
2554 1.2 isaki bool empty;
2555 1.2 isaki audio_track_lock_enter(track);
2556 1.2 isaki empty = (input->used == 0 && usrbuf->used == 0);
2557 1.2 isaki audio_track_lock_exit(track);
2558 1.2 isaki if (!empty)
2559 1.2 isaki break;
2560 1.2 isaki
2561 1.2 isaki if ((ioflag & IO_NDELAY)) {
2562 1.2 isaki mutex_exit(sc->sc_lock);
2563 1.2 isaki return EWOULDBLOCK;
2564 1.2 isaki }
2565 1.2 isaki
2566 1.2 isaki TRACET(3, track, "sleep");
2567 1.2 isaki error = audio_track_waitio(sc, track);
2568 1.2 isaki if (error) {
2569 1.2 isaki mutex_exit(sc->sc_lock);
2570 1.2 isaki return error;
2571 1.2 isaki }
2572 1.2 isaki }
2573 1.2 isaki mutex_exit(sc->sc_lock);
2574 1.2 isaki
2575 1.2 isaki audio_track_lock_enter(track);
2576 1.2 isaki audio_track_record(track);
2577 1.2 isaki
2578 1.2 isaki /* uiomove from usrbuf as much as possible. */
2579 1.2 isaki bytes = uimin(usrbuf->used, uio->uio_resid);
2580 1.2 isaki while (bytes > 0) {
2581 1.2 isaki int head = usrbuf->head;
2582 1.2 isaki int len = uimin(bytes, usrbuf->capacity - head);
2583 1.2 isaki error = uiomove((uint8_t *)usrbuf->mem + head, len,
2584 1.2 isaki uio);
2585 1.2 isaki if (error) {
2586 1.9 isaki audio_track_lock_exit(track);
2587 1.2 isaki device_printf(sc->sc_dev,
2588 1.2 isaki "uiomove(len=%d) failed with %d\n",
2589 1.2 isaki len, error);
2590 1.2 isaki goto abort;
2591 1.2 isaki }
2592 1.2 isaki auring_take(usrbuf, len);
2593 1.2 isaki track->useriobytes += len;
2594 1.2 isaki TRACET(3, track, "uiomove(len=%d) usrbuf=%d/%d/C%d",
2595 1.2 isaki len,
2596 1.2 isaki usrbuf->head, usrbuf->used, usrbuf->capacity);
2597 1.2 isaki bytes -= len;
2598 1.2 isaki }
2599 1.9 isaki
2600 1.9 isaki audio_track_lock_exit(track);
2601 1.2 isaki }
2602 1.2 isaki
2603 1.2 isaki abort:
2604 1.2 isaki return error;
2605 1.2 isaki }
2606 1.2 isaki
2607 1.2 isaki
2608 1.2 isaki /*
2609 1.2 isaki * Clear file's playback and/or record track buffer immediately.
2610 1.2 isaki */
2611 1.2 isaki static void
2612 1.2 isaki audio_file_clear(struct audio_softc *sc, audio_file_t *file)
2613 1.2 isaki {
2614 1.2 isaki
2615 1.2 isaki if (file->ptrack)
2616 1.2 isaki audio_track_clear(sc, file->ptrack);
2617 1.2 isaki if (file->rtrack)
2618 1.2 isaki audio_track_clear(sc, file->rtrack);
2619 1.2 isaki }
2620 1.2 isaki
2621 1.28.2.8 martin /*
2622 1.28.2.8 martin * Must be called without sc_lock nor sc_exlock held.
2623 1.28.2.8 martin */
2624 1.2 isaki int
2625 1.2 isaki audio_write(struct audio_softc *sc, struct uio *uio, int ioflag,
2626 1.2 isaki audio_file_t *file)
2627 1.2 isaki {
2628 1.2 isaki audio_track_t *track;
2629 1.2 isaki audio_ring_t *usrbuf;
2630 1.2 isaki audio_ring_t *outbuf;
2631 1.2 isaki int error;
2632 1.2 isaki
2633 1.2 isaki track = file->ptrack;
2634 1.2 isaki KASSERT(track);
2635 1.2 isaki
2636 1.2 isaki /* I think it's better than EINVAL. */
2637 1.2 isaki if (track->mmapped)
2638 1.2 isaki return EPERM;
2639 1.2 isaki
2640 1.25 isaki TRACET(2, track, "%sresid=%zd pid=%d.%d ioflag=0x%x",
2641 1.25 isaki audiodebug >= 3 ? "begin " : "",
2642 1.25 isaki uio->uio_resid, (int)curproc->p_pid, (int)curlwp->l_lid, ioflag);
2643 1.25 isaki
2644 1.2 isaki if (uio->uio_resid == 0) {
2645 1.2 isaki track->eofcounter++;
2646 1.2 isaki return 0;
2647 1.2 isaki }
2648 1.2 isaki
2649 1.28.2.12 martin error = audio_exlock_mutex_enter(sc);
2650 1.28.2.12 martin if (error)
2651 1.28.2.12 martin return error;
2652 1.28.2.12 martin
2653 1.2 isaki #ifdef AUDIO_PM_IDLE
2654 1.2 isaki if (device_is_active(&sc->sc_dev) || sc->sc_idle)
2655 1.2 isaki device_active(&sc->sc_dev, DVA_SYSTEM);
2656 1.2 isaki #endif
2657 1.2 isaki
2658 1.2 isaki /*
2659 1.2 isaki * The first write starts pmixer.
2660 1.2 isaki */
2661 1.2 isaki if (sc->sc_pbusy == false)
2662 1.2 isaki audio_pmixer_start(sc, false);
2663 1.28.2.12 martin audio_exlock_mutex_exit(sc);
2664 1.2 isaki
2665 1.28.2.12 martin usrbuf = &track->usrbuf;
2666 1.28.2.12 martin outbuf = &track->outbuf;
2667 1.2 isaki track->pstate = AUDIO_STATE_RUNNING;
2668 1.2 isaki error = 0;
2669 1.28.2.12 martin
2670 1.2 isaki while (uio->uio_resid > 0 && error == 0) {
2671 1.2 isaki int bytes;
2672 1.2 isaki
2673 1.2 isaki TRACET(3, track, "while resid=%zd usrbuf=%d/%d/H%d",
2674 1.2 isaki uio->uio_resid,
2675 1.2 isaki usrbuf->head, usrbuf->used, track->usrbuf_usedhigh);
2676 1.2 isaki
2677 1.2 isaki /* Wait when buffers are full. */
2678 1.2 isaki mutex_enter(sc->sc_lock);
2679 1.2 isaki for (;;) {
2680 1.2 isaki bool full;
2681 1.2 isaki audio_track_lock_enter(track);
2682 1.2 isaki full = (usrbuf->used >= track->usrbuf_usedhigh &&
2683 1.2 isaki outbuf->used >= outbuf->capacity);
2684 1.2 isaki audio_track_lock_exit(track);
2685 1.2 isaki if (!full)
2686 1.2 isaki break;
2687 1.2 isaki
2688 1.2 isaki if ((ioflag & IO_NDELAY)) {
2689 1.2 isaki error = EWOULDBLOCK;
2690 1.2 isaki mutex_exit(sc->sc_lock);
2691 1.2 isaki goto abort;
2692 1.2 isaki }
2693 1.2 isaki
2694 1.2 isaki TRACET(3, track, "sleep usrbuf=%d/H%d",
2695 1.2 isaki usrbuf->used, track->usrbuf_usedhigh);
2696 1.2 isaki error = audio_track_waitio(sc, track);
2697 1.2 isaki if (error) {
2698 1.2 isaki mutex_exit(sc->sc_lock);
2699 1.2 isaki goto abort;
2700 1.2 isaki }
2701 1.2 isaki }
2702 1.2 isaki mutex_exit(sc->sc_lock);
2703 1.2 isaki
2704 1.9 isaki audio_track_lock_enter(track);
2705 1.9 isaki
2706 1.2 isaki /* uiomove to usrbuf as much as possible. */
2707 1.2 isaki bytes = uimin(track->usrbuf_usedhigh - usrbuf->used,
2708 1.2 isaki uio->uio_resid);
2709 1.2 isaki while (bytes > 0) {
2710 1.2 isaki int tail = auring_tail(usrbuf);
2711 1.2 isaki int len = uimin(bytes, usrbuf->capacity - tail);
2712 1.2 isaki error = uiomove((uint8_t *)usrbuf->mem + tail, len,
2713 1.2 isaki uio);
2714 1.2 isaki if (error) {
2715 1.9 isaki audio_track_lock_exit(track);
2716 1.2 isaki device_printf(sc->sc_dev,
2717 1.2 isaki "uiomove(len=%d) failed with %d\n",
2718 1.2 isaki len, error);
2719 1.2 isaki goto abort;
2720 1.2 isaki }
2721 1.2 isaki auring_push(usrbuf, len);
2722 1.2 isaki track->useriobytes += len;
2723 1.2 isaki TRACET(3, track, "uiomove(len=%d) usrbuf=%d/%d/C%d",
2724 1.2 isaki len,
2725 1.2 isaki usrbuf->head, usrbuf->used, usrbuf->capacity);
2726 1.2 isaki bytes -= len;
2727 1.2 isaki }
2728 1.2 isaki
2729 1.2 isaki /* Convert them as much as possible. */
2730 1.2 isaki while (usrbuf->used >= track->usrbuf_blksize &&
2731 1.2 isaki outbuf->used < outbuf->capacity) {
2732 1.2 isaki audio_track_play(track);
2733 1.2 isaki }
2734 1.9 isaki
2735 1.2 isaki audio_track_lock_exit(track);
2736 1.2 isaki }
2737 1.2 isaki
2738 1.2 isaki abort:
2739 1.2 isaki TRACET(3, track, "done error=%d", error);
2740 1.2 isaki return error;
2741 1.2 isaki }
2742 1.2 isaki
2743 1.28.2.8 martin /*
2744 1.28.2.8 martin * Must be called without sc_lock nor sc_exlock held.
2745 1.28.2.8 martin */
2746 1.2 isaki int
2747 1.2 isaki audio_ioctl(dev_t dev, struct audio_softc *sc, u_long cmd, void *addr, int flag,
2748 1.2 isaki struct lwp *l, audio_file_t *file)
2749 1.2 isaki {
2750 1.2 isaki struct audio_offset *ao;
2751 1.2 isaki struct audio_info ai;
2752 1.2 isaki audio_track_t *track;
2753 1.2 isaki audio_encoding_t *ae;
2754 1.2 isaki audio_format_query_t *query;
2755 1.2 isaki u_int stamp;
2756 1.2 isaki u_int offs;
2757 1.2 isaki int fd;
2758 1.2 isaki int index;
2759 1.2 isaki int error;
2760 1.2 isaki
2761 1.2 isaki #if defined(AUDIO_DEBUG)
2762 1.2 isaki const char *ioctlnames[] = {
2763 1.2 isaki " AUDIO_GETINFO", /* 21 */
2764 1.2 isaki " AUDIO_SETINFO", /* 22 */
2765 1.2 isaki " AUDIO_DRAIN", /* 23 */
2766 1.2 isaki " AUDIO_FLUSH", /* 24 */
2767 1.2 isaki " AUDIO_WSEEK", /* 25 */
2768 1.2 isaki " AUDIO_RERROR", /* 26 */
2769 1.2 isaki " AUDIO_GETDEV", /* 27 */
2770 1.2 isaki " AUDIO_GETENC", /* 28 */
2771 1.2 isaki " AUDIO_GETFD", /* 29 */
2772 1.2 isaki " AUDIO_SETFD", /* 30 */
2773 1.2 isaki " AUDIO_PERROR", /* 31 */
2774 1.2 isaki " AUDIO_GETIOFFS", /* 32 */
2775 1.2 isaki " AUDIO_GETOOFFS", /* 33 */
2776 1.2 isaki " AUDIO_GETPROPS", /* 34 */
2777 1.2 isaki " AUDIO_GETBUFINFO", /* 35 */
2778 1.2 isaki " AUDIO_SETCHAN", /* 36 */
2779 1.2 isaki " AUDIO_GETCHAN", /* 37 */
2780 1.2 isaki " AUDIO_QUERYFORMAT", /* 38 */
2781 1.2 isaki " AUDIO_GETFORMAT", /* 39 */
2782 1.2 isaki " AUDIO_SETFORMAT", /* 40 */
2783 1.2 isaki };
2784 1.2 isaki int nameidx = (cmd & 0xff);
2785 1.2 isaki const char *ioctlname = "";
2786 1.2 isaki if (21 <= nameidx && nameidx <= 21 + __arraycount(ioctlnames))
2787 1.2 isaki ioctlname = ioctlnames[nameidx - 21];
2788 1.2 isaki TRACEF(2, file, "(%lu,'%c',%lu)%s pid=%d.%d",
2789 1.2 isaki IOCPARM_LEN(cmd), (char)IOCGROUP(cmd), cmd&0xff, ioctlname,
2790 1.2 isaki (int)curproc->p_pid, (int)l->l_lid);
2791 1.2 isaki #endif
2792 1.2 isaki
2793 1.2 isaki error = 0;
2794 1.2 isaki switch (cmd) {
2795 1.2 isaki case FIONBIO:
2796 1.2 isaki /* All handled in the upper FS layer. */
2797 1.2 isaki break;
2798 1.2 isaki
2799 1.2 isaki case FIONREAD:
2800 1.2 isaki /* Get the number of bytes that can be read. */
2801 1.2 isaki if (file->rtrack) {
2802 1.2 isaki *(int *)addr = audio_track_readablebytes(file->rtrack);
2803 1.2 isaki } else {
2804 1.2 isaki *(int *)addr = 0;
2805 1.2 isaki }
2806 1.2 isaki break;
2807 1.2 isaki
2808 1.2 isaki case FIOASYNC:
2809 1.2 isaki /* Set/Clear ASYNC I/O. */
2810 1.2 isaki if (*(int *)addr) {
2811 1.2 isaki file->async_audio = curproc->p_pid;
2812 1.2 isaki TRACEF(2, file, "FIOASYNC pid %d", file->async_audio);
2813 1.2 isaki } else {
2814 1.2 isaki file->async_audio = 0;
2815 1.2 isaki TRACEF(2, file, "FIOASYNC off");
2816 1.2 isaki }
2817 1.2 isaki break;
2818 1.2 isaki
2819 1.2 isaki case AUDIO_FLUSH:
2820 1.2 isaki /* XXX TODO: clear errors and restart? */
2821 1.2 isaki audio_file_clear(sc, file);
2822 1.2 isaki break;
2823 1.2 isaki
2824 1.2 isaki case AUDIO_RERROR:
2825 1.2 isaki /*
2826 1.2 isaki * Number of read bytes dropped. We don't know where
2827 1.2 isaki * or when they were dropped (including conversion stage).
2828 1.2 isaki * Therefore, the number of accurate bytes or samples is
2829 1.2 isaki * also unknown.
2830 1.2 isaki */
2831 1.2 isaki track = file->rtrack;
2832 1.2 isaki if (track) {
2833 1.2 isaki *(int *)addr = frametobyte(&track->usrbuf.fmt,
2834 1.2 isaki track->dropframes);
2835 1.2 isaki }
2836 1.2 isaki break;
2837 1.2 isaki
2838 1.2 isaki case AUDIO_PERROR:
2839 1.2 isaki /*
2840 1.2 isaki * Number of write bytes dropped. We don't know where
2841 1.2 isaki * or when they were dropped (including conversion stage).
2842 1.2 isaki * Therefore, the number of accurate bytes or samples is
2843 1.2 isaki * also unknown.
2844 1.2 isaki */
2845 1.2 isaki track = file->ptrack;
2846 1.2 isaki if (track) {
2847 1.2 isaki *(int *)addr = frametobyte(&track->usrbuf.fmt,
2848 1.2 isaki track->dropframes);
2849 1.2 isaki }
2850 1.2 isaki break;
2851 1.2 isaki
2852 1.2 isaki case AUDIO_GETIOFFS:
2853 1.2 isaki /* XXX TODO */
2854 1.2 isaki ao = (struct audio_offset *)addr;
2855 1.2 isaki ao->samples = 0;
2856 1.2 isaki ao->deltablks = 0;
2857 1.2 isaki ao->offset = 0;
2858 1.2 isaki break;
2859 1.2 isaki
2860 1.2 isaki case AUDIO_GETOOFFS:
2861 1.2 isaki ao = (struct audio_offset *)addr;
2862 1.2 isaki track = file->ptrack;
2863 1.2 isaki if (track == NULL) {
2864 1.2 isaki ao->samples = 0;
2865 1.2 isaki ao->deltablks = 0;
2866 1.2 isaki ao->offset = 0;
2867 1.2 isaki break;
2868 1.2 isaki }
2869 1.2 isaki mutex_enter(sc->sc_lock);
2870 1.2 isaki mutex_enter(sc->sc_intr_lock);
2871 1.2 isaki /* figure out where next DMA will start */
2872 1.2 isaki stamp = track->usrbuf_stamp;
2873 1.2 isaki offs = track->usrbuf.head;
2874 1.2 isaki mutex_exit(sc->sc_intr_lock);
2875 1.2 isaki mutex_exit(sc->sc_lock);
2876 1.2 isaki
2877 1.2 isaki ao->samples = stamp;
2878 1.2 isaki ao->deltablks = (stamp / track->usrbuf_blksize) -
2879 1.2 isaki (track->usrbuf_stamp_last / track->usrbuf_blksize);
2880 1.2 isaki track->usrbuf_stamp_last = stamp;
2881 1.2 isaki offs = rounddown(offs, track->usrbuf_blksize)
2882 1.2 isaki + track->usrbuf_blksize;
2883 1.2 isaki if (offs >= track->usrbuf.capacity)
2884 1.2 isaki offs -= track->usrbuf.capacity;
2885 1.2 isaki ao->offset = offs;
2886 1.2 isaki
2887 1.2 isaki TRACET(3, track, "GETOOFFS: samples=%u deltablks=%u offset=%u",
2888 1.2 isaki ao->samples, ao->deltablks, ao->offset);
2889 1.2 isaki break;
2890 1.2 isaki
2891 1.2 isaki case AUDIO_WSEEK:
2892 1.2 isaki /* XXX return value does not include outbuf one. */
2893 1.2 isaki if (file->ptrack)
2894 1.2 isaki *(u_long *)addr = file->ptrack->usrbuf.used;
2895 1.2 isaki break;
2896 1.2 isaki
2897 1.2 isaki case AUDIO_SETINFO:
2898 1.28.2.12 martin error = audio_exlock_enter(sc);
2899 1.2 isaki if (error)
2900 1.2 isaki break;
2901 1.2 isaki error = audio_file_setinfo(sc, file, (struct audio_info *)addr);
2902 1.2 isaki if (error) {
2903 1.28.2.12 martin audio_exlock_exit(sc);
2904 1.2 isaki break;
2905 1.2 isaki }
2906 1.2 isaki /* XXX TODO: update last_ai if /dev/sound ? */
2907 1.2 isaki if (ISDEVSOUND(dev))
2908 1.2 isaki error = audiogetinfo(sc, &sc->sc_ai, 0, file);
2909 1.28.2.12 martin audio_exlock_exit(sc);
2910 1.2 isaki break;
2911 1.2 isaki
2912 1.2 isaki case AUDIO_GETINFO:
2913 1.28.2.12 martin error = audio_exlock_enter(sc);
2914 1.2 isaki if (error)
2915 1.2 isaki break;
2916 1.2 isaki error = audiogetinfo(sc, (struct audio_info *)addr, 1, file);
2917 1.28.2.12 martin audio_exlock_exit(sc);
2918 1.2 isaki break;
2919 1.2 isaki
2920 1.2 isaki case AUDIO_GETBUFINFO:
2921 1.28.2.12 martin error = audio_exlock_enter(sc);
2922 1.28.2.12 martin if (error)
2923 1.28.2.12 martin break;
2924 1.2 isaki error = audiogetinfo(sc, (struct audio_info *)addr, 0, file);
2925 1.28.2.12 martin audio_exlock_exit(sc);
2926 1.2 isaki break;
2927 1.2 isaki
2928 1.2 isaki case AUDIO_DRAIN:
2929 1.2 isaki if (file->ptrack) {
2930 1.2 isaki mutex_enter(sc->sc_lock);
2931 1.2 isaki error = audio_track_drain(sc, file->ptrack);
2932 1.2 isaki mutex_exit(sc->sc_lock);
2933 1.2 isaki }
2934 1.2 isaki break;
2935 1.2 isaki
2936 1.2 isaki case AUDIO_GETDEV:
2937 1.2 isaki mutex_enter(sc->sc_lock);
2938 1.2 isaki error = sc->hw_if->getdev(sc->hw_hdl, (audio_device_t *)addr);
2939 1.2 isaki mutex_exit(sc->sc_lock);
2940 1.2 isaki break;
2941 1.2 isaki
2942 1.2 isaki case AUDIO_GETENC:
2943 1.2 isaki ae = (audio_encoding_t *)addr;
2944 1.2 isaki index = ae->index;
2945 1.2 isaki if (index < 0 || index >= __arraycount(audio_encodings)) {
2946 1.2 isaki error = EINVAL;
2947 1.2 isaki break;
2948 1.2 isaki }
2949 1.2 isaki *ae = audio_encodings[index];
2950 1.2 isaki ae->index = index;
2951 1.2 isaki /*
2952 1.2 isaki * EMULATED always.
2953 1.2 isaki * EMULATED flag at that time used to mean that it could
2954 1.2 isaki * not be passed directly to the hardware as-is. But
2955 1.2 isaki * currently, all formats including hardware native is not
2956 1.2 isaki * passed directly to the hardware. So I set EMULATED
2957 1.2 isaki * flag for all formats.
2958 1.2 isaki */
2959 1.2 isaki ae->flags = AUDIO_ENCODINGFLAG_EMULATED;
2960 1.2 isaki break;
2961 1.2 isaki
2962 1.2 isaki case AUDIO_GETFD:
2963 1.2 isaki /*
2964 1.2 isaki * Returns the current setting of full duplex mode.
2965 1.2 isaki * If HW has full duplex mode and there are two mixers,
2966 1.2 isaki * it is full duplex. Otherwise half duplex.
2967 1.2 isaki */
2968 1.28.2.12 martin error = audio_exlock_enter(sc);
2969 1.28.2.12 martin if (error)
2970 1.28.2.12 martin break;
2971 1.14 isaki fd = (sc->sc_props & AUDIO_PROP_FULLDUPLEX)
2972 1.2 isaki && (sc->sc_pmixer && sc->sc_rmixer);
2973 1.28.2.12 martin audio_exlock_exit(sc);
2974 1.2 isaki *(int *)addr = fd;
2975 1.2 isaki break;
2976 1.2 isaki
2977 1.2 isaki case AUDIO_GETPROPS:
2978 1.14 isaki *(int *)addr = sc->sc_props;
2979 1.2 isaki break;
2980 1.2 isaki
2981 1.2 isaki case AUDIO_QUERYFORMAT:
2982 1.2 isaki query = (audio_format_query_t *)addr;
2983 1.28.2.12 martin mutex_enter(sc->sc_lock);
2984 1.28.2.12 martin error = sc->hw_if->query_format(sc->hw_hdl, query);
2985 1.28.2.12 martin mutex_exit(sc->sc_lock);
2986 1.28.2.12 martin /* Hide internal infomations */
2987 1.28.2.12 martin query->fmt.driver_data = NULL;
2988 1.2 isaki break;
2989 1.2 isaki
2990 1.2 isaki case AUDIO_GETFORMAT:
2991 1.28.2.12 martin error = audio_exlock_enter(sc);
2992 1.28.2.12 martin if (error)
2993 1.28.2.12 martin break;
2994 1.2 isaki audio_mixers_get_format(sc, (struct audio_info *)addr);
2995 1.28.2.12 martin audio_exlock_exit(sc);
2996 1.2 isaki break;
2997 1.2 isaki
2998 1.2 isaki case AUDIO_SETFORMAT:
2999 1.28.2.12 martin error = audio_exlock_enter(sc);
3000 1.2 isaki audio_mixers_get_format(sc, &ai);
3001 1.2 isaki error = audio_mixers_set_format(sc, (struct audio_info *)addr);
3002 1.2 isaki if (error) {
3003 1.2 isaki /* Rollback */
3004 1.2 isaki audio_mixers_set_format(sc, &ai);
3005 1.2 isaki }
3006 1.28.2.12 martin audio_exlock_exit(sc);
3007 1.2 isaki break;
3008 1.2 isaki
3009 1.2 isaki case AUDIO_SETFD:
3010 1.2 isaki case AUDIO_SETCHAN:
3011 1.2 isaki case AUDIO_GETCHAN:
3012 1.2 isaki /* Obsoleted */
3013 1.2 isaki break;
3014 1.2 isaki
3015 1.2 isaki default:
3016 1.2 isaki if (sc->hw_if->dev_ioctl) {
3017 1.28.2.12 martin mutex_enter(sc->sc_lock);
3018 1.2 isaki error = sc->hw_if->dev_ioctl(sc->hw_hdl,
3019 1.2 isaki cmd, addr, flag, l);
3020 1.28.2.12 martin mutex_exit(sc->sc_lock);
3021 1.2 isaki } else {
3022 1.2 isaki TRACEF(2, file, "unknown ioctl");
3023 1.2 isaki error = EINVAL;
3024 1.2 isaki }
3025 1.2 isaki break;
3026 1.2 isaki }
3027 1.2 isaki TRACEF(2, file, "(%lu,'%c',%lu)%s result %d",
3028 1.2 isaki IOCPARM_LEN(cmd), (char)IOCGROUP(cmd), cmd&0xff, ioctlname,
3029 1.2 isaki error);
3030 1.2 isaki return error;
3031 1.2 isaki }
3032 1.2 isaki
3033 1.2 isaki /*
3034 1.2 isaki * Returns the number of bytes that can be read on recording buffer.
3035 1.2 isaki */
3036 1.2 isaki static __inline int
3037 1.2 isaki audio_track_readablebytes(const audio_track_t *track)
3038 1.2 isaki {
3039 1.2 isaki int bytes;
3040 1.2 isaki
3041 1.2 isaki KASSERT(track);
3042 1.2 isaki KASSERT(track->mode == AUMODE_RECORD);
3043 1.2 isaki
3044 1.2 isaki /*
3045 1.2 isaki * Although usrbuf is primarily readable data, recorded data
3046 1.2 isaki * also stays in track->input until reading. So it is necessary
3047 1.2 isaki * to add it. track->input is in frame, usrbuf is in byte.
3048 1.2 isaki */
3049 1.2 isaki bytes = track->usrbuf.used +
3050 1.2 isaki track->input->used * frametobyte(&track->usrbuf.fmt, 1);
3051 1.2 isaki return bytes;
3052 1.2 isaki }
3053 1.2 isaki
3054 1.28.2.8 martin /*
3055 1.28.2.8 martin * Must be called without sc_lock nor sc_exlock held.
3056 1.28.2.8 martin */
3057 1.2 isaki int
3058 1.2 isaki audio_poll(struct audio_softc *sc, int events, struct lwp *l,
3059 1.2 isaki audio_file_t *file)
3060 1.2 isaki {
3061 1.2 isaki audio_track_t *track;
3062 1.2 isaki int revents;
3063 1.2 isaki bool in_is_valid;
3064 1.2 isaki bool out_is_valid;
3065 1.2 isaki
3066 1.2 isaki #if defined(AUDIO_DEBUG)
3067 1.2 isaki #define POLLEV_BITMAP "\177\020" \
3068 1.2 isaki "b\10WRBAND\0" \
3069 1.2 isaki "b\7RDBAND\0" "b\6RDNORM\0" "b\5NVAL\0" "b\4HUP\0" \
3070 1.2 isaki "b\3ERR\0" "b\2OUT\0" "b\1PRI\0" "b\0IN\0"
3071 1.2 isaki char evbuf[64];
3072 1.2 isaki snprintb(evbuf, sizeof(evbuf), POLLEV_BITMAP, events);
3073 1.2 isaki TRACEF(2, file, "pid=%d.%d events=%s",
3074 1.2 isaki (int)curproc->p_pid, (int)l->l_lid, evbuf);
3075 1.2 isaki #endif
3076 1.2 isaki
3077 1.2 isaki revents = 0;
3078 1.2 isaki in_is_valid = false;
3079 1.2 isaki out_is_valid = false;
3080 1.2 isaki if (events & (POLLIN | POLLRDNORM)) {
3081 1.2 isaki track = file->rtrack;
3082 1.2 isaki if (track) {
3083 1.2 isaki int used;
3084 1.2 isaki in_is_valid = true;
3085 1.2 isaki used = audio_track_readablebytes(track);
3086 1.2 isaki if (used > 0)
3087 1.2 isaki revents |= events & (POLLIN | POLLRDNORM);
3088 1.2 isaki }
3089 1.2 isaki }
3090 1.2 isaki if (events & (POLLOUT | POLLWRNORM)) {
3091 1.2 isaki track = file->ptrack;
3092 1.2 isaki if (track) {
3093 1.2 isaki out_is_valid = true;
3094 1.2 isaki if (track->usrbuf.used <= track->usrbuf_usedlow)
3095 1.2 isaki revents |= events & (POLLOUT | POLLWRNORM);
3096 1.2 isaki }
3097 1.2 isaki }
3098 1.2 isaki
3099 1.2 isaki if (revents == 0) {
3100 1.2 isaki mutex_enter(sc->sc_lock);
3101 1.2 isaki if (in_is_valid) {
3102 1.2 isaki TRACEF(3, file, "selrecord rsel");
3103 1.2 isaki selrecord(l, &sc->sc_rsel);
3104 1.2 isaki }
3105 1.2 isaki if (out_is_valid) {
3106 1.2 isaki TRACEF(3, file, "selrecord wsel");
3107 1.2 isaki selrecord(l, &sc->sc_wsel);
3108 1.2 isaki }
3109 1.2 isaki mutex_exit(sc->sc_lock);
3110 1.2 isaki }
3111 1.2 isaki
3112 1.2 isaki #if defined(AUDIO_DEBUG)
3113 1.2 isaki snprintb(evbuf, sizeof(evbuf), POLLEV_BITMAP, revents);
3114 1.2 isaki TRACEF(2, file, "revents=%s", evbuf);
3115 1.2 isaki #endif
3116 1.2 isaki return revents;
3117 1.2 isaki }
3118 1.2 isaki
3119 1.2 isaki static const struct filterops audioread_filtops = {
3120 1.2 isaki .f_isfd = 1,
3121 1.2 isaki .f_attach = NULL,
3122 1.2 isaki .f_detach = filt_audioread_detach,
3123 1.2 isaki .f_event = filt_audioread_event,
3124 1.2 isaki };
3125 1.2 isaki
3126 1.2 isaki static void
3127 1.2 isaki filt_audioread_detach(struct knote *kn)
3128 1.2 isaki {
3129 1.2 isaki struct audio_softc *sc;
3130 1.2 isaki audio_file_t *file;
3131 1.2 isaki
3132 1.2 isaki file = kn->kn_hook;
3133 1.2 isaki sc = file->sc;
3134 1.2 isaki TRACEF(3, file, "");
3135 1.2 isaki
3136 1.2 isaki mutex_enter(sc->sc_lock);
3137 1.2 isaki SLIST_REMOVE(&sc->sc_rsel.sel_klist, kn, knote, kn_selnext);
3138 1.2 isaki mutex_exit(sc->sc_lock);
3139 1.2 isaki }
3140 1.2 isaki
3141 1.2 isaki static int
3142 1.2 isaki filt_audioread_event(struct knote *kn, long hint)
3143 1.2 isaki {
3144 1.2 isaki audio_file_t *file;
3145 1.2 isaki audio_track_t *track;
3146 1.2 isaki
3147 1.2 isaki file = kn->kn_hook;
3148 1.2 isaki track = file->rtrack;
3149 1.2 isaki
3150 1.2 isaki /*
3151 1.2 isaki * kn_data must contain the number of bytes can be read.
3152 1.2 isaki * The return value indicates whether the event occurs or not.
3153 1.2 isaki */
3154 1.2 isaki
3155 1.2 isaki if (track == NULL) {
3156 1.2 isaki /* can not read with this descriptor. */
3157 1.2 isaki kn->kn_data = 0;
3158 1.2 isaki return 0;
3159 1.2 isaki }
3160 1.2 isaki
3161 1.2 isaki kn->kn_data = audio_track_readablebytes(track);
3162 1.2 isaki TRACEF(3, file, "data=%" PRId64, kn->kn_data);
3163 1.2 isaki return kn->kn_data > 0;
3164 1.2 isaki }
3165 1.2 isaki
3166 1.2 isaki static const struct filterops audiowrite_filtops = {
3167 1.2 isaki .f_isfd = 1,
3168 1.2 isaki .f_attach = NULL,
3169 1.2 isaki .f_detach = filt_audiowrite_detach,
3170 1.2 isaki .f_event = filt_audiowrite_event,
3171 1.2 isaki };
3172 1.2 isaki
3173 1.2 isaki static void
3174 1.2 isaki filt_audiowrite_detach(struct knote *kn)
3175 1.2 isaki {
3176 1.2 isaki struct audio_softc *sc;
3177 1.2 isaki audio_file_t *file;
3178 1.2 isaki
3179 1.2 isaki file = kn->kn_hook;
3180 1.2 isaki sc = file->sc;
3181 1.2 isaki TRACEF(3, file, "");
3182 1.2 isaki
3183 1.2 isaki mutex_enter(sc->sc_lock);
3184 1.2 isaki SLIST_REMOVE(&sc->sc_wsel.sel_klist, kn, knote, kn_selnext);
3185 1.2 isaki mutex_exit(sc->sc_lock);
3186 1.2 isaki }
3187 1.2 isaki
3188 1.2 isaki static int
3189 1.2 isaki filt_audiowrite_event(struct knote *kn, long hint)
3190 1.2 isaki {
3191 1.2 isaki audio_file_t *file;
3192 1.2 isaki audio_track_t *track;
3193 1.2 isaki
3194 1.2 isaki file = kn->kn_hook;
3195 1.2 isaki track = file->ptrack;
3196 1.2 isaki
3197 1.2 isaki /*
3198 1.2 isaki * kn_data must contain the number of bytes can be write.
3199 1.2 isaki * The return value indicates whether the event occurs or not.
3200 1.2 isaki */
3201 1.2 isaki
3202 1.2 isaki if (track == NULL) {
3203 1.2 isaki /* can not write with this descriptor. */
3204 1.2 isaki kn->kn_data = 0;
3205 1.2 isaki return 0;
3206 1.2 isaki }
3207 1.2 isaki
3208 1.2 isaki kn->kn_data = track->usrbuf_usedhigh - track->usrbuf.used;
3209 1.2 isaki TRACEF(3, file, "data=%" PRId64, kn->kn_data);
3210 1.2 isaki return (track->usrbuf.used < track->usrbuf_usedlow);
3211 1.2 isaki }
3212 1.2 isaki
3213 1.28.2.8 martin /*
3214 1.28.2.8 martin * Must be called without sc_lock nor sc_exlock held.
3215 1.28.2.8 martin */
3216 1.2 isaki int
3217 1.2 isaki audio_kqfilter(struct audio_softc *sc, audio_file_t *file, struct knote *kn)
3218 1.2 isaki {
3219 1.2 isaki struct klist *klist;
3220 1.2 isaki
3221 1.2 isaki TRACEF(3, file, "kn=%p kn_filter=%x", kn, (int)kn->kn_filter);
3222 1.2 isaki
3223 1.28.2.12 martin mutex_enter(sc->sc_lock);
3224 1.2 isaki switch (kn->kn_filter) {
3225 1.2 isaki case EVFILT_READ:
3226 1.2 isaki klist = &sc->sc_rsel.sel_klist;
3227 1.2 isaki kn->kn_fop = &audioread_filtops;
3228 1.2 isaki break;
3229 1.2 isaki
3230 1.2 isaki case EVFILT_WRITE:
3231 1.2 isaki klist = &sc->sc_wsel.sel_klist;
3232 1.2 isaki kn->kn_fop = &audiowrite_filtops;
3233 1.2 isaki break;
3234 1.2 isaki
3235 1.2 isaki default:
3236 1.28.2.12 martin mutex_exit(sc->sc_lock);
3237 1.2 isaki return EINVAL;
3238 1.2 isaki }
3239 1.2 isaki
3240 1.2 isaki kn->kn_hook = file;
3241 1.2 isaki
3242 1.2 isaki SLIST_INSERT_HEAD(klist, kn, kn_selnext);
3243 1.2 isaki mutex_exit(sc->sc_lock);
3244 1.2 isaki
3245 1.2 isaki return 0;
3246 1.2 isaki }
3247 1.2 isaki
3248 1.28.2.8 martin /*
3249 1.28.2.8 martin * Must be called without sc_lock nor sc_exlock held.
3250 1.28.2.8 martin */
3251 1.2 isaki int
3252 1.2 isaki audio_mmap(struct audio_softc *sc, off_t *offp, size_t len, int prot,
3253 1.2 isaki int *flagsp, int *advicep, struct uvm_object **uobjp, int *maxprotp,
3254 1.2 isaki audio_file_t *file)
3255 1.2 isaki {
3256 1.2 isaki audio_track_t *track;
3257 1.2 isaki vsize_t vsize;
3258 1.2 isaki int error;
3259 1.2 isaki
3260 1.2 isaki TRACEF(2, file, "off=%lld, prot=%d", (long long)(*offp), prot);
3261 1.2 isaki
3262 1.2 isaki if (*offp < 0)
3263 1.2 isaki return EINVAL;
3264 1.2 isaki
3265 1.2 isaki #if 0
3266 1.2 isaki /* XXX
3267 1.2 isaki * The idea here was to use the protection to determine if
3268 1.2 isaki * we are mapping the read or write buffer, but it fails.
3269 1.2 isaki * The VM system is broken in (at least) two ways.
3270 1.2 isaki * 1) If you map memory VM_PROT_WRITE you SIGSEGV
3271 1.2 isaki * when writing to it, so VM_PROT_READ|VM_PROT_WRITE
3272 1.2 isaki * has to be used for mmapping the play buffer.
3273 1.2 isaki * 2) Even if calling mmap() with VM_PROT_READ|VM_PROT_WRITE
3274 1.2 isaki * audio_mmap will get called at some point with VM_PROT_READ
3275 1.2 isaki * only.
3276 1.2 isaki * So, alas, we always map the play buffer for now.
3277 1.2 isaki */
3278 1.2 isaki if (prot == (VM_PROT_READ|VM_PROT_WRITE) ||
3279 1.2 isaki prot == VM_PROT_WRITE)
3280 1.2 isaki track = file->ptrack;
3281 1.2 isaki else if (prot == VM_PROT_READ)
3282 1.2 isaki track = file->rtrack;
3283 1.2 isaki else
3284 1.2 isaki return EINVAL;
3285 1.2 isaki #else
3286 1.2 isaki track = file->ptrack;
3287 1.2 isaki #endif
3288 1.2 isaki if (track == NULL)
3289 1.2 isaki return EACCES;
3290 1.2 isaki
3291 1.2 isaki vsize = roundup2(MAX(track->usrbuf.capacity, PAGE_SIZE), PAGE_SIZE);
3292 1.2 isaki if (len > vsize)
3293 1.2 isaki return EOVERFLOW;
3294 1.2 isaki if (*offp > (uint)(vsize - len))
3295 1.2 isaki return EOVERFLOW;
3296 1.2 isaki
3297 1.2 isaki /* XXX TODO: what happens when mmap twice. */
3298 1.2 isaki if (!track->mmapped) {
3299 1.2 isaki track->mmapped = true;
3300 1.2 isaki
3301 1.2 isaki if (!track->is_pause) {
3302 1.28.2.12 martin error = audio_exlock_mutex_enter(sc);
3303 1.2 isaki if (error)
3304 1.2 isaki return error;
3305 1.2 isaki if (sc->sc_pbusy == false)
3306 1.2 isaki audio_pmixer_start(sc, true);
3307 1.28.2.12 martin audio_exlock_mutex_exit(sc);
3308 1.2 isaki }
3309 1.2 isaki /* XXX mmapping record buffer is not supported */
3310 1.2 isaki }
3311 1.2 isaki
3312 1.2 isaki /* get ringbuffer */
3313 1.2 isaki *uobjp = track->uobj;
3314 1.2 isaki
3315 1.2 isaki /* Acquire a reference for the mmap. munmap will release. */
3316 1.2 isaki uao_reference(*uobjp);
3317 1.2 isaki *maxprotp = prot;
3318 1.2 isaki *advicep = UVM_ADV_RANDOM;
3319 1.2 isaki *flagsp = MAP_SHARED;
3320 1.2 isaki return 0;
3321 1.2 isaki }
3322 1.2 isaki
3323 1.2 isaki /*
3324 1.2 isaki * /dev/audioctl has to be able to open at any time without interference
3325 1.2 isaki * with any /dev/audio or /dev/sound.
3326 1.28.2.12 martin * Must be called with sc_exlock held and without sc_lock held.
3327 1.2 isaki */
3328 1.2 isaki static int
3329 1.2 isaki audioctl_open(dev_t dev, struct audio_softc *sc, int flags, int ifmt,
3330 1.2 isaki struct lwp *l)
3331 1.2 isaki {
3332 1.2 isaki struct file *fp;
3333 1.2 isaki audio_file_t *af;
3334 1.2 isaki int fd;
3335 1.2 isaki int error;
3336 1.2 isaki
3337 1.2 isaki KASSERT(sc->sc_exlock);
3338 1.2 isaki
3339 1.2 isaki TRACE(1, "");
3340 1.2 isaki
3341 1.2 isaki error = fd_allocfile(&fp, &fd);
3342 1.2 isaki if (error)
3343 1.2 isaki return error;
3344 1.2 isaki
3345 1.2 isaki af = kmem_zalloc(sizeof(audio_file_t), KM_SLEEP);
3346 1.2 isaki af->sc = sc;
3347 1.2 isaki af->dev = dev;
3348 1.2 isaki
3349 1.2 isaki /* Not necessary to insert sc_files. */
3350 1.2 isaki
3351 1.2 isaki error = fd_clone(fp, fd, flags, &audio_fileops, af);
3352 1.28.2.8 martin KASSERTMSG(error == EMOVEFD, "error=%d", error);
3353 1.2 isaki
3354 1.2 isaki return error;
3355 1.2 isaki }
3356 1.2 isaki
3357 1.2 isaki /*
3358 1.2 isaki * Free 'mem' if available, and initialize the pointer.
3359 1.2 isaki * For this reason, this is implemented as macro.
3360 1.2 isaki */
3361 1.2 isaki #define audio_free(mem) do { \
3362 1.2 isaki if (mem != NULL) { \
3363 1.2 isaki kern_free(mem); \
3364 1.2 isaki mem = NULL; \
3365 1.2 isaki } \
3366 1.2 isaki } while (0)
3367 1.2 isaki
3368 1.2 isaki /*
3369 1.28.2.5 martin * (Re)allocate 'memblock' with specified 'bytes'.
3370 1.28.2.5 martin * bytes must not be 0.
3371 1.28.2.5 martin * This function never returns NULL.
3372 1.28.2.5 martin */
3373 1.28.2.5 martin static void *
3374 1.28.2.5 martin audio_realloc(void *memblock, size_t bytes)
3375 1.28.2.5 martin {
3376 1.28.2.5 martin
3377 1.28.2.5 martin KASSERT(bytes != 0);
3378 1.28.2.5 martin audio_free(memblock);
3379 1.28.2.5 martin return kern_malloc(bytes, M_WAITOK);
3380 1.28.2.5 martin }
3381 1.28.2.5 martin
3382 1.28.2.5 martin /*
3383 1.2 isaki * (Re)allocate usrbuf with 'newbufsize' bytes.
3384 1.2 isaki * Use this function for usrbuf because only usrbuf can be mmapped.
3385 1.2 isaki * If successful, it updates track->usrbuf.mem, track->usrbuf.capacity and
3386 1.2 isaki * returns 0. Otherwise, it clears track->usrbuf.mem, track->usrbuf.capacity
3387 1.2 isaki * and returns errno.
3388 1.2 isaki * It must be called before updating usrbuf.capacity.
3389 1.2 isaki */
3390 1.2 isaki static int
3391 1.2 isaki audio_realloc_usrbuf(audio_track_t *track, int newbufsize)
3392 1.2 isaki {
3393 1.2 isaki struct audio_softc *sc;
3394 1.2 isaki vaddr_t vstart;
3395 1.2 isaki vsize_t oldvsize;
3396 1.2 isaki vsize_t newvsize;
3397 1.2 isaki int error;
3398 1.2 isaki
3399 1.2 isaki KASSERT(newbufsize > 0);
3400 1.2 isaki sc = track->mixer->sc;
3401 1.2 isaki
3402 1.2 isaki /* Get a nonzero multiple of PAGE_SIZE */
3403 1.2 isaki newvsize = roundup2(MAX(newbufsize, PAGE_SIZE), PAGE_SIZE);
3404 1.2 isaki
3405 1.2 isaki if (track->usrbuf.mem != NULL) {
3406 1.2 isaki oldvsize = roundup2(MAX(track->usrbuf.capacity, PAGE_SIZE),
3407 1.2 isaki PAGE_SIZE);
3408 1.2 isaki if (oldvsize == newvsize) {
3409 1.2 isaki track->usrbuf.capacity = newbufsize;
3410 1.2 isaki return 0;
3411 1.2 isaki }
3412 1.2 isaki vstart = (vaddr_t)track->usrbuf.mem;
3413 1.2 isaki uvm_unmap(kernel_map, vstart, vstart + oldvsize);
3414 1.2 isaki /* uvm_unmap also detach uobj */
3415 1.2 isaki track->uobj = NULL; /* paranoia */
3416 1.2 isaki track->usrbuf.mem = NULL;
3417 1.2 isaki }
3418 1.2 isaki
3419 1.2 isaki /* Create a uvm anonymous object */
3420 1.2 isaki track->uobj = uao_create(newvsize, 0);
3421 1.2 isaki
3422 1.2 isaki /* Map it into the kernel virtual address space */
3423 1.2 isaki vstart = 0;
3424 1.2 isaki error = uvm_map(kernel_map, &vstart, newvsize, track->uobj, 0, 0,
3425 1.2 isaki UVM_MAPFLAG(UVM_PROT_RW, UVM_PROT_RW, UVM_INH_NONE,
3426 1.2 isaki UVM_ADV_RANDOM, 0));
3427 1.2 isaki if (error) {
3428 1.2 isaki device_printf(sc->sc_dev, "uvm_map failed with %d\n", error);
3429 1.2 isaki uao_detach(track->uobj); /* release reference */
3430 1.2 isaki goto abort;
3431 1.2 isaki }
3432 1.2 isaki
3433 1.2 isaki error = uvm_map_pageable(kernel_map, vstart, vstart + newvsize,
3434 1.2 isaki false, 0);
3435 1.2 isaki if (error) {
3436 1.2 isaki device_printf(sc->sc_dev, "uvm_map_pageable failed with %d\n",
3437 1.2 isaki error);
3438 1.2 isaki uvm_unmap(kernel_map, vstart, vstart + newvsize);
3439 1.2 isaki /* uvm_unmap also detach uobj */
3440 1.2 isaki goto abort;
3441 1.2 isaki }
3442 1.2 isaki
3443 1.2 isaki track->usrbuf.mem = (void *)vstart;
3444 1.2 isaki track->usrbuf.capacity = newbufsize;
3445 1.2 isaki memset(track->usrbuf.mem, 0, newvsize);
3446 1.2 isaki return 0;
3447 1.2 isaki
3448 1.2 isaki /* failure */
3449 1.2 isaki abort:
3450 1.2 isaki track->uobj = NULL; /* paranoia */
3451 1.2 isaki track->usrbuf.mem = NULL;
3452 1.2 isaki track->usrbuf.capacity = 0;
3453 1.2 isaki return error;
3454 1.2 isaki }
3455 1.2 isaki
3456 1.2 isaki /*
3457 1.2 isaki * Free usrbuf (if available).
3458 1.2 isaki */
3459 1.2 isaki static void
3460 1.2 isaki audio_free_usrbuf(audio_track_t *track)
3461 1.2 isaki {
3462 1.2 isaki vaddr_t vstart;
3463 1.2 isaki vsize_t vsize;
3464 1.2 isaki
3465 1.2 isaki vstart = (vaddr_t)track->usrbuf.mem;
3466 1.2 isaki vsize = roundup2(MAX(track->usrbuf.capacity, PAGE_SIZE), PAGE_SIZE);
3467 1.2 isaki if (track->usrbuf.mem != NULL) {
3468 1.2 isaki /*
3469 1.2 isaki * Unmap the kernel mapping. uvm_unmap releases the
3470 1.2 isaki * reference to the uvm object, and this should be the
3471 1.2 isaki * last virtual mapping of the uvm object, so no need
3472 1.2 isaki * to explicitly release (`detach') the object.
3473 1.2 isaki */
3474 1.2 isaki uvm_unmap(kernel_map, vstart, vstart + vsize);
3475 1.2 isaki
3476 1.2 isaki track->uobj = NULL;
3477 1.2 isaki track->usrbuf.mem = NULL;
3478 1.2 isaki track->usrbuf.capacity = 0;
3479 1.2 isaki }
3480 1.2 isaki }
3481 1.2 isaki
3482 1.2 isaki /*
3483 1.2 isaki * This filter changes the volume for each channel.
3484 1.2 isaki * arg->context points track->ch_volume[].
3485 1.2 isaki */
3486 1.2 isaki static void
3487 1.2 isaki audio_track_chvol(audio_filter_arg_t *arg)
3488 1.2 isaki {
3489 1.2 isaki int16_t *ch_volume;
3490 1.2 isaki const aint_t *s;
3491 1.2 isaki aint_t *d;
3492 1.2 isaki u_int i;
3493 1.2 isaki u_int ch;
3494 1.2 isaki u_int channels;
3495 1.2 isaki
3496 1.2 isaki DIAGNOSTIC_filter_arg(arg);
3497 1.28.2.8 martin KASSERTMSG(arg->srcfmt->channels == arg->dstfmt->channels,
3498 1.28.2.8 martin "arg->srcfmt->channels=%d, arg->dstfmt->channels=%d",
3499 1.28.2.8 martin arg->srcfmt->channels, arg->dstfmt->channels);
3500 1.2 isaki KASSERT(arg->context != NULL);
3501 1.28.2.8 martin KASSERTMSG(arg->srcfmt->channels <= AUDIO_MAX_CHANNELS,
3502 1.28.2.8 martin "arg->srcfmt->channels=%d", arg->srcfmt->channels);
3503 1.2 isaki
3504 1.2 isaki s = arg->src;
3505 1.2 isaki d = arg->dst;
3506 1.2 isaki ch_volume = arg->context;
3507 1.2 isaki
3508 1.2 isaki channels = arg->srcfmt->channels;
3509 1.2 isaki for (i = 0; i < arg->count; i++) {
3510 1.2 isaki for (ch = 0; ch < channels; ch++) {
3511 1.2 isaki aint2_t val;
3512 1.2 isaki val = *s++;
3513 1.16 isaki val = AUDIO_SCALEDOWN(val * ch_volume[ch], 8);
3514 1.2 isaki *d++ = (aint_t)val;
3515 1.2 isaki }
3516 1.2 isaki }
3517 1.2 isaki }
3518 1.2 isaki
3519 1.2 isaki /*
3520 1.2 isaki * This filter performs conversion from stereo (or more channels) to mono.
3521 1.2 isaki */
3522 1.2 isaki static void
3523 1.2 isaki audio_track_chmix_mixLR(audio_filter_arg_t *arg)
3524 1.2 isaki {
3525 1.2 isaki const aint_t *s;
3526 1.2 isaki aint_t *d;
3527 1.2 isaki u_int i;
3528 1.2 isaki
3529 1.2 isaki DIAGNOSTIC_filter_arg(arg);
3530 1.2 isaki
3531 1.2 isaki s = arg->src;
3532 1.2 isaki d = arg->dst;
3533 1.2 isaki
3534 1.2 isaki for (i = 0; i < arg->count; i++) {
3535 1.16 isaki *d++ = AUDIO_SCALEDOWN(s[0], 1) + AUDIO_SCALEDOWN(s[1], 1);
3536 1.2 isaki s += arg->srcfmt->channels;
3537 1.2 isaki }
3538 1.2 isaki }
3539 1.2 isaki
3540 1.2 isaki /*
3541 1.2 isaki * This filter performs conversion from mono to stereo (or more channels).
3542 1.2 isaki */
3543 1.2 isaki static void
3544 1.2 isaki audio_track_chmix_dupLR(audio_filter_arg_t *arg)
3545 1.2 isaki {
3546 1.2 isaki const aint_t *s;
3547 1.2 isaki aint_t *d;
3548 1.2 isaki u_int i;
3549 1.2 isaki u_int ch;
3550 1.2 isaki u_int dstchannels;
3551 1.2 isaki
3552 1.2 isaki DIAGNOSTIC_filter_arg(arg);
3553 1.2 isaki
3554 1.2 isaki s = arg->src;
3555 1.2 isaki d = arg->dst;
3556 1.2 isaki dstchannels = arg->dstfmt->channels;
3557 1.2 isaki
3558 1.2 isaki for (i = 0; i < arg->count; i++) {
3559 1.2 isaki d[0] = s[0];
3560 1.2 isaki d[1] = s[0];
3561 1.2 isaki s++;
3562 1.2 isaki d += dstchannels;
3563 1.2 isaki }
3564 1.2 isaki if (dstchannels > 2) {
3565 1.2 isaki d = arg->dst;
3566 1.2 isaki for (i = 0; i < arg->count; i++) {
3567 1.2 isaki for (ch = 2; ch < dstchannels; ch++) {
3568 1.2 isaki d[ch] = 0;
3569 1.2 isaki }
3570 1.2 isaki d += dstchannels;
3571 1.2 isaki }
3572 1.2 isaki }
3573 1.2 isaki }
3574 1.2 isaki
3575 1.2 isaki /*
3576 1.2 isaki * This filter shrinks M channels into N channels.
3577 1.2 isaki * Extra channels are discarded.
3578 1.2 isaki */
3579 1.2 isaki static void
3580 1.2 isaki audio_track_chmix_shrink(audio_filter_arg_t *arg)
3581 1.2 isaki {
3582 1.2 isaki const aint_t *s;
3583 1.2 isaki aint_t *d;
3584 1.2 isaki u_int i;
3585 1.2 isaki u_int ch;
3586 1.2 isaki
3587 1.2 isaki DIAGNOSTIC_filter_arg(arg);
3588 1.2 isaki
3589 1.2 isaki s = arg->src;
3590 1.2 isaki d = arg->dst;
3591 1.2 isaki
3592 1.2 isaki for (i = 0; i < arg->count; i++) {
3593 1.2 isaki for (ch = 0; ch < arg->dstfmt->channels; ch++) {
3594 1.2 isaki *d++ = s[ch];
3595 1.2 isaki }
3596 1.2 isaki s += arg->srcfmt->channels;
3597 1.2 isaki }
3598 1.2 isaki }
3599 1.2 isaki
3600 1.2 isaki /*
3601 1.2 isaki * This filter expands M channels into N channels.
3602 1.2 isaki * Silence is inserted for missing channels.
3603 1.2 isaki */
3604 1.2 isaki static void
3605 1.2 isaki audio_track_chmix_expand(audio_filter_arg_t *arg)
3606 1.2 isaki {
3607 1.2 isaki const aint_t *s;
3608 1.2 isaki aint_t *d;
3609 1.2 isaki u_int i;
3610 1.2 isaki u_int ch;
3611 1.2 isaki u_int srcchannels;
3612 1.2 isaki u_int dstchannels;
3613 1.2 isaki
3614 1.2 isaki DIAGNOSTIC_filter_arg(arg);
3615 1.2 isaki
3616 1.2 isaki s = arg->src;
3617 1.2 isaki d = arg->dst;
3618 1.2 isaki
3619 1.2 isaki srcchannels = arg->srcfmt->channels;
3620 1.2 isaki dstchannels = arg->dstfmt->channels;
3621 1.2 isaki for (i = 0; i < arg->count; i++) {
3622 1.2 isaki for (ch = 0; ch < srcchannels; ch++) {
3623 1.2 isaki *d++ = *s++;
3624 1.2 isaki }
3625 1.2 isaki for (; ch < dstchannels; ch++) {
3626 1.2 isaki *d++ = 0;
3627 1.2 isaki }
3628 1.2 isaki }
3629 1.2 isaki }
3630 1.2 isaki
3631 1.2 isaki /*
3632 1.2 isaki * This filter performs frequency conversion (up sampling).
3633 1.2 isaki * It uses linear interpolation.
3634 1.2 isaki */
3635 1.2 isaki static void
3636 1.2 isaki audio_track_freq_up(audio_filter_arg_t *arg)
3637 1.2 isaki {
3638 1.2 isaki audio_track_t *track;
3639 1.2 isaki audio_ring_t *src;
3640 1.2 isaki audio_ring_t *dst;
3641 1.2 isaki const aint_t *s;
3642 1.2 isaki aint_t *d;
3643 1.2 isaki aint_t prev[AUDIO_MAX_CHANNELS];
3644 1.2 isaki aint_t curr[AUDIO_MAX_CHANNELS];
3645 1.2 isaki aint_t grad[AUDIO_MAX_CHANNELS];
3646 1.2 isaki u_int i;
3647 1.2 isaki u_int t;
3648 1.2 isaki u_int step;
3649 1.2 isaki u_int channels;
3650 1.2 isaki u_int ch;
3651 1.2 isaki int srcused;
3652 1.2 isaki
3653 1.2 isaki track = arg->context;
3654 1.2 isaki KASSERT(track);
3655 1.2 isaki src = &track->freq.srcbuf;
3656 1.2 isaki dst = track->freq.dst;
3657 1.2 isaki DIAGNOSTIC_ring(dst);
3658 1.2 isaki DIAGNOSTIC_ring(src);
3659 1.2 isaki KASSERT(src->used > 0);
3660 1.28.2.8 martin KASSERTMSG(src->fmt.channels == dst->fmt.channels,
3661 1.28.2.8 martin "src->fmt.channels=%d dst->fmt.channels=%d",
3662 1.28.2.8 martin src->fmt.channels, dst->fmt.channels);
3663 1.28.2.8 martin KASSERTMSG(src->head % track->mixer->frames_per_block == 0,
3664 1.28.2.8 martin "src->head=%d track->mixer->frames_per_block=%d",
3665 1.28.2.8 martin src->head, track->mixer->frames_per_block);
3666 1.2 isaki
3667 1.2 isaki s = arg->src;
3668 1.2 isaki d = arg->dst;
3669 1.2 isaki
3670 1.2 isaki /*
3671 1.2 isaki * In order to faciliate interpolation for each block, slide (delay)
3672 1.2 isaki * input by one sample. As a result, strictly speaking, the output
3673 1.2 isaki * phase is delayed by 1/dstfreq. However, I believe there is no
3674 1.2 isaki * observable impact.
3675 1.2 isaki *
3676 1.2 isaki * Example)
3677 1.2 isaki * srcfreq:dstfreq = 1:3
3678 1.2 isaki *
3679 1.2 isaki * A - -
3680 1.2 isaki * |
3681 1.2 isaki * |
3682 1.2 isaki * | B - -
3683 1.2 isaki * +-----+-----> input timeframe
3684 1.2 isaki * 0 1
3685 1.2 isaki *
3686 1.2 isaki * 0 1
3687 1.2 isaki * +-----+-----> input timeframe
3688 1.2 isaki * | A
3689 1.2 isaki * | x x
3690 1.2 isaki * | x x
3691 1.2 isaki * x (B)
3692 1.2 isaki * +-+-+-+-+-+-> output timeframe
3693 1.2 isaki * 0 1 2 3 4 5
3694 1.2 isaki */
3695 1.2 isaki
3696 1.2 isaki /* Last samples in previous block */
3697 1.2 isaki channels = src->fmt.channels;
3698 1.2 isaki for (ch = 0; ch < channels; ch++) {
3699 1.2 isaki prev[ch] = track->freq_prev[ch];
3700 1.2 isaki curr[ch] = track->freq_curr[ch];
3701 1.2 isaki grad[ch] = curr[ch] - prev[ch];
3702 1.2 isaki }
3703 1.2 isaki
3704 1.2 isaki step = track->freq_step;
3705 1.2 isaki t = track->freq_current;
3706 1.2 isaki //#define FREQ_DEBUG
3707 1.2 isaki #if defined(FREQ_DEBUG)
3708 1.2 isaki #define PRINTF(fmt...) printf(fmt)
3709 1.2 isaki #else
3710 1.2 isaki #define PRINTF(fmt...) do { } while (0)
3711 1.2 isaki #endif
3712 1.2 isaki srcused = src->used;
3713 1.2 isaki PRINTF("upstart step=%d leap=%d", step, track->freq_leap);
3714 1.2 isaki PRINTF(" srcused=%d arg->count=%u", src->used, arg->count);
3715 1.2 isaki PRINTF(" prev=%d curr=%d grad=%d", prev[0], curr[0], grad[0]);
3716 1.2 isaki PRINTF(" t=%d\n", t);
3717 1.2 isaki
3718 1.2 isaki for (i = 0; i < arg->count; i++) {
3719 1.2 isaki PRINTF("i=%d t=%5d", i, t);
3720 1.2 isaki if (t >= 65536) {
3721 1.2 isaki for (ch = 0; ch < channels; ch++) {
3722 1.2 isaki prev[ch] = curr[ch];
3723 1.2 isaki curr[ch] = *s++;
3724 1.2 isaki grad[ch] = curr[ch] - prev[ch];
3725 1.2 isaki }
3726 1.2 isaki PRINTF(" prev=%d s[%d]=%d",
3727 1.2 isaki prev[0], src->used - srcused, curr[0]);
3728 1.2 isaki
3729 1.2 isaki /* Update */
3730 1.2 isaki t -= 65536;
3731 1.2 isaki srcused--;
3732 1.2 isaki if (srcused < 0) {
3733 1.2 isaki PRINTF(" break\n");
3734 1.2 isaki break;
3735 1.2 isaki }
3736 1.2 isaki }
3737 1.2 isaki
3738 1.2 isaki for (ch = 0; ch < channels; ch++) {
3739 1.2 isaki *d++ = prev[ch] + (aint2_t)grad[ch] * t / 65536;
3740 1.2 isaki #if defined(FREQ_DEBUG)
3741 1.2 isaki if (ch == 0)
3742 1.2 isaki printf(" t=%5d *d=%d", t, d[-1]);
3743 1.2 isaki #endif
3744 1.2 isaki }
3745 1.2 isaki t += step;
3746 1.2 isaki
3747 1.2 isaki PRINTF("\n");
3748 1.2 isaki }
3749 1.2 isaki PRINTF("end prev=%d curr=%d\n", prev[0], curr[0]);
3750 1.2 isaki
3751 1.2 isaki auring_take(src, src->used);
3752 1.2 isaki auring_push(dst, i);
3753 1.2 isaki
3754 1.2 isaki /* Adjust */
3755 1.2 isaki t += track->freq_leap;
3756 1.2 isaki
3757 1.2 isaki track->freq_current = t;
3758 1.2 isaki for (ch = 0; ch < channels; ch++) {
3759 1.2 isaki track->freq_prev[ch] = prev[ch];
3760 1.2 isaki track->freq_curr[ch] = curr[ch];
3761 1.2 isaki }
3762 1.2 isaki }
3763 1.2 isaki
3764 1.2 isaki /*
3765 1.2 isaki * This filter performs frequency conversion (down sampling).
3766 1.2 isaki * It uses simple thinning.
3767 1.2 isaki */
3768 1.2 isaki static void
3769 1.2 isaki audio_track_freq_down(audio_filter_arg_t *arg)
3770 1.2 isaki {
3771 1.2 isaki audio_track_t *track;
3772 1.2 isaki audio_ring_t *src;
3773 1.2 isaki audio_ring_t *dst;
3774 1.2 isaki const aint_t *s0;
3775 1.2 isaki aint_t *d;
3776 1.2 isaki u_int i;
3777 1.2 isaki u_int t;
3778 1.2 isaki u_int step;
3779 1.2 isaki u_int ch;
3780 1.2 isaki u_int channels;
3781 1.2 isaki
3782 1.2 isaki track = arg->context;
3783 1.2 isaki KASSERT(track);
3784 1.2 isaki src = &track->freq.srcbuf;
3785 1.2 isaki dst = track->freq.dst;
3786 1.2 isaki
3787 1.2 isaki DIAGNOSTIC_ring(dst);
3788 1.2 isaki DIAGNOSTIC_ring(src);
3789 1.2 isaki KASSERT(src->used > 0);
3790 1.28.2.8 martin KASSERTMSG(src->fmt.channels == dst->fmt.channels,
3791 1.28.2.8 martin "src->fmt.channels=%d dst->fmt.channels=%d",
3792 1.28.2.8 martin src->fmt.channels, dst->fmt.channels);
3793 1.2 isaki KASSERTMSG(src->head % track->mixer->frames_per_block == 0,
3794 1.28.2.8 martin "src->head=%d track->mixer->frames_per_block=%d",
3795 1.2 isaki src->head, track->mixer->frames_per_block);
3796 1.2 isaki
3797 1.2 isaki s0 = arg->src;
3798 1.2 isaki d = arg->dst;
3799 1.2 isaki t = track->freq_current;
3800 1.2 isaki step = track->freq_step;
3801 1.2 isaki channels = dst->fmt.channels;
3802 1.2 isaki PRINTF("downstart step=%d leap=%d", step, track->freq_leap);
3803 1.2 isaki PRINTF(" srcused=%d arg->count=%u", src->used, arg->count);
3804 1.2 isaki PRINTF(" t=%d\n", t);
3805 1.2 isaki
3806 1.2 isaki for (i = 0; i < arg->count && t / 65536 < src->used; i++) {
3807 1.2 isaki const aint_t *s;
3808 1.2 isaki PRINTF("i=%4d t=%10d", i, t);
3809 1.2 isaki s = s0 + (t / 65536) * channels;
3810 1.2 isaki PRINTF(" s=%5ld", (s - s0) / channels);
3811 1.2 isaki for (ch = 0; ch < channels; ch++) {
3812 1.2 isaki if (ch == 0) PRINTF(" *s=%d", s[ch]);
3813 1.2 isaki *d++ = s[ch];
3814 1.2 isaki }
3815 1.2 isaki PRINTF("\n");
3816 1.2 isaki t += step;
3817 1.2 isaki }
3818 1.2 isaki t += track->freq_leap;
3819 1.2 isaki PRINTF("end t=%d\n", t);
3820 1.2 isaki auring_take(src, src->used);
3821 1.2 isaki auring_push(dst, i);
3822 1.2 isaki track->freq_current = t % 65536;
3823 1.2 isaki }
3824 1.2 isaki
3825 1.2 isaki /*
3826 1.2 isaki * Creates track and returns it.
3827 1.28.2.12 martin * Must be called without sc_lock held.
3828 1.2 isaki */
3829 1.2 isaki audio_track_t *
3830 1.2 isaki audio_track_create(struct audio_softc *sc, audio_trackmixer_t *mixer)
3831 1.2 isaki {
3832 1.2 isaki audio_track_t *track;
3833 1.2 isaki static int newid = 0;
3834 1.2 isaki
3835 1.2 isaki track = kmem_zalloc(sizeof(*track), KM_SLEEP);
3836 1.2 isaki
3837 1.2 isaki track->id = newid++;
3838 1.2 isaki track->mixer = mixer;
3839 1.2 isaki track->mode = mixer->mode;
3840 1.2 isaki
3841 1.2 isaki /* Do TRACE after id is assigned. */
3842 1.2 isaki TRACET(3, track, "for %s",
3843 1.2 isaki mixer->mode == AUMODE_PLAY ? "playback" : "recording");
3844 1.2 isaki
3845 1.2 isaki #if defined(AUDIO_SUPPORT_TRACK_VOLUME)
3846 1.2 isaki track->volume = 256;
3847 1.2 isaki #endif
3848 1.2 isaki for (int i = 0; i < AUDIO_MAX_CHANNELS; i++) {
3849 1.2 isaki track->ch_volume[i] = 256;
3850 1.2 isaki }
3851 1.2 isaki
3852 1.2 isaki return track;
3853 1.2 isaki }
3854 1.2 isaki
3855 1.2 isaki /*
3856 1.2 isaki * Release all resources of the track and track itself.
3857 1.2 isaki * track must not be NULL. Don't specify the track within the file
3858 1.2 isaki * structure linked from sc->sc_files.
3859 1.2 isaki */
3860 1.2 isaki static void
3861 1.2 isaki audio_track_destroy(audio_track_t *track)
3862 1.2 isaki {
3863 1.2 isaki
3864 1.2 isaki KASSERT(track);
3865 1.2 isaki
3866 1.2 isaki audio_free_usrbuf(track);
3867 1.2 isaki audio_free(track->codec.srcbuf.mem);
3868 1.2 isaki audio_free(track->chvol.srcbuf.mem);
3869 1.2 isaki audio_free(track->chmix.srcbuf.mem);
3870 1.2 isaki audio_free(track->freq.srcbuf.mem);
3871 1.2 isaki audio_free(track->outbuf.mem);
3872 1.2 isaki
3873 1.2 isaki kmem_free(track, sizeof(*track));
3874 1.2 isaki }
3875 1.2 isaki
3876 1.2 isaki /*
3877 1.2 isaki * It returns encoding conversion filter according to src and dst format.
3878 1.2 isaki * If it is not a convertible pair, it returns NULL. Either src or dst
3879 1.2 isaki * must be internal format.
3880 1.2 isaki */
3881 1.2 isaki static audio_filter_t
3882 1.2 isaki audio_track_get_codec(audio_track_t *track, const audio_format2_t *src,
3883 1.2 isaki const audio_format2_t *dst)
3884 1.2 isaki {
3885 1.2 isaki
3886 1.2 isaki if (audio_format2_is_internal(src)) {
3887 1.2 isaki if (dst->encoding == AUDIO_ENCODING_ULAW) {
3888 1.2 isaki return audio_internal_to_mulaw;
3889 1.2 isaki } else if (dst->encoding == AUDIO_ENCODING_ALAW) {
3890 1.2 isaki return audio_internal_to_alaw;
3891 1.2 isaki } else if (audio_format2_is_linear(dst)) {
3892 1.2 isaki switch (dst->stride) {
3893 1.2 isaki case 8:
3894 1.2 isaki return audio_internal_to_linear8;
3895 1.2 isaki case 16:
3896 1.2 isaki return audio_internal_to_linear16;
3897 1.2 isaki #if defined(AUDIO_SUPPORT_LINEAR24)
3898 1.2 isaki case 24:
3899 1.2 isaki return audio_internal_to_linear24;
3900 1.2 isaki #endif
3901 1.2 isaki case 32:
3902 1.2 isaki return audio_internal_to_linear32;
3903 1.2 isaki default:
3904 1.2 isaki TRACET(1, track, "unsupported %s stride %d",
3905 1.2 isaki "dst", dst->stride);
3906 1.2 isaki goto abort;
3907 1.2 isaki }
3908 1.2 isaki }
3909 1.2 isaki } else if (audio_format2_is_internal(dst)) {
3910 1.2 isaki if (src->encoding == AUDIO_ENCODING_ULAW) {
3911 1.2 isaki return audio_mulaw_to_internal;
3912 1.2 isaki } else if (src->encoding == AUDIO_ENCODING_ALAW) {
3913 1.2 isaki return audio_alaw_to_internal;
3914 1.2 isaki } else if (audio_format2_is_linear(src)) {
3915 1.2 isaki switch (src->stride) {
3916 1.2 isaki case 8:
3917 1.2 isaki return audio_linear8_to_internal;
3918 1.2 isaki case 16:
3919 1.2 isaki return audio_linear16_to_internal;
3920 1.2 isaki #if defined(AUDIO_SUPPORT_LINEAR24)
3921 1.2 isaki case 24:
3922 1.2 isaki return audio_linear24_to_internal;
3923 1.2 isaki #endif
3924 1.2 isaki case 32:
3925 1.2 isaki return audio_linear32_to_internal;
3926 1.2 isaki default:
3927 1.2 isaki TRACET(1, track, "unsupported %s stride %d",
3928 1.2 isaki "src", src->stride);
3929 1.2 isaki goto abort;
3930 1.2 isaki }
3931 1.2 isaki }
3932 1.2 isaki }
3933 1.2 isaki
3934 1.2 isaki TRACET(1, track, "unsupported encoding");
3935 1.2 isaki abort:
3936 1.2 isaki #if defined(AUDIO_DEBUG)
3937 1.2 isaki if (audiodebug >= 2) {
3938 1.2 isaki char buf[100];
3939 1.2 isaki audio_format2_tostr(buf, sizeof(buf), src);
3940 1.2 isaki TRACET(2, track, "src %s", buf);
3941 1.2 isaki audio_format2_tostr(buf, sizeof(buf), dst);
3942 1.2 isaki TRACET(2, track, "dst %s", buf);
3943 1.2 isaki }
3944 1.2 isaki #endif
3945 1.2 isaki return NULL;
3946 1.2 isaki }
3947 1.2 isaki
3948 1.2 isaki /*
3949 1.2 isaki * Initialize the codec stage of this track as necessary.
3950 1.2 isaki * If successful, it initializes the codec stage as necessary, stores updated
3951 1.2 isaki * last_dst in *last_dstp in any case, and returns 0.
3952 1.2 isaki * Otherwise, it returns errno without modifying *last_dstp.
3953 1.2 isaki */
3954 1.2 isaki static int
3955 1.2 isaki audio_track_init_codec(audio_track_t *track, audio_ring_t **last_dstp)
3956 1.2 isaki {
3957 1.2 isaki audio_ring_t *last_dst;
3958 1.2 isaki audio_ring_t *srcbuf;
3959 1.2 isaki audio_format2_t *srcfmt;
3960 1.2 isaki audio_format2_t *dstfmt;
3961 1.2 isaki audio_filter_arg_t *arg;
3962 1.2 isaki u_int len;
3963 1.2 isaki int error;
3964 1.2 isaki
3965 1.2 isaki KASSERT(track);
3966 1.2 isaki
3967 1.2 isaki last_dst = *last_dstp;
3968 1.2 isaki dstfmt = &last_dst->fmt;
3969 1.2 isaki srcfmt = &track->inputfmt;
3970 1.2 isaki srcbuf = &track->codec.srcbuf;
3971 1.2 isaki error = 0;
3972 1.2 isaki
3973 1.2 isaki if (srcfmt->encoding != dstfmt->encoding
3974 1.2 isaki || srcfmt->precision != dstfmt->precision
3975 1.2 isaki || srcfmt->stride != dstfmt->stride) {
3976 1.2 isaki track->codec.dst = last_dst;
3977 1.2 isaki
3978 1.2 isaki srcbuf->fmt = *dstfmt;
3979 1.2 isaki srcbuf->fmt.encoding = srcfmt->encoding;
3980 1.2 isaki srcbuf->fmt.precision = srcfmt->precision;
3981 1.2 isaki srcbuf->fmt.stride = srcfmt->stride;
3982 1.2 isaki
3983 1.2 isaki track->codec.filter = audio_track_get_codec(track,
3984 1.2 isaki &srcbuf->fmt, dstfmt);
3985 1.2 isaki if (track->codec.filter == NULL) {
3986 1.2 isaki error = EINVAL;
3987 1.2 isaki goto abort;
3988 1.2 isaki }
3989 1.2 isaki
3990 1.2 isaki srcbuf->head = 0;
3991 1.2 isaki srcbuf->used = 0;
3992 1.2 isaki srcbuf->capacity = frame_per_block(track->mixer, &srcbuf->fmt);
3993 1.2 isaki len = auring_bytelen(srcbuf);
3994 1.2 isaki srcbuf->mem = audio_realloc(srcbuf->mem, len);
3995 1.2 isaki
3996 1.2 isaki arg = &track->codec.arg;
3997 1.2 isaki arg->srcfmt = &srcbuf->fmt;
3998 1.2 isaki arg->dstfmt = dstfmt;
3999 1.2 isaki arg->context = NULL;
4000 1.2 isaki
4001 1.2 isaki *last_dstp = srcbuf;
4002 1.2 isaki return 0;
4003 1.2 isaki }
4004 1.2 isaki
4005 1.2 isaki abort:
4006 1.2 isaki track->codec.filter = NULL;
4007 1.2 isaki audio_free(srcbuf->mem);
4008 1.2 isaki return error;
4009 1.2 isaki }
4010 1.2 isaki
4011 1.2 isaki /*
4012 1.2 isaki * Initialize the chvol stage of this track as necessary.
4013 1.2 isaki * If successful, it initializes the chvol stage as necessary, stores updated
4014 1.2 isaki * last_dst in *last_dstp in any case, and returns 0.
4015 1.2 isaki * Otherwise, it returns errno without modifying *last_dstp.
4016 1.2 isaki */
4017 1.2 isaki static int
4018 1.2 isaki audio_track_init_chvol(audio_track_t *track, audio_ring_t **last_dstp)
4019 1.2 isaki {
4020 1.2 isaki audio_ring_t *last_dst;
4021 1.2 isaki audio_ring_t *srcbuf;
4022 1.2 isaki audio_format2_t *srcfmt;
4023 1.2 isaki audio_format2_t *dstfmt;
4024 1.2 isaki audio_filter_arg_t *arg;
4025 1.2 isaki u_int len;
4026 1.2 isaki int error;
4027 1.2 isaki
4028 1.2 isaki KASSERT(track);
4029 1.2 isaki
4030 1.2 isaki last_dst = *last_dstp;
4031 1.2 isaki dstfmt = &last_dst->fmt;
4032 1.2 isaki srcfmt = &track->inputfmt;
4033 1.2 isaki srcbuf = &track->chvol.srcbuf;
4034 1.2 isaki error = 0;
4035 1.2 isaki
4036 1.2 isaki /* Check whether channel volume conversion is necessary. */
4037 1.2 isaki bool use_chvol = false;
4038 1.2 isaki for (int ch = 0; ch < srcfmt->channels; ch++) {
4039 1.2 isaki if (track->ch_volume[ch] != 256) {
4040 1.2 isaki use_chvol = true;
4041 1.2 isaki break;
4042 1.2 isaki }
4043 1.2 isaki }
4044 1.2 isaki
4045 1.2 isaki if (use_chvol == true) {
4046 1.2 isaki track->chvol.dst = last_dst;
4047 1.2 isaki track->chvol.filter = audio_track_chvol;
4048 1.2 isaki
4049 1.2 isaki srcbuf->fmt = *dstfmt;
4050 1.2 isaki /* no format conversion occurs */
4051 1.2 isaki
4052 1.2 isaki srcbuf->head = 0;
4053 1.2 isaki srcbuf->used = 0;
4054 1.2 isaki srcbuf->capacity = frame_per_block(track->mixer, &srcbuf->fmt);
4055 1.2 isaki len = auring_bytelen(srcbuf);
4056 1.2 isaki srcbuf->mem = audio_realloc(srcbuf->mem, len);
4057 1.2 isaki
4058 1.2 isaki arg = &track->chvol.arg;
4059 1.2 isaki arg->srcfmt = &srcbuf->fmt;
4060 1.2 isaki arg->dstfmt = dstfmt;
4061 1.2 isaki arg->context = track->ch_volume;
4062 1.2 isaki
4063 1.2 isaki *last_dstp = srcbuf;
4064 1.2 isaki return 0;
4065 1.2 isaki }
4066 1.2 isaki
4067 1.2 isaki track->chvol.filter = NULL;
4068 1.2 isaki audio_free(srcbuf->mem);
4069 1.2 isaki return error;
4070 1.2 isaki }
4071 1.2 isaki
4072 1.2 isaki /*
4073 1.2 isaki * Initialize the chmix stage of this track as necessary.
4074 1.2 isaki * If successful, it initializes the chmix stage as necessary, stores updated
4075 1.2 isaki * last_dst in *last_dstp in any case, and returns 0.
4076 1.2 isaki * Otherwise, it returns errno without modifying *last_dstp.
4077 1.2 isaki */
4078 1.2 isaki static int
4079 1.2 isaki audio_track_init_chmix(audio_track_t *track, audio_ring_t **last_dstp)
4080 1.2 isaki {
4081 1.2 isaki audio_ring_t *last_dst;
4082 1.2 isaki audio_ring_t *srcbuf;
4083 1.2 isaki audio_format2_t *srcfmt;
4084 1.2 isaki audio_format2_t *dstfmt;
4085 1.2 isaki audio_filter_arg_t *arg;
4086 1.2 isaki u_int srcch;
4087 1.2 isaki u_int dstch;
4088 1.2 isaki u_int len;
4089 1.2 isaki int error;
4090 1.2 isaki
4091 1.2 isaki KASSERT(track);
4092 1.2 isaki
4093 1.2 isaki last_dst = *last_dstp;
4094 1.2 isaki dstfmt = &last_dst->fmt;
4095 1.2 isaki srcfmt = &track->inputfmt;
4096 1.2 isaki srcbuf = &track->chmix.srcbuf;
4097 1.2 isaki error = 0;
4098 1.2 isaki
4099 1.2 isaki srcch = srcfmt->channels;
4100 1.2 isaki dstch = dstfmt->channels;
4101 1.2 isaki if (srcch != dstch) {
4102 1.2 isaki track->chmix.dst = last_dst;
4103 1.2 isaki
4104 1.2 isaki if (srcch >= 2 && dstch == 1) {
4105 1.2 isaki track->chmix.filter = audio_track_chmix_mixLR;
4106 1.2 isaki } else if (srcch == 1 && dstch >= 2) {
4107 1.2 isaki track->chmix.filter = audio_track_chmix_dupLR;
4108 1.2 isaki } else if (srcch > dstch) {
4109 1.2 isaki track->chmix.filter = audio_track_chmix_shrink;
4110 1.2 isaki } else {
4111 1.2 isaki track->chmix.filter = audio_track_chmix_expand;
4112 1.2 isaki }
4113 1.2 isaki
4114 1.2 isaki srcbuf->fmt = *dstfmt;
4115 1.2 isaki srcbuf->fmt.channels = srcch;
4116 1.2 isaki
4117 1.2 isaki srcbuf->head = 0;
4118 1.2 isaki srcbuf->used = 0;
4119 1.2 isaki /* XXX The buffer size should be able to calculate. */
4120 1.2 isaki srcbuf->capacity = frame_per_block(track->mixer, &srcbuf->fmt);
4121 1.2 isaki len = auring_bytelen(srcbuf);
4122 1.2 isaki srcbuf->mem = audio_realloc(srcbuf->mem, len);
4123 1.2 isaki
4124 1.2 isaki arg = &track->chmix.arg;
4125 1.2 isaki arg->srcfmt = &srcbuf->fmt;
4126 1.2 isaki arg->dstfmt = dstfmt;
4127 1.2 isaki arg->context = NULL;
4128 1.2 isaki
4129 1.2 isaki *last_dstp = srcbuf;
4130 1.2 isaki return 0;
4131 1.2 isaki }
4132 1.2 isaki
4133 1.2 isaki track->chmix.filter = NULL;
4134 1.2 isaki audio_free(srcbuf->mem);
4135 1.2 isaki return error;
4136 1.2 isaki }
4137 1.2 isaki
4138 1.2 isaki /*
4139 1.2 isaki * Initialize the freq stage of this track as necessary.
4140 1.2 isaki * If successful, it initializes the freq stage as necessary, stores updated
4141 1.2 isaki * last_dst in *last_dstp in any case, and returns 0.
4142 1.2 isaki * Otherwise, it returns errno without modifying *last_dstp.
4143 1.2 isaki */
4144 1.2 isaki static int
4145 1.2 isaki audio_track_init_freq(audio_track_t *track, audio_ring_t **last_dstp)
4146 1.2 isaki {
4147 1.2 isaki audio_ring_t *last_dst;
4148 1.2 isaki audio_ring_t *srcbuf;
4149 1.2 isaki audio_format2_t *srcfmt;
4150 1.2 isaki audio_format2_t *dstfmt;
4151 1.2 isaki audio_filter_arg_t *arg;
4152 1.2 isaki uint32_t srcfreq;
4153 1.2 isaki uint32_t dstfreq;
4154 1.2 isaki u_int dst_capacity;
4155 1.2 isaki u_int mod;
4156 1.2 isaki u_int len;
4157 1.2 isaki int error;
4158 1.2 isaki
4159 1.2 isaki KASSERT(track);
4160 1.2 isaki
4161 1.2 isaki last_dst = *last_dstp;
4162 1.2 isaki dstfmt = &last_dst->fmt;
4163 1.2 isaki srcfmt = &track->inputfmt;
4164 1.2 isaki srcbuf = &track->freq.srcbuf;
4165 1.2 isaki error = 0;
4166 1.2 isaki
4167 1.2 isaki srcfreq = srcfmt->sample_rate;
4168 1.2 isaki dstfreq = dstfmt->sample_rate;
4169 1.2 isaki if (srcfreq != dstfreq) {
4170 1.2 isaki track->freq.dst = last_dst;
4171 1.2 isaki
4172 1.2 isaki memset(track->freq_prev, 0, sizeof(track->freq_prev));
4173 1.2 isaki memset(track->freq_curr, 0, sizeof(track->freq_curr));
4174 1.2 isaki
4175 1.2 isaki /* freq_step is the ratio of src/dst when let dst 65536. */
4176 1.2 isaki track->freq_step = (uint64_t)srcfreq * 65536 / dstfreq;
4177 1.2 isaki
4178 1.2 isaki dst_capacity = frame_per_block(track->mixer, dstfmt);
4179 1.2 isaki mod = (uint64_t)srcfreq * 65536 % dstfreq;
4180 1.2 isaki track->freq_leap = (mod * dst_capacity + dstfreq / 2) / dstfreq;
4181 1.2 isaki
4182 1.2 isaki if (track->freq_step < 65536) {
4183 1.2 isaki track->freq.filter = audio_track_freq_up;
4184 1.2 isaki /* In order to carry at the first time. */
4185 1.2 isaki track->freq_current = 65536;
4186 1.2 isaki } else {
4187 1.2 isaki track->freq.filter = audio_track_freq_down;
4188 1.2 isaki track->freq_current = 0;
4189 1.2 isaki }
4190 1.2 isaki
4191 1.2 isaki srcbuf->fmt = *dstfmt;
4192 1.2 isaki srcbuf->fmt.sample_rate = srcfreq;
4193 1.2 isaki
4194 1.2 isaki srcbuf->head = 0;
4195 1.2 isaki srcbuf->used = 0;
4196 1.2 isaki srcbuf->capacity = frame_per_block(track->mixer, &srcbuf->fmt);
4197 1.2 isaki len = auring_bytelen(srcbuf);
4198 1.2 isaki srcbuf->mem = audio_realloc(srcbuf->mem, len);
4199 1.2 isaki
4200 1.2 isaki arg = &track->freq.arg;
4201 1.2 isaki arg->srcfmt = &srcbuf->fmt;
4202 1.2 isaki arg->dstfmt = dstfmt;/*&last_dst->fmt;*/
4203 1.2 isaki arg->context = track;
4204 1.2 isaki
4205 1.2 isaki *last_dstp = srcbuf;
4206 1.2 isaki return 0;
4207 1.2 isaki }
4208 1.2 isaki
4209 1.2 isaki track->freq.filter = NULL;
4210 1.2 isaki audio_free(srcbuf->mem);
4211 1.2 isaki return error;
4212 1.2 isaki }
4213 1.2 isaki
4214 1.2 isaki /*
4215 1.2 isaki * When playing back: (e.g. if codec and freq stage are valid)
4216 1.2 isaki *
4217 1.2 isaki * write
4218 1.2 isaki * | uiomove
4219 1.2 isaki * v
4220 1.2 isaki * usrbuf [...............] byte ring buffer (mmap-able)
4221 1.2 isaki * | memcpy
4222 1.2 isaki * v
4223 1.2 isaki * codec.srcbuf[....] 1 block (ring) buffer <-- stage input
4224 1.2 isaki * .dst ----+
4225 1.2 isaki * | convert
4226 1.2 isaki * v
4227 1.2 isaki * freq.srcbuf [....] 1 block (ring) buffer
4228 1.2 isaki * .dst ----+
4229 1.2 isaki * | convert
4230 1.2 isaki * v
4231 1.2 isaki * outbuf [...............] NBLKOUT blocks ring buffer
4232 1.2 isaki *
4233 1.2 isaki *
4234 1.2 isaki * When recording:
4235 1.2 isaki *
4236 1.2 isaki * freq.srcbuf [...............] NBLKOUT blocks ring buffer <-- stage input
4237 1.2 isaki * .dst ----+
4238 1.2 isaki * | convert
4239 1.2 isaki * v
4240 1.2 isaki * codec.srcbuf[.....] 1 block (ring) buffer
4241 1.2 isaki * .dst ----+
4242 1.2 isaki * | convert
4243 1.2 isaki * v
4244 1.2 isaki * outbuf [.....] 1 block (ring) buffer
4245 1.2 isaki * | memcpy
4246 1.2 isaki * v
4247 1.2 isaki * usrbuf [...............] byte ring buffer (mmap-able *)
4248 1.2 isaki * | uiomove
4249 1.2 isaki * v
4250 1.2 isaki * read
4251 1.2 isaki *
4252 1.2 isaki * *: usrbuf for recording is also mmap-able due to symmetry with
4253 1.2 isaki * playback buffer, but for now mmap will never happen for recording.
4254 1.2 isaki */
4255 1.2 isaki
4256 1.2 isaki /*
4257 1.2 isaki * Set the userland format of this track.
4258 1.2 isaki * usrfmt argument should be parameter verified with audio_check_params().
4259 1.2 isaki * It will release and reallocate all internal conversion buffers.
4260 1.2 isaki * It returns 0 if successful. Otherwise it returns errno with clearing all
4261 1.2 isaki * internal buffers.
4262 1.2 isaki * It must be called without sc_intr_lock since uvm_* routines require non
4263 1.2 isaki * intr_lock state.
4264 1.2 isaki * It must be called with track lock held since it may release and reallocate
4265 1.2 isaki * outbuf.
4266 1.2 isaki */
4267 1.2 isaki static int
4268 1.2 isaki audio_track_set_format(audio_track_t *track, audio_format2_t *usrfmt)
4269 1.2 isaki {
4270 1.2 isaki struct audio_softc *sc;
4271 1.2 isaki u_int newbufsize;
4272 1.2 isaki u_int oldblksize;
4273 1.2 isaki u_int len;
4274 1.2 isaki int error;
4275 1.2 isaki
4276 1.2 isaki KASSERT(track);
4277 1.2 isaki sc = track->mixer->sc;
4278 1.2 isaki
4279 1.2 isaki /* usrbuf is the closest buffer to the userland. */
4280 1.2 isaki track->usrbuf.fmt = *usrfmt;
4281 1.2 isaki
4282 1.2 isaki /*
4283 1.2 isaki * For references, one block size (in 40msec) is:
4284 1.2 isaki * 320 bytes = 204 blocks/64KB for mulaw/8kHz/1ch
4285 1.2 isaki * 7680 bytes = 8 blocks/64KB for s16/48kHz/2ch
4286 1.2 isaki * 30720 bytes = 90 KB/3blocks for s16/48kHz/8ch
4287 1.2 isaki * 61440 bytes = 180 KB/3blocks for s16/96kHz/8ch
4288 1.2 isaki * 245760 bytes = 720 KB/3blocks for s32/192kHz/8ch
4289 1.2 isaki *
4290 1.2 isaki * For example,
4291 1.2 isaki * 1) If usrbuf_blksize = 7056 (s16/44.1k/2ch) and PAGE_SIZE = 8192,
4292 1.2 isaki * newbufsize = rounddown(65536 / 7056) = 63504
4293 1.2 isaki * newvsize = roundup2(63504, PAGE_SIZE) = 65536
4294 1.2 isaki * Therefore it maps 8 * 8K pages and usrbuf->capacity = 63504.
4295 1.2 isaki *
4296 1.2 isaki * 2) If usrbuf_blksize = 7680 (s16/48k/2ch) and PAGE_SIZE = 4096,
4297 1.2 isaki * newbufsize = rounddown(65536 / 7680) = 61440
4298 1.2 isaki * newvsize = roundup2(61440, PAGE_SIZE) = 61440 (= 15 pages)
4299 1.2 isaki * Therefore it maps 15 * 4K pages and usrbuf->capacity = 61440.
4300 1.2 isaki */
4301 1.2 isaki oldblksize = track->usrbuf_blksize;
4302 1.2 isaki track->usrbuf_blksize = frametobyte(&track->usrbuf.fmt,
4303 1.2 isaki frame_per_block(track->mixer, &track->usrbuf.fmt));
4304 1.2 isaki track->usrbuf.head = 0;
4305 1.2 isaki track->usrbuf.used = 0;
4306 1.2 isaki newbufsize = MAX(track->usrbuf_blksize * AUMINNOBLK, 65536);
4307 1.2 isaki newbufsize = rounddown(newbufsize, track->usrbuf_blksize);
4308 1.2 isaki error = audio_realloc_usrbuf(track, newbufsize);
4309 1.2 isaki if (error) {
4310 1.2 isaki device_printf(sc->sc_dev, "malloc usrbuf(%d) failed\n",
4311 1.2 isaki newbufsize);
4312 1.2 isaki goto error;
4313 1.2 isaki }
4314 1.2 isaki
4315 1.2 isaki /* Recalc water mark. */
4316 1.2 isaki if (track->usrbuf_blksize != oldblksize) {
4317 1.2 isaki if (audio_track_is_playback(track)) {
4318 1.2 isaki /* Set high at 100%, low at 75%. */
4319 1.2 isaki track->usrbuf_usedhigh = track->usrbuf.capacity;
4320 1.2 isaki track->usrbuf_usedlow = track->usrbuf.capacity * 3 / 4;
4321 1.2 isaki } else {
4322 1.2 isaki /* Set high at 100% minus 1block(?), low at 0% */
4323 1.2 isaki track->usrbuf_usedhigh = track->usrbuf.capacity -
4324 1.2 isaki track->usrbuf_blksize;
4325 1.2 isaki track->usrbuf_usedlow = 0;
4326 1.2 isaki }
4327 1.2 isaki }
4328 1.2 isaki
4329 1.2 isaki /* Stage buffer */
4330 1.2 isaki audio_ring_t *last_dst = &track->outbuf;
4331 1.2 isaki if (audio_track_is_playback(track)) {
4332 1.2 isaki /* On playback, initialize from the mixer side in order. */
4333 1.2 isaki track->inputfmt = *usrfmt;
4334 1.2 isaki track->outbuf.fmt = track->mixer->track_fmt;
4335 1.2 isaki
4336 1.2 isaki if ((error = audio_track_init_freq(track, &last_dst)) != 0)
4337 1.2 isaki goto error;
4338 1.2 isaki if ((error = audio_track_init_chmix(track, &last_dst)) != 0)
4339 1.2 isaki goto error;
4340 1.2 isaki if ((error = audio_track_init_chvol(track, &last_dst)) != 0)
4341 1.2 isaki goto error;
4342 1.2 isaki if ((error = audio_track_init_codec(track, &last_dst)) != 0)
4343 1.2 isaki goto error;
4344 1.2 isaki } else {
4345 1.2 isaki /* On recording, initialize from userland side in order. */
4346 1.2 isaki track->inputfmt = track->mixer->track_fmt;
4347 1.2 isaki track->outbuf.fmt = *usrfmt;
4348 1.2 isaki
4349 1.2 isaki if ((error = audio_track_init_codec(track, &last_dst)) != 0)
4350 1.2 isaki goto error;
4351 1.2 isaki if ((error = audio_track_init_chvol(track, &last_dst)) != 0)
4352 1.2 isaki goto error;
4353 1.2 isaki if ((error = audio_track_init_chmix(track, &last_dst)) != 0)
4354 1.2 isaki goto error;
4355 1.2 isaki if ((error = audio_track_init_freq(track, &last_dst)) != 0)
4356 1.2 isaki goto error;
4357 1.2 isaki }
4358 1.2 isaki #if 0
4359 1.2 isaki /* debug */
4360 1.2 isaki if (track->freq.filter) {
4361 1.2 isaki audio_print_format2("freq src", &track->freq.srcbuf.fmt);
4362 1.2 isaki audio_print_format2("freq dst", &track->freq.dst->fmt);
4363 1.2 isaki }
4364 1.2 isaki if (track->chmix.filter) {
4365 1.2 isaki audio_print_format2("chmix src", &track->chmix.srcbuf.fmt);
4366 1.2 isaki audio_print_format2("chmix dst", &track->chmix.dst->fmt);
4367 1.2 isaki }
4368 1.2 isaki if (track->chvol.filter) {
4369 1.2 isaki audio_print_format2("chvol src", &track->chvol.srcbuf.fmt);
4370 1.2 isaki audio_print_format2("chvol dst", &track->chvol.dst->fmt);
4371 1.2 isaki }
4372 1.2 isaki if (track->codec.filter) {
4373 1.2 isaki audio_print_format2("codec src", &track->codec.srcbuf.fmt);
4374 1.2 isaki audio_print_format2("codec dst", &track->codec.dst->fmt);
4375 1.2 isaki }
4376 1.2 isaki #endif
4377 1.2 isaki
4378 1.2 isaki /* Stage input buffer */
4379 1.2 isaki track->input = last_dst;
4380 1.2 isaki
4381 1.2 isaki /*
4382 1.2 isaki * On the recording track, make the first stage a ring buffer.
4383 1.2 isaki * XXX is there a better way?
4384 1.2 isaki */
4385 1.2 isaki if (audio_track_is_record(track)) {
4386 1.2 isaki track->input->capacity = NBLKOUT *
4387 1.2 isaki frame_per_block(track->mixer, &track->input->fmt);
4388 1.2 isaki len = auring_bytelen(track->input);
4389 1.2 isaki track->input->mem = audio_realloc(track->input->mem, len);
4390 1.2 isaki }
4391 1.2 isaki
4392 1.2 isaki /*
4393 1.2 isaki * Output buffer.
4394 1.2 isaki * On the playback track, its capacity is NBLKOUT blocks.
4395 1.2 isaki * On the recording track, its capacity is 1 block.
4396 1.2 isaki */
4397 1.2 isaki track->outbuf.head = 0;
4398 1.2 isaki track->outbuf.used = 0;
4399 1.2 isaki track->outbuf.capacity = frame_per_block(track->mixer,
4400 1.2 isaki &track->outbuf.fmt);
4401 1.2 isaki if (audio_track_is_playback(track))
4402 1.2 isaki track->outbuf.capacity *= NBLKOUT;
4403 1.2 isaki len = auring_bytelen(&track->outbuf);
4404 1.2 isaki track->outbuf.mem = audio_realloc(track->outbuf.mem, len);
4405 1.2 isaki if (track->outbuf.mem == NULL) {
4406 1.2 isaki device_printf(sc->sc_dev, "malloc outbuf(%d) failed\n", len);
4407 1.2 isaki error = ENOMEM;
4408 1.2 isaki goto error;
4409 1.2 isaki }
4410 1.2 isaki
4411 1.2 isaki #if defined(AUDIO_DEBUG)
4412 1.2 isaki if (audiodebug >= 3) {
4413 1.2 isaki struct audio_track_debugbuf m;
4414 1.2 isaki
4415 1.2 isaki memset(&m, 0, sizeof(m));
4416 1.2 isaki snprintf(m.outbuf, sizeof(m.outbuf), " out=%d",
4417 1.2 isaki track->outbuf.capacity * frametobyte(&track->outbuf.fmt,1));
4418 1.2 isaki if (track->freq.filter)
4419 1.2 isaki snprintf(m.freq, sizeof(m.freq), " freq=%d",
4420 1.2 isaki track->freq.srcbuf.capacity *
4421 1.2 isaki frametobyte(&track->freq.srcbuf.fmt, 1));
4422 1.2 isaki if (track->chmix.filter)
4423 1.2 isaki snprintf(m.chmix, sizeof(m.chmix), " chmix=%d",
4424 1.2 isaki track->chmix.srcbuf.capacity *
4425 1.2 isaki frametobyte(&track->chmix.srcbuf.fmt, 1));
4426 1.2 isaki if (track->chvol.filter)
4427 1.2 isaki snprintf(m.chvol, sizeof(m.chvol), " chvol=%d",
4428 1.2 isaki track->chvol.srcbuf.capacity *
4429 1.2 isaki frametobyte(&track->chvol.srcbuf.fmt, 1));
4430 1.2 isaki if (track->codec.filter)
4431 1.2 isaki snprintf(m.codec, sizeof(m.codec), " codec=%d",
4432 1.2 isaki track->codec.srcbuf.capacity *
4433 1.2 isaki frametobyte(&track->codec.srcbuf.fmt, 1));
4434 1.2 isaki snprintf(m.usrbuf, sizeof(m.usrbuf),
4435 1.2 isaki " usr=%d", track->usrbuf.capacity);
4436 1.2 isaki
4437 1.2 isaki if (audio_track_is_playback(track)) {
4438 1.2 isaki TRACET(0, track, "bufsize%s%s%s%s%s%s",
4439 1.2 isaki m.outbuf, m.freq, m.chmix,
4440 1.2 isaki m.chvol, m.codec, m.usrbuf);
4441 1.2 isaki } else {
4442 1.2 isaki TRACET(0, track, "bufsize%s%s%s%s%s%s",
4443 1.2 isaki m.freq, m.chmix, m.chvol,
4444 1.2 isaki m.codec, m.outbuf, m.usrbuf);
4445 1.2 isaki }
4446 1.2 isaki }
4447 1.2 isaki #endif
4448 1.2 isaki return 0;
4449 1.2 isaki
4450 1.2 isaki error:
4451 1.2 isaki audio_free_usrbuf(track);
4452 1.2 isaki audio_free(track->codec.srcbuf.mem);
4453 1.2 isaki audio_free(track->chvol.srcbuf.mem);
4454 1.2 isaki audio_free(track->chmix.srcbuf.mem);
4455 1.2 isaki audio_free(track->freq.srcbuf.mem);
4456 1.2 isaki audio_free(track->outbuf.mem);
4457 1.2 isaki return error;
4458 1.2 isaki }
4459 1.2 isaki
4460 1.2 isaki /*
4461 1.2 isaki * Fill silence frames (as the internal format) up to 1 block
4462 1.2 isaki * if the ring is not empty and less than 1 block.
4463 1.2 isaki * It returns the number of appended frames.
4464 1.2 isaki */
4465 1.2 isaki static int
4466 1.2 isaki audio_append_silence(audio_track_t *track, audio_ring_t *ring)
4467 1.2 isaki {
4468 1.2 isaki int fpb;
4469 1.2 isaki int n;
4470 1.2 isaki
4471 1.2 isaki KASSERT(track);
4472 1.2 isaki KASSERT(audio_format2_is_internal(&ring->fmt));
4473 1.2 isaki
4474 1.2 isaki /* XXX is n correct? */
4475 1.2 isaki /* XXX memset uses frametobyte()? */
4476 1.2 isaki
4477 1.2 isaki if (ring->used == 0)
4478 1.2 isaki return 0;
4479 1.2 isaki
4480 1.2 isaki fpb = frame_per_block(track->mixer, &ring->fmt);
4481 1.2 isaki if (ring->used >= fpb)
4482 1.2 isaki return 0;
4483 1.2 isaki
4484 1.2 isaki n = (ring->capacity - ring->used) % fpb;
4485 1.2 isaki
4486 1.28.2.8 martin KASSERTMSG(auring_get_contig_free(ring) >= n,
4487 1.28.2.8 martin "auring_get_contig_free(ring)=%d n=%d",
4488 1.28.2.8 martin auring_get_contig_free(ring), n);
4489 1.2 isaki
4490 1.2 isaki memset(auring_tailptr_aint(ring), 0,
4491 1.2 isaki n * ring->fmt.channels * sizeof(aint_t));
4492 1.2 isaki auring_push(ring, n);
4493 1.2 isaki return n;
4494 1.2 isaki }
4495 1.2 isaki
4496 1.2 isaki /*
4497 1.2 isaki * Execute the conversion stage.
4498 1.2 isaki * It prepares arg from this stage and executes stage->filter.
4499 1.2 isaki * It must be called only if stage->filter is not NULL.
4500 1.2 isaki *
4501 1.2 isaki * For stages other than frequency conversion, the function increments
4502 1.2 isaki * src and dst counters here. For frequency conversion stage, on the
4503 1.2 isaki * other hand, the function does not touch src and dst counters and
4504 1.2 isaki * filter side has to increment them.
4505 1.2 isaki */
4506 1.2 isaki static void
4507 1.2 isaki audio_apply_stage(audio_track_t *track, audio_stage_t *stage, bool isfreq)
4508 1.2 isaki {
4509 1.2 isaki audio_filter_arg_t *arg;
4510 1.2 isaki int srccount;
4511 1.2 isaki int dstcount;
4512 1.2 isaki int count;
4513 1.2 isaki
4514 1.2 isaki KASSERT(track);
4515 1.2 isaki KASSERT(stage->filter);
4516 1.2 isaki
4517 1.2 isaki srccount = auring_get_contig_used(&stage->srcbuf);
4518 1.2 isaki dstcount = auring_get_contig_free(stage->dst);
4519 1.2 isaki
4520 1.2 isaki if (isfreq) {
4521 1.28.2.8 martin KASSERTMSG(srccount > 0, "freq but srccount=%d", srccount);
4522 1.2 isaki count = uimin(dstcount, track->mixer->frames_per_block);
4523 1.2 isaki } else {
4524 1.2 isaki count = uimin(srccount, dstcount);
4525 1.2 isaki }
4526 1.2 isaki
4527 1.2 isaki if (count > 0) {
4528 1.2 isaki arg = &stage->arg;
4529 1.2 isaki arg->src = auring_headptr(&stage->srcbuf);
4530 1.2 isaki arg->dst = auring_tailptr(stage->dst);
4531 1.2 isaki arg->count = count;
4532 1.2 isaki
4533 1.2 isaki stage->filter(arg);
4534 1.2 isaki
4535 1.2 isaki if (!isfreq) {
4536 1.2 isaki auring_take(&stage->srcbuf, count);
4537 1.2 isaki auring_push(stage->dst, count);
4538 1.2 isaki }
4539 1.2 isaki }
4540 1.2 isaki }
4541 1.2 isaki
4542 1.2 isaki /*
4543 1.2 isaki * Produce output buffer for playback from user input buffer.
4544 1.2 isaki * It must be called only if usrbuf is not empty and outbuf is
4545 1.2 isaki * available at least one free block.
4546 1.2 isaki */
4547 1.2 isaki static void
4548 1.2 isaki audio_track_play(audio_track_t *track)
4549 1.2 isaki {
4550 1.2 isaki audio_ring_t *usrbuf;
4551 1.2 isaki audio_ring_t *input;
4552 1.2 isaki int count;
4553 1.2 isaki int framesize;
4554 1.2 isaki int bytes;
4555 1.2 isaki
4556 1.2 isaki KASSERT(track);
4557 1.2 isaki KASSERT(track->lock);
4558 1.2 isaki TRACET(4, track, "start pstate=%d", track->pstate);
4559 1.2 isaki
4560 1.2 isaki /* At this point usrbuf must not be empty. */
4561 1.2 isaki KASSERT(track->usrbuf.used > 0);
4562 1.2 isaki /* Also, outbuf must be available at least one block. */
4563 1.2 isaki count = auring_get_contig_free(&track->outbuf);
4564 1.2 isaki KASSERTMSG(count >= frame_per_block(track->mixer, &track->outbuf.fmt),
4565 1.2 isaki "count=%d fpb=%d",
4566 1.2 isaki count, frame_per_block(track->mixer, &track->outbuf.fmt));
4567 1.2 isaki
4568 1.2 isaki /* XXX TODO: is this necessary for now? */
4569 1.2 isaki int track_count_0 = track->outbuf.used;
4570 1.2 isaki
4571 1.2 isaki usrbuf = &track->usrbuf;
4572 1.2 isaki input = track->input;
4573 1.2 isaki
4574 1.2 isaki /*
4575 1.2 isaki * framesize is always 1 byte or more since all formats supported as
4576 1.2 isaki * usrfmt(=input) have 8bit or more stride.
4577 1.2 isaki */
4578 1.2 isaki framesize = frametobyte(&input->fmt, 1);
4579 1.2 isaki KASSERT(framesize >= 1);
4580 1.2 isaki
4581 1.2 isaki /* The next stage of usrbuf (=input) must be available. */
4582 1.2 isaki KASSERT(auring_get_contig_free(input) > 0);
4583 1.2 isaki
4584 1.2 isaki /*
4585 1.2 isaki * Copy usrbuf up to 1block to input buffer.
4586 1.2 isaki * count is the number of frames to copy from usrbuf.
4587 1.2 isaki * bytes is the number of bytes to copy from usrbuf. However it is
4588 1.2 isaki * not copied less than one frame.
4589 1.2 isaki */
4590 1.2 isaki count = uimin(usrbuf->used, track->usrbuf_blksize) / framesize;
4591 1.2 isaki bytes = count * framesize;
4592 1.2 isaki
4593 1.2 isaki track->usrbuf_stamp += bytes;
4594 1.2 isaki
4595 1.2 isaki if (usrbuf->head + bytes < usrbuf->capacity) {
4596 1.2 isaki memcpy((uint8_t *)input->mem + auring_tail(input) * framesize,
4597 1.2 isaki (uint8_t *)usrbuf->mem + usrbuf->head,
4598 1.2 isaki bytes);
4599 1.2 isaki auring_push(input, count);
4600 1.2 isaki auring_take(usrbuf, bytes);
4601 1.2 isaki } else {
4602 1.2 isaki int bytes1;
4603 1.2 isaki int bytes2;
4604 1.2 isaki
4605 1.2 isaki bytes1 = auring_get_contig_used(usrbuf);
4606 1.28.2.8 martin KASSERTMSG(bytes1 % framesize == 0,
4607 1.28.2.8 martin "bytes1=%d framesize=%d", bytes1, framesize);
4608 1.2 isaki memcpy((uint8_t *)input->mem + auring_tail(input) * framesize,
4609 1.2 isaki (uint8_t *)usrbuf->mem + usrbuf->head,
4610 1.2 isaki bytes1);
4611 1.2 isaki auring_push(input, bytes1 / framesize);
4612 1.2 isaki auring_take(usrbuf, bytes1);
4613 1.2 isaki
4614 1.2 isaki bytes2 = bytes - bytes1;
4615 1.2 isaki memcpy((uint8_t *)input->mem + auring_tail(input) * framesize,
4616 1.2 isaki (uint8_t *)usrbuf->mem + usrbuf->head,
4617 1.2 isaki bytes2);
4618 1.2 isaki auring_push(input, bytes2 / framesize);
4619 1.2 isaki auring_take(usrbuf, bytes2);
4620 1.2 isaki }
4621 1.2 isaki
4622 1.2 isaki /* Encoding conversion */
4623 1.2 isaki if (track->codec.filter)
4624 1.2 isaki audio_apply_stage(track, &track->codec, false);
4625 1.2 isaki
4626 1.2 isaki /* Channel volume */
4627 1.2 isaki if (track->chvol.filter)
4628 1.2 isaki audio_apply_stage(track, &track->chvol, false);
4629 1.2 isaki
4630 1.2 isaki /* Channel mix */
4631 1.2 isaki if (track->chmix.filter)
4632 1.2 isaki audio_apply_stage(track, &track->chmix, false);
4633 1.2 isaki
4634 1.2 isaki /* Frequency conversion */
4635 1.2 isaki /*
4636 1.2 isaki * Since the frequency conversion needs correction for each block,
4637 1.2 isaki * it rounds up to 1 block.
4638 1.2 isaki */
4639 1.2 isaki if (track->freq.filter) {
4640 1.2 isaki int n;
4641 1.2 isaki n = audio_append_silence(track, &track->freq.srcbuf);
4642 1.2 isaki if (n > 0) {
4643 1.2 isaki TRACET(4, track,
4644 1.2 isaki "freq.srcbuf add silence %d -> %d/%d/%d",
4645 1.2 isaki n,
4646 1.2 isaki track->freq.srcbuf.head,
4647 1.2 isaki track->freq.srcbuf.used,
4648 1.2 isaki track->freq.srcbuf.capacity);
4649 1.2 isaki }
4650 1.2 isaki if (track->freq.srcbuf.used > 0) {
4651 1.2 isaki audio_apply_stage(track, &track->freq, true);
4652 1.2 isaki }
4653 1.2 isaki }
4654 1.2 isaki
4655 1.18 isaki if (bytes < track->usrbuf_blksize) {
4656 1.2 isaki /*
4657 1.2 isaki * Clear all conversion buffer pointer if the conversion was
4658 1.2 isaki * not exactly one block. These conversion stage buffers are
4659 1.2 isaki * certainly circular buffers because of symmetry with the
4660 1.2 isaki * previous and next stage buffer. However, since they are
4661 1.2 isaki * treated as simple contiguous buffers in operation, so head
4662 1.2 isaki * always should point 0. This may happen during drain-age.
4663 1.2 isaki */
4664 1.2 isaki TRACET(4, track, "reset stage");
4665 1.2 isaki if (track->codec.filter) {
4666 1.2 isaki KASSERT(track->codec.srcbuf.used == 0);
4667 1.2 isaki track->codec.srcbuf.head = 0;
4668 1.2 isaki }
4669 1.2 isaki if (track->chvol.filter) {
4670 1.2 isaki KASSERT(track->chvol.srcbuf.used == 0);
4671 1.2 isaki track->chvol.srcbuf.head = 0;
4672 1.2 isaki }
4673 1.2 isaki if (track->chmix.filter) {
4674 1.2 isaki KASSERT(track->chmix.srcbuf.used == 0);
4675 1.2 isaki track->chmix.srcbuf.head = 0;
4676 1.2 isaki }
4677 1.2 isaki if (track->freq.filter) {
4678 1.2 isaki KASSERT(track->freq.srcbuf.used == 0);
4679 1.2 isaki track->freq.srcbuf.head = 0;
4680 1.2 isaki }
4681 1.2 isaki }
4682 1.2 isaki
4683 1.2 isaki if (track->input == &track->outbuf) {
4684 1.2 isaki track->outputcounter = track->inputcounter;
4685 1.2 isaki } else {
4686 1.2 isaki track->outputcounter += track->outbuf.used - track_count_0;
4687 1.2 isaki }
4688 1.2 isaki
4689 1.2 isaki #if defined(AUDIO_DEBUG)
4690 1.2 isaki if (audiodebug >= 3) {
4691 1.2 isaki struct audio_track_debugbuf m;
4692 1.2 isaki audio_track_bufstat(track, &m);
4693 1.2 isaki TRACET(0, track, "end%s%s%s%s%s%s",
4694 1.2 isaki m.outbuf, m.freq, m.chvol, m.chmix, m.codec, m.usrbuf);
4695 1.2 isaki }
4696 1.2 isaki #endif
4697 1.2 isaki }
4698 1.2 isaki
4699 1.2 isaki /*
4700 1.2 isaki * Produce user output buffer for recording from input buffer.
4701 1.2 isaki */
4702 1.2 isaki static void
4703 1.2 isaki audio_track_record(audio_track_t *track)
4704 1.2 isaki {
4705 1.2 isaki audio_ring_t *outbuf;
4706 1.2 isaki audio_ring_t *usrbuf;
4707 1.2 isaki int count;
4708 1.2 isaki int bytes;
4709 1.2 isaki int framesize;
4710 1.2 isaki
4711 1.2 isaki KASSERT(track);
4712 1.2 isaki KASSERT(track->lock);
4713 1.2 isaki
4714 1.2 isaki /* Number of frames to process */
4715 1.2 isaki count = auring_get_contig_used(track->input);
4716 1.2 isaki count = uimin(count, track->mixer->frames_per_block);
4717 1.2 isaki if (count == 0) {
4718 1.2 isaki TRACET(4, track, "count == 0");
4719 1.2 isaki return;
4720 1.2 isaki }
4721 1.2 isaki
4722 1.2 isaki /* Frequency conversion */
4723 1.2 isaki if (track->freq.filter) {
4724 1.2 isaki if (track->freq.srcbuf.used > 0) {
4725 1.2 isaki audio_apply_stage(track, &track->freq, true);
4726 1.2 isaki /* XXX should input of freq be from beginning of buf? */
4727 1.2 isaki }
4728 1.2 isaki }
4729 1.2 isaki
4730 1.2 isaki /* Channel mix */
4731 1.2 isaki if (track->chmix.filter)
4732 1.2 isaki audio_apply_stage(track, &track->chmix, false);
4733 1.2 isaki
4734 1.2 isaki /* Channel volume */
4735 1.2 isaki if (track->chvol.filter)
4736 1.2 isaki audio_apply_stage(track, &track->chvol, false);
4737 1.2 isaki
4738 1.2 isaki /* Encoding conversion */
4739 1.2 isaki if (track->codec.filter)
4740 1.2 isaki audio_apply_stage(track, &track->codec, false);
4741 1.2 isaki
4742 1.2 isaki /* Copy outbuf to usrbuf */
4743 1.2 isaki outbuf = &track->outbuf;
4744 1.2 isaki usrbuf = &track->usrbuf;
4745 1.2 isaki /*
4746 1.2 isaki * framesize is always 1 byte or more since all formats supported
4747 1.2 isaki * as usrfmt(=output) have 8bit or more stride.
4748 1.2 isaki */
4749 1.2 isaki framesize = frametobyte(&outbuf->fmt, 1);
4750 1.2 isaki KASSERT(framesize >= 1);
4751 1.2 isaki /*
4752 1.2 isaki * count is the number of frames to copy to usrbuf.
4753 1.2 isaki * bytes is the number of bytes to copy to usrbuf.
4754 1.2 isaki */
4755 1.2 isaki count = outbuf->used;
4756 1.2 isaki count = uimin(count,
4757 1.2 isaki (track->usrbuf_usedhigh - usrbuf->used) / framesize);
4758 1.2 isaki bytes = count * framesize;
4759 1.2 isaki if (auring_tail(usrbuf) + bytes < usrbuf->capacity) {
4760 1.2 isaki memcpy((uint8_t *)usrbuf->mem + auring_tail(usrbuf),
4761 1.2 isaki (uint8_t *)outbuf->mem + outbuf->head * framesize,
4762 1.2 isaki bytes);
4763 1.2 isaki auring_push(usrbuf, bytes);
4764 1.2 isaki auring_take(outbuf, count);
4765 1.2 isaki } else {
4766 1.2 isaki int bytes1;
4767 1.2 isaki int bytes2;
4768 1.2 isaki
4769 1.28.2.4 martin bytes1 = auring_get_contig_free(usrbuf);
4770 1.28.2.8 martin KASSERTMSG(bytes1 % framesize == 0,
4771 1.28.2.8 martin "bytes1=%d framesize=%d", bytes1, framesize);
4772 1.2 isaki memcpy((uint8_t *)usrbuf->mem + auring_tail(usrbuf),
4773 1.2 isaki (uint8_t *)outbuf->mem + outbuf->head * framesize,
4774 1.2 isaki bytes1);
4775 1.2 isaki auring_push(usrbuf, bytes1);
4776 1.2 isaki auring_take(outbuf, bytes1 / framesize);
4777 1.2 isaki
4778 1.2 isaki bytes2 = bytes - bytes1;
4779 1.2 isaki memcpy((uint8_t *)usrbuf->mem + auring_tail(usrbuf),
4780 1.2 isaki (uint8_t *)outbuf->mem + outbuf->head * framesize,
4781 1.2 isaki bytes2);
4782 1.2 isaki auring_push(usrbuf, bytes2);
4783 1.2 isaki auring_take(outbuf, bytes2 / framesize);
4784 1.2 isaki }
4785 1.2 isaki
4786 1.2 isaki /* XXX TODO: any counters here? */
4787 1.2 isaki
4788 1.2 isaki #if defined(AUDIO_DEBUG)
4789 1.2 isaki if (audiodebug >= 3) {
4790 1.2 isaki struct audio_track_debugbuf m;
4791 1.2 isaki audio_track_bufstat(track, &m);
4792 1.2 isaki TRACET(0, track, "end%s%s%s%s%s%s",
4793 1.2 isaki m.freq, m.chvol, m.chmix, m.codec, m.outbuf, m.usrbuf);
4794 1.2 isaki }
4795 1.2 isaki #endif
4796 1.2 isaki }
4797 1.2 isaki
4798 1.2 isaki /*
4799 1.2 isaki * Calcurate blktime [msec] from mixer(.hwbuf.fmt).
4800 1.28.2.12 martin * Must be called with sc_exlock held.
4801 1.2 isaki */
4802 1.2 isaki static u_int
4803 1.2 isaki audio_mixer_calc_blktime(struct audio_softc *sc, audio_trackmixer_t *mixer)
4804 1.2 isaki {
4805 1.2 isaki audio_format2_t *fmt;
4806 1.2 isaki u_int blktime;
4807 1.2 isaki u_int frames_per_block;
4808 1.2 isaki
4809 1.28.2.12 martin KASSERT(sc->sc_exlock);
4810 1.2 isaki
4811 1.2 isaki fmt = &mixer->hwbuf.fmt;
4812 1.2 isaki blktime = sc->sc_blk_ms;
4813 1.2 isaki
4814 1.2 isaki /*
4815 1.2 isaki * If stride is not multiples of 8, special treatment is necessary.
4816 1.2 isaki * For now, it is only x68k's vs(4), 4 bit/sample ADPCM.
4817 1.2 isaki */
4818 1.2 isaki if (fmt->stride == 4) {
4819 1.2 isaki frames_per_block = fmt->sample_rate * blktime / 1000;
4820 1.2 isaki if ((frames_per_block & 1) != 0)
4821 1.2 isaki blktime *= 2;
4822 1.2 isaki }
4823 1.2 isaki #ifdef DIAGNOSTIC
4824 1.2 isaki else if (fmt->stride % NBBY != 0) {
4825 1.2 isaki panic("unsupported HW stride %d", fmt->stride);
4826 1.2 isaki }
4827 1.2 isaki #endif
4828 1.2 isaki
4829 1.2 isaki return blktime;
4830 1.2 isaki }
4831 1.2 isaki
4832 1.2 isaki /*
4833 1.2 isaki * Initialize the mixer corresponding to the mode.
4834 1.2 isaki * Set AUMODE_PLAY to the 'mode' for playback or AUMODE_RECORD for recording.
4835 1.2 isaki * sc->sc_[pr]mixer (corresponding to the 'mode') must be zero-filled.
4836 1.2 isaki * This function returns 0 on sucessful. Otherwise returns errno.
4837 1.28.2.12 martin * Must be called with sc_exlock held and without sc_lock held.
4838 1.2 isaki */
4839 1.2 isaki static int
4840 1.2 isaki audio_mixer_init(struct audio_softc *sc, int mode,
4841 1.2 isaki const audio_format2_t *hwfmt, const audio_filter_reg_t *reg)
4842 1.2 isaki {
4843 1.2 isaki char codecbuf[64];
4844 1.28.2.14 martin char blkdmsbuf[8];
4845 1.2 isaki audio_trackmixer_t *mixer;
4846 1.2 isaki void (*softint_handler)(void *);
4847 1.2 isaki int len;
4848 1.2 isaki int blksize;
4849 1.2 isaki int capacity;
4850 1.2 isaki size_t bufsize;
4851 1.2 isaki int hwblks;
4852 1.2 isaki int blkms;
4853 1.28.2.14 martin int blkdms;
4854 1.2 isaki int error;
4855 1.2 isaki
4856 1.2 isaki KASSERT(hwfmt != NULL);
4857 1.2 isaki KASSERT(reg != NULL);
4858 1.28.2.12 martin KASSERT(sc->sc_exlock);
4859 1.2 isaki
4860 1.2 isaki error = 0;
4861 1.2 isaki if (mode == AUMODE_PLAY)
4862 1.2 isaki mixer = sc->sc_pmixer;
4863 1.2 isaki else
4864 1.2 isaki mixer = sc->sc_rmixer;
4865 1.2 isaki
4866 1.2 isaki mixer->sc = sc;
4867 1.2 isaki mixer->mode = mode;
4868 1.2 isaki
4869 1.2 isaki mixer->hwbuf.fmt = *hwfmt;
4870 1.2 isaki mixer->volume = 256;
4871 1.2 isaki mixer->blktime_d = 1000;
4872 1.2 isaki mixer->blktime_n = audio_mixer_calc_blktime(sc, mixer);
4873 1.2 isaki sc->sc_blk_ms = mixer->blktime_n;
4874 1.2 isaki hwblks = NBLKHW;
4875 1.2 isaki
4876 1.2 isaki mixer->frames_per_block = frame_per_block(mixer, &mixer->hwbuf.fmt);
4877 1.2 isaki blksize = frametobyte(&mixer->hwbuf.fmt, mixer->frames_per_block);
4878 1.2 isaki if (sc->hw_if->round_blocksize) {
4879 1.2 isaki int rounded;
4880 1.2 isaki audio_params_t p = format2_to_params(&mixer->hwbuf.fmt);
4881 1.28.2.12 martin mutex_enter(sc->sc_lock);
4882 1.2 isaki rounded = sc->hw_if->round_blocksize(sc->hw_hdl, blksize,
4883 1.2 isaki mode, &p);
4884 1.28.2.12 martin mutex_exit(sc->sc_lock);
4885 1.28.2.3 martin TRACE(1, "round_blocksize %d -> %d", blksize, rounded);
4886 1.2 isaki if (rounded != blksize) {
4887 1.2 isaki if ((rounded * NBBY) % (mixer->hwbuf.fmt.stride *
4888 1.2 isaki mixer->hwbuf.fmt.channels) != 0) {
4889 1.2 isaki device_printf(sc->sc_dev,
4890 1.28.2.14 martin "round_blocksize must return blocksize "
4891 1.28.2.14 martin "divisible by framesize: "
4892 1.28.2.14 martin "blksize=%d rounded=%d "
4893 1.28.2.14 martin "stride=%ubit channels=%u\n",
4894 1.28.2.14 martin blksize, rounded,
4895 1.28.2.14 martin mixer->hwbuf.fmt.stride,
4896 1.28.2.14 martin mixer->hwbuf.fmt.channels);
4897 1.2 isaki return EINVAL;
4898 1.2 isaki }
4899 1.2 isaki /* Recalculation */
4900 1.2 isaki blksize = rounded;
4901 1.2 isaki mixer->frames_per_block = blksize * NBBY /
4902 1.2 isaki (mixer->hwbuf.fmt.stride *
4903 1.2 isaki mixer->hwbuf.fmt.channels);
4904 1.2 isaki }
4905 1.2 isaki }
4906 1.2 isaki mixer->blktime_n = mixer->frames_per_block;
4907 1.2 isaki mixer->blktime_d = mixer->hwbuf.fmt.sample_rate;
4908 1.2 isaki
4909 1.2 isaki capacity = mixer->frames_per_block * hwblks;
4910 1.2 isaki bufsize = frametobyte(&mixer->hwbuf.fmt, capacity);
4911 1.2 isaki if (sc->hw_if->round_buffersize) {
4912 1.2 isaki size_t rounded;
4913 1.28.2.12 martin mutex_enter(sc->sc_lock);
4914 1.2 isaki rounded = sc->hw_if->round_buffersize(sc->hw_hdl, mode,
4915 1.2 isaki bufsize);
4916 1.28.2.12 martin mutex_exit(sc->sc_lock);
4917 1.28.2.3 martin TRACE(1, "round_buffersize %zd -> %zd", bufsize, rounded);
4918 1.2 isaki if (rounded < bufsize) {
4919 1.2 isaki /* buffersize needs NBLKHW blocks at least. */
4920 1.2 isaki device_printf(sc->sc_dev,
4921 1.2 isaki "buffersize too small: buffersize=%zd blksize=%d\n",
4922 1.2 isaki rounded, blksize);
4923 1.2 isaki return EINVAL;
4924 1.2 isaki }
4925 1.2 isaki if (rounded % blksize != 0) {
4926 1.2 isaki /* buffersize/blksize constraint mismatch? */
4927 1.2 isaki device_printf(sc->sc_dev,
4928 1.2 isaki "buffersize must be multiple of blksize: "
4929 1.2 isaki "buffersize=%zu blksize=%d\n",
4930 1.2 isaki rounded, blksize);
4931 1.2 isaki return EINVAL;
4932 1.2 isaki }
4933 1.2 isaki if (rounded != bufsize) {
4934 1.2 isaki /* Recalcuration */
4935 1.2 isaki bufsize = rounded;
4936 1.2 isaki hwblks = bufsize / blksize;
4937 1.2 isaki capacity = mixer->frames_per_block * hwblks;
4938 1.2 isaki }
4939 1.2 isaki }
4940 1.28.2.3 martin TRACE(1, "buffersize for %s = %zu",
4941 1.2 isaki (mode == AUMODE_PLAY) ? "playback" : "recording",
4942 1.2 isaki bufsize);
4943 1.2 isaki mixer->hwbuf.capacity = capacity;
4944 1.2 isaki
4945 1.2 isaki if (sc->hw_if->allocm) {
4946 1.28.2.12 martin /* sc_lock is not necessary for allocm */
4947 1.2 isaki mixer->hwbuf.mem = sc->hw_if->allocm(sc->hw_hdl, mode, bufsize);
4948 1.2 isaki if (mixer->hwbuf.mem == NULL) {
4949 1.2 isaki device_printf(sc->sc_dev, "%s: allocm(%zu) failed\n",
4950 1.2 isaki __func__, bufsize);
4951 1.2 isaki return ENOMEM;
4952 1.2 isaki }
4953 1.2 isaki } else {
4954 1.28 isaki mixer->hwbuf.mem = kmem_alloc(bufsize, KM_SLEEP);
4955 1.2 isaki }
4956 1.2 isaki
4957 1.2 isaki /* From here, audio_mixer_destroy is necessary to exit. */
4958 1.2 isaki if (mode == AUMODE_PLAY) {
4959 1.2 isaki cv_init(&mixer->outcv, "audiowr");
4960 1.2 isaki } else {
4961 1.2 isaki cv_init(&mixer->outcv, "audiord");
4962 1.2 isaki }
4963 1.2 isaki
4964 1.2 isaki if (mode == AUMODE_PLAY) {
4965 1.2 isaki softint_handler = audio_softintr_wr;
4966 1.2 isaki } else {
4967 1.2 isaki softint_handler = audio_softintr_rd;
4968 1.2 isaki }
4969 1.2 isaki mixer->sih = softint_establish(SOFTINT_SERIAL | SOFTINT_MPSAFE,
4970 1.2 isaki softint_handler, sc);
4971 1.2 isaki if (mixer->sih == NULL) {
4972 1.2 isaki device_printf(sc->sc_dev, "softint_establish failed\n");
4973 1.2 isaki goto abort;
4974 1.2 isaki }
4975 1.2 isaki
4976 1.2 isaki mixer->track_fmt.encoding = AUDIO_ENCODING_SLINEAR_NE;
4977 1.2 isaki mixer->track_fmt.precision = AUDIO_INTERNAL_BITS;
4978 1.2 isaki mixer->track_fmt.stride = AUDIO_INTERNAL_BITS;
4979 1.2 isaki mixer->track_fmt.channels = mixer->hwbuf.fmt.channels;
4980 1.2 isaki mixer->track_fmt.sample_rate = mixer->hwbuf.fmt.sample_rate;
4981 1.2 isaki
4982 1.2 isaki if (mixer->hwbuf.fmt.encoding == AUDIO_ENCODING_SLINEAR_OE &&
4983 1.2 isaki mixer->hwbuf.fmt.precision == AUDIO_INTERNAL_BITS) {
4984 1.2 isaki mixer->swap_endian = true;
4985 1.2 isaki TRACE(1, "swap_endian");
4986 1.2 isaki }
4987 1.2 isaki
4988 1.2 isaki if (mode == AUMODE_PLAY) {
4989 1.2 isaki /* Mixing buffer */
4990 1.2 isaki mixer->mixfmt = mixer->track_fmt;
4991 1.2 isaki mixer->mixfmt.precision *= 2;
4992 1.2 isaki mixer->mixfmt.stride *= 2;
4993 1.2 isaki /* XXX TODO: use some macros? */
4994 1.2 isaki len = mixer->frames_per_block * mixer->mixfmt.channels *
4995 1.2 isaki mixer->mixfmt.stride / NBBY;
4996 1.2 isaki mixer->mixsample = audio_realloc(mixer->mixsample, len);
4997 1.2 isaki } else {
4998 1.2 isaki /* No mixing buffer for recording */
4999 1.2 isaki }
5000 1.2 isaki
5001 1.2 isaki if (reg->codec) {
5002 1.2 isaki mixer->codec = reg->codec;
5003 1.2 isaki mixer->codecarg.context = reg->context;
5004 1.2 isaki if (mode == AUMODE_PLAY) {
5005 1.2 isaki mixer->codecarg.srcfmt = &mixer->track_fmt;
5006 1.2 isaki mixer->codecarg.dstfmt = &mixer->hwbuf.fmt;
5007 1.2 isaki } else {
5008 1.2 isaki mixer->codecarg.srcfmt = &mixer->hwbuf.fmt;
5009 1.2 isaki mixer->codecarg.dstfmt = &mixer->track_fmt;
5010 1.2 isaki }
5011 1.2 isaki mixer->codecbuf.fmt = mixer->track_fmt;
5012 1.2 isaki mixer->codecbuf.capacity = mixer->frames_per_block;
5013 1.2 isaki len = auring_bytelen(&mixer->codecbuf);
5014 1.2 isaki mixer->codecbuf.mem = audio_realloc(mixer->codecbuf.mem, len);
5015 1.2 isaki if (mixer->codecbuf.mem == NULL) {
5016 1.2 isaki device_printf(sc->sc_dev,
5017 1.2 isaki "%s: malloc codecbuf(%d) failed\n",
5018 1.2 isaki __func__, len);
5019 1.2 isaki error = ENOMEM;
5020 1.2 isaki goto abort;
5021 1.2 isaki }
5022 1.2 isaki }
5023 1.2 isaki
5024 1.2 isaki /* Succeeded so display it. */
5025 1.2 isaki codecbuf[0] = '\0';
5026 1.2 isaki if (mixer->codec || mixer->swap_endian) {
5027 1.2 isaki snprintf(codecbuf, sizeof(codecbuf), " %s %s:%d",
5028 1.2 isaki (mode == AUMODE_PLAY) ? "->" : "<-",
5029 1.2 isaki audio_encoding_name(mixer->hwbuf.fmt.encoding),
5030 1.2 isaki mixer->hwbuf.fmt.precision);
5031 1.2 isaki }
5032 1.2 isaki blkms = mixer->blktime_n * 1000 / mixer->blktime_d;
5033 1.28.2.14 martin blkdms = (mixer->blktime_n * 10000 / mixer->blktime_d) % 10;
5034 1.28.2.14 martin blkdmsbuf[0] = '\0';
5035 1.28.2.14 martin if (blkdms != 0) {
5036 1.28.2.14 martin snprintf(blkdmsbuf, sizeof(blkdmsbuf), ".%1d", blkdms);
5037 1.28.2.14 martin }
5038 1.28.2.14 martin aprint_normal_dev(sc->sc_dev,
5039 1.28.2.14 martin "%s:%d%s %dch %dHz, blk %d bytes (%d%sms) for %s\n",
5040 1.2 isaki audio_encoding_name(mixer->track_fmt.encoding),
5041 1.2 isaki mixer->track_fmt.precision,
5042 1.2 isaki codecbuf,
5043 1.2 isaki mixer->track_fmt.channels,
5044 1.2 isaki mixer->track_fmt.sample_rate,
5045 1.28.2.14 martin blksize,
5046 1.28.2.14 martin blkms, blkdmsbuf,
5047 1.2 isaki (mode == AUMODE_PLAY) ? "playback" : "recording");
5048 1.2 isaki
5049 1.2 isaki return 0;
5050 1.2 isaki
5051 1.2 isaki abort:
5052 1.2 isaki audio_mixer_destroy(sc, mixer);
5053 1.2 isaki return error;
5054 1.2 isaki }
5055 1.2 isaki
5056 1.2 isaki /*
5057 1.2 isaki * Releases all resources of 'mixer'.
5058 1.2 isaki * Note that it does not release the memory area of 'mixer' itself.
5059 1.28.2.12 martin * Must be called with sc_exlock held and without sc_lock held.
5060 1.2 isaki */
5061 1.2 isaki static void
5062 1.2 isaki audio_mixer_destroy(struct audio_softc *sc, audio_trackmixer_t *mixer)
5063 1.2 isaki {
5064 1.27 isaki int bufsize;
5065 1.2 isaki
5066 1.28.2.12 martin KASSERT(sc->sc_exlock == 1);
5067 1.2 isaki
5068 1.27 isaki bufsize = frametobyte(&mixer->hwbuf.fmt, mixer->hwbuf.capacity);
5069 1.2 isaki
5070 1.2 isaki if (mixer->hwbuf.mem != NULL) {
5071 1.2 isaki if (sc->hw_if->freem) {
5072 1.28.2.12 martin /* sc_lock is not necessary for freem */
5073 1.27 isaki sc->hw_if->freem(sc->hw_hdl, mixer->hwbuf.mem, bufsize);
5074 1.2 isaki } else {
5075 1.28 isaki kmem_free(mixer->hwbuf.mem, bufsize);
5076 1.2 isaki }
5077 1.2 isaki mixer->hwbuf.mem = NULL;
5078 1.2 isaki }
5079 1.2 isaki
5080 1.2 isaki audio_free(mixer->codecbuf.mem);
5081 1.2 isaki audio_free(mixer->mixsample);
5082 1.2 isaki
5083 1.2 isaki cv_destroy(&mixer->outcv);
5084 1.2 isaki
5085 1.2 isaki if (mixer->sih) {
5086 1.2 isaki softint_disestablish(mixer->sih);
5087 1.2 isaki mixer->sih = NULL;
5088 1.2 isaki }
5089 1.2 isaki }
5090 1.2 isaki
5091 1.2 isaki /*
5092 1.2 isaki * Starts playback mixer.
5093 1.2 isaki * Must be called only if sc_pbusy is false.
5094 1.2 isaki * Must be called with sc_lock held.
5095 1.2 isaki * Must not be called from the interrupt context.
5096 1.2 isaki */
5097 1.2 isaki static void
5098 1.2 isaki audio_pmixer_start(struct audio_softc *sc, bool force)
5099 1.2 isaki {
5100 1.2 isaki audio_trackmixer_t *mixer;
5101 1.2 isaki int minimum;
5102 1.2 isaki
5103 1.2 isaki KASSERT(mutex_owned(sc->sc_lock));
5104 1.2 isaki KASSERT(sc->sc_pbusy == false);
5105 1.2 isaki
5106 1.2 isaki mutex_enter(sc->sc_intr_lock);
5107 1.2 isaki
5108 1.2 isaki mixer = sc->sc_pmixer;
5109 1.2 isaki TRACE(2, "%smixseq=%d hwseq=%d hwbuf=%d/%d/%d%s",
5110 1.2 isaki (audiodebug >= 3) ? "begin " : "",
5111 1.2 isaki (int)mixer->mixseq, (int)mixer->hwseq,
5112 1.2 isaki mixer->hwbuf.head, mixer->hwbuf.used, mixer->hwbuf.capacity,
5113 1.2 isaki force ? " force" : "");
5114 1.2 isaki
5115 1.2 isaki /* Need two blocks to start normally. */
5116 1.2 isaki minimum = (force) ? 1 : 2;
5117 1.2 isaki while (mixer->hwbuf.used < mixer->frames_per_block * minimum) {
5118 1.2 isaki audio_pmixer_process(sc);
5119 1.2 isaki }
5120 1.2 isaki
5121 1.2 isaki /* Start output */
5122 1.2 isaki audio_pmixer_output(sc);
5123 1.2 isaki sc->sc_pbusy = true;
5124 1.2 isaki
5125 1.2 isaki TRACE(3, "end mixseq=%d hwseq=%d hwbuf=%d/%d/%d",
5126 1.2 isaki (int)mixer->mixseq, (int)mixer->hwseq,
5127 1.2 isaki mixer->hwbuf.head, mixer->hwbuf.used, mixer->hwbuf.capacity);
5128 1.2 isaki
5129 1.2 isaki mutex_exit(sc->sc_intr_lock);
5130 1.2 isaki }
5131 1.2 isaki
5132 1.2 isaki /*
5133 1.2 isaki * When playing back with MD filter:
5134 1.2 isaki *
5135 1.2 isaki * track track ...
5136 1.2 isaki * v v
5137 1.2 isaki * + mix (with aint2_t)
5138 1.2 isaki * | master volume (with aint2_t)
5139 1.2 isaki * v
5140 1.2 isaki * mixsample [::::] wide-int 1 block (ring) buffer
5141 1.2 isaki * |
5142 1.2 isaki * | convert aint2_t -> aint_t
5143 1.2 isaki * v
5144 1.2 isaki * codecbuf [....] 1 block (ring) buffer
5145 1.2 isaki * |
5146 1.2 isaki * | convert to hw format
5147 1.2 isaki * v
5148 1.2 isaki * hwbuf [............] NBLKHW blocks ring buffer
5149 1.2 isaki *
5150 1.2 isaki * When playing back without MD filter:
5151 1.2 isaki *
5152 1.2 isaki * mixsample [::::] wide-int 1 block (ring) buffer
5153 1.2 isaki * |
5154 1.2 isaki * | convert aint2_t -> aint_t
5155 1.2 isaki * | (with byte swap if necessary)
5156 1.2 isaki * v
5157 1.2 isaki * hwbuf [............] NBLKHW blocks ring buffer
5158 1.2 isaki *
5159 1.2 isaki * mixsample: slinear_NE, wide internal precision, HW ch, HW freq.
5160 1.2 isaki * codecbuf: slinear_NE, internal precision, HW ch, HW freq.
5161 1.2 isaki * hwbuf: HW encoding, HW precision, HW ch, HW freq.
5162 1.2 isaki */
5163 1.2 isaki
5164 1.2 isaki /*
5165 1.2 isaki * Performs track mixing and converts it to hwbuf.
5166 1.2 isaki * Note that this function doesn't transfer hwbuf to hardware.
5167 1.2 isaki * Must be called with sc_intr_lock held.
5168 1.2 isaki */
5169 1.2 isaki static void
5170 1.2 isaki audio_pmixer_process(struct audio_softc *sc)
5171 1.2 isaki {
5172 1.2 isaki audio_trackmixer_t *mixer;
5173 1.2 isaki audio_file_t *f;
5174 1.2 isaki int frame_count;
5175 1.2 isaki int sample_count;
5176 1.2 isaki int mixed;
5177 1.2 isaki int i;
5178 1.2 isaki aint2_t *m;
5179 1.2 isaki aint_t *h;
5180 1.2 isaki
5181 1.2 isaki mixer = sc->sc_pmixer;
5182 1.2 isaki
5183 1.2 isaki frame_count = mixer->frames_per_block;
5184 1.28.2.8 martin KASSERTMSG(auring_get_contig_free(&mixer->hwbuf) >= frame_count,
5185 1.28.2.8 martin "auring_get_contig_free()=%d frame_count=%d",
5186 1.28.2.8 martin auring_get_contig_free(&mixer->hwbuf), frame_count);
5187 1.2 isaki sample_count = frame_count * mixer->mixfmt.channels;
5188 1.2 isaki
5189 1.2 isaki mixer->mixseq++;
5190 1.2 isaki
5191 1.2 isaki /* Mix all tracks */
5192 1.2 isaki mixed = 0;
5193 1.2 isaki SLIST_FOREACH(f, &sc->sc_files, entry) {
5194 1.2 isaki audio_track_t *track = f->ptrack;
5195 1.2 isaki
5196 1.2 isaki if (track == NULL)
5197 1.2 isaki continue;
5198 1.2 isaki
5199 1.2 isaki if (track->is_pause) {
5200 1.2 isaki TRACET(4, track, "skip; paused");
5201 1.2 isaki continue;
5202 1.2 isaki }
5203 1.2 isaki
5204 1.2 isaki /* Skip if the track is used by process context. */
5205 1.2 isaki if (audio_track_lock_tryenter(track) == false) {
5206 1.2 isaki TRACET(4, track, "skip; in use");
5207 1.2 isaki continue;
5208 1.2 isaki }
5209 1.2 isaki
5210 1.2 isaki /* Emulate mmap'ped track */
5211 1.2 isaki if (track->mmapped) {
5212 1.2 isaki auring_push(&track->usrbuf, track->usrbuf_blksize);
5213 1.2 isaki TRACET(4, track, "mmap; usr=%d/%d/C%d",
5214 1.2 isaki track->usrbuf.head,
5215 1.2 isaki track->usrbuf.used,
5216 1.2 isaki track->usrbuf.capacity);
5217 1.2 isaki }
5218 1.2 isaki
5219 1.2 isaki if (track->outbuf.used < mixer->frames_per_block &&
5220 1.2 isaki track->usrbuf.used > 0) {
5221 1.2 isaki TRACET(4, track, "process");
5222 1.2 isaki audio_track_play(track);
5223 1.2 isaki }
5224 1.2 isaki
5225 1.2 isaki if (track->outbuf.used > 0) {
5226 1.2 isaki mixed = audio_pmixer_mix_track(mixer, track, mixed);
5227 1.2 isaki } else {
5228 1.2 isaki TRACET(4, track, "skip; empty");
5229 1.2 isaki }
5230 1.2 isaki
5231 1.2 isaki audio_track_lock_exit(track);
5232 1.2 isaki }
5233 1.2 isaki
5234 1.2 isaki if (mixed == 0) {
5235 1.2 isaki /* Silence */
5236 1.2 isaki memset(mixer->mixsample, 0,
5237 1.2 isaki frametobyte(&mixer->mixfmt, frame_count));
5238 1.2 isaki } else {
5239 1.23 isaki if (mixed > 1) {
5240 1.23 isaki /* If there are multiple tracks, do auto gain control */
5241 1.23 isaki audio_pmixer_agc(mixer, sample_count);
5242 1.2 isaki }
5243 1.2 isaki
5244 1.23 isaki /* Apply master volume */
5245 1.23 isaki if (mixer->volume < 256) {
5246 1.2 isaki m = mixer->mixsample;
5247 1.2 isaki for (i = 0; i < sample_count; i++) {
5248 1.23 isaki *m = AUDIO_SCALEDOWN(*m * mixer->volume, 8);
5249 1.2 isaki m++;
5250 1.2 isaki }
5251 1.23 isaki
5252 1.23 isaki /*
5253 1.23 isaki * Recover the volume gradually at the pace of
5254 1.23 isaki * several times per second. If it's too fast, you
5255 1.23 isaki * can recognize that the volume changes up and down
5256 1.23 isaki * quickly and it's not so comfortable.
5257 1.23 isaki */
5258 1.23 isaki mixer->voltimer += mixer->blktime_n;
5259 1.23 isaki if (mixer->voltimer * 4 >= mixer->blktime_d) {
5260 1.23 isaki mixer->volume++;
5261 1.23 isaki mixer->voltimer = 0;
5262 1.23 isaki #if defined(AUDIO_DEBUG_AGC)
5263 1.23 isaki TRACE(1, "volume recover: %d", mixer->volume);
5264 1.23 isaki #endif
5265 1.23 isaki }
5266 1.2 isaki }
5267 1.2 isaki }
5268 1.2 isaki
5269 1.2 isaki /*
5270 1.2 isaki * The rest is the hardware part.
5271 1.2 isaki */
5272 1.2 isaki
5273 1.2 isaki if (mixer->codec) {
5274 1.2 isaki h = auring_tailptr_aint(&mixer->codecbuf);
5275 1.2 isaki } else {
5276 1.2 isaki h = auring_tailptr_aint(&mixer->hwbuf);
5277 1.2 isaki }
5278 1.2 isaki
5279 1.2 isaki m = mixer->mixsample;
5280 1.2 isaki if (mixer->swap_endian) {
5281 1.2 isaki for (i = 0; i < sample_count; i++) {
5282 1.2 isaki *h++ = bswap16(*m++);
5283 1.2 isaki }
5284 1.2 isaki } else {
5285 1.2 isaki for (i = 0; i < sample_count; i++) {
5286 1.2 isaki *h++ = *m++;
5287 1.2 isaki }
5288 1.2 isaki }
5289 1.2 isaki
5290 1.2 isaki /* Hardware driver's codec */
5291 1.2 isaki if (mixer->codec) {
5292 1.2 isaki auring_push(&mixer->codecbuf, frame_count);
5293 1.2 isaki mixer->codecarg.src = auring_headptr(&mixer->codecbuf);
5294 1.2 isaki mixer->codecarg.dst = auring_tailptr(&mixer->hwbuf);
5295 1.2 isaki mixer->codecarg.count = frame_count;
5296 1.2 isaki mixer->codec(&mixer->codecarg);
5297 1.2 isaki auring_take(&mixer->codecbuf, mixer->codecarg.count);
5298 1.2 isaki }
5299 1.2 isaki
5300 1.2 isaki auring_push(&mixer->hwbuf, frame_count);
5301 1.2 isaki
5302 1.2 isaki TRACE(4, "done mixseq=%d hwbuf=%d/%d/%d%s",
5303 1.2 isaki (int)mixer->mixseq,
5304 1.2 isaki mixer->hwbuf.head, mixer->hwbuf.used, mixer->hwbuf.capacity,
5305 1.2 isaki (mixed == 0) ? " silent" : "");
5306 1.2 isaki }
5307 1.2 isaki
5308 1.2 isaki /*
5309 1.23 isaki * Do auto gain control.
5310 1.23 isaki * Must be called sc_intr_lock held.
5311 1.23 isaki */
5312 1.23 isaki static void
5313 1.23 isaki audio_pmixer_agc(audio_trackmixer_t *mixer, int sample_count)
5314 1.23 isaki {
5315 1.23 isaki struct audio_softc *sc __unused;
5316 1.23 isaki aint2_t val;
5317 1.23 isaki aint2_t maxval;
5318 1.23 isaki aint2_t minval;
5319 1.23 isaki aint2_t over_plus;
5320 1.23 isaki aint2_t over_minus;
5321 1.23 isaki aint2_t *m;
5322 1.23 isaki int newvol;
5323 1.23 isaki int i;
5324 1.23 isaki
5325 1.23 isaki sc = mixer->sc;
5326 1.23 isaki
5327 1.23 isaki /* Overflow detection */
5328 1.23 isaki maxval = AINT_T_MAX;
5329 1.23 isaki minval = AINT_T_MIN;
5330 1.23 isaki m = mixer->mixsample;
5331 1.23 isaki for (i = 0; i < sample_count; i++) {
5332 1.23 isaki val = *m++;
5333 1.23 isaki if (val > maxval)
5334 1.23 isaki maxval = val;
5335 1.23 isaki else if (val < minval)
5336 1.23 isaki minval = val;
5337 1.23 isaki }
5338 1.23 isaki
5339 1.23 isaki /* Absolute value of overflowed amount */
5340 1.23 isaki over_plus = maxval - AINT_T_MAX;
5341 1.23 isaki over_minus = AINT_T_MIN - minval;
5342 1.23 isaki
5343 1.23 isaki if (over_plus > 0 || over_minus > 0) {
5344 1.23 isaki if (over_plus > over_minus) {
5345 1.23 isaki newvol = (int)((aint2_t)AINT_T_MAX * 256 / maxval);
5346 1.23 isaki } else {
5347 1.23 isaki newvol = (int)((aint2_t)AINT_T_MIN * 256 / minval);
5348 1.23 isaki }
5349 1.23 isaki
5350 1.23 isaki /*
5351 1.23 isaki * Change the volume only if new one is smaller.
5352 1.23 isaki * Reset the timer even if the volume isn't changed.
5353 1.23 isaki */
5354 1.23 isaki if (newvol <= mixer->volume) {
5355 1.23 isaki mixer->volume = newvol;
5356 1.23 isaki mixer->voltimer = 0;
5357 1.23 isaki #if defined(AUDIO_DEBUG_AGC)
5358 1.23 isaki TRACE(1, "auto volume adjust: %d", mixer->volume);
5359 1.23 isaki #endif
5360 1.23 isaki }
5361 1.23 isaki }
5362 1.23 isaki }
5363 1.23 isaki
5364 1.23 isaki /*
5365 1.2 isaki * Mix one track.
5366 1.2 isaki * 'mixed' specifies the number of tracks mixed so far.
5367 1.2 isaki * It returns the number of tracks mixed. In other words, it returns
5368 1.2 isaki * mixed + 1 if this track is mixed.
5369 1.2 isaki */
5370 1.2 isaki static int
5371 1.2 isaki audio_pmixer_mix_track(audio_trackmixer_t *mixer, audio_track_t *track,
5372 1.2 isaki int mixed)
5373 1.2 isaki {
5374 1.2 isaki int count;
5375 1.2 isaki int sample_count;
5376 1.2 isaki int remain;
5377 1.2 isaki int i;
5378 1.2 isaki const aint_t *s;
5379 1.2 isaki aint2_t *d;
5380 1.2 isaki
5381 1.2 isaki /* XXX TODO: Is this necessary for now? */
5382 1.2 isaki if (mixer->mixseq < track->seq)
5383 1.2 isaki return mixed;
5384 1.2 isaki
5385 1.2 isaki count = auring_get_contig_used(&track->outbuf);
5386 1.2 isaki count = uimin(count, mixer->frames_per_block);
5387 1.2 isaki
5388 1.2 isaki s = auring_headptr_aint(&track->outbuf);
5389 1.2 isaki d = mixer->mixsample;
5390 1.2 isaki
5391 1.2 isaki /*
5392 1.2 isaki * Apply track volume with double-sized integer and perform
5393 1.2 isaki * additive synthesis.
5394 1.2 isaki *
5395 1.2 isaki * XXX If you limit the track volume to 1.0 or less (<= 256),
5396 1.2 isaki * it would be better to do this in the track conversion stage
5397 1.2 isaki * rather than here. However, if you accept the volume to
5398 1.2 isaki * be greater than 1.0 (> 256), it's better to do it here.
5399 1.2 isaki * Because the operation here is done by double-sized integer.
5400 1.2 isaki */
5401 1.2 isaki sample_count = count * mixer->mixfmt.channels;
5402 1.2 isaki if (mixed == 0) {
5403 1.2 isaki /* If this is the first track, assignment can be used. */
5404 1.2 isaki #if defined(AUDIO_SUPPORT_TRACK_VOLUME)
5405 1.2 isaki if (track->volume != 256) {
5406 1.2 isaki for (i = 0; i < sample_count; i++) {
5407 1.16 isaki aint2_t v;
5408 1.16 isaki v = *s++;
5409 1.16 isaki *d++ = AUDIO_SCALEDOWN(v * track->volume, 8)
5410 1.2 isaki }
5411 1.2 isaki } else
5412 1.2 isaki #endif
5413 1.2 isaki {
5414 1.2 isaki for (i = 0; i < sample_count; i++) {
5415 1.2 isaki *d++ = ((aint2_t)*s++);
5416 1.2 isaki }
5417 1.2 isaki }
5418 1.17 isaki /* Fill silence if the first track is not filled. */
5419 1.17 isaki for (; i < mixer->frames_per_block * mixer->mixfmt.channels; i++)
5420 1.17 isaki *d++ = 0;
5421 1.2 isaki } else {
5422 1.2 isaki /* If this is the second or later, add it. */
5423 1.2 isaki #if defined(AUDIO_SUPPORT_TRACK_VOLUME)
5424 1.2 isaki if (track->volume != 256) {
5425 1.2 isaki for (i = 0; i < sample_count; i++) {
5426 1.16 isaki aint2_t v;
5427 1.16 isaki v = *s++;
5428 1.16 isaki *d++ += AUDIO_SCALEDOWN(v * track->volume, 8);
5429 1.2 isaki }
5430 1.2 isaki } else
5431 1.2 isaki #endif
5432 1.2 isaki {
5433 1.2 isaki for (i = 0; i < sample_count; i++) {
5434 1.2 isaki *d++ += ((aint2_t)*s++);
5435 1.2 isaki }
5436 1.2 isaki }
5437 1.2 isaki }
5438 1.2 isaki
5439 1.2 isaki auring_take(&track->outbuf, count);
5440 1.2 isaki /*
5441 1.2 isaki * The counters have to align block even if outbuf is less than
5442 1.2 isaki * one block. XXX Is this still necessary?
5443 1.2 isaki */
5444 1.2 isaki remain = mixer->frames_per_block - count;
5445 1.2 isaki if (__predict_false(remain != 0)) {
5446 1.2 isaki auring_push(&track->outbuf, remain);
5447 1.2 isaki auring_take(&track->outbuf, remain);
5448 1.2 isaki }
5449 1.2 isaki
5450 1.2 isaki /*
5451 1.2 isaki * Update track sequence.
5452 1.2 isaki * mixseq has previous value yet at this point.
5453 1.2 isaki */
5454 1.2 isaki track->seq = mixer->mixseq + 1;
5455 1.2 isaki
5456 1.2 isaki return mixed + 1;
5457 1.2 isaki }
5458 1.2 isaki
5459 1.2 isaki /*
5460 1.2 isaki * Output one block from hwbuf to HW.
5461 1.2 isaki * Must be called with sc_intr_lock held.
5462 1.2 isaki */
5463 1.2 isaki static void
5464 1.2 isaki audio_pmixer_output(struct audio_softc *sc)
5465 1.2 isaki {
5466 1.2 isaki audio_trackmixer_t *mixer;
5467 1.2 isaki audio_params_t params;
5468 1.2 isaki void *start;
5469 1.2 isaki void *end;
5470 1.2 isaki int blksize;
5471 1.2 isaki int error;
5472 1.2 isaki
5473 1.2 isaki mixer = sc->sc_pmixer;
5474 1.2 isaki TRACE(4, "pbusy=%d hwbuf=%d/%d/%d",
5475 1.2 isaki sc->sc_pbusy,
5476 1.2 isaki mixer->hwbuf.head, mixer->hwbuf.used, mixer->hwbuf.capacity);
5477 1.28.2.8 martin KASSERTMSG(mixer->hwbuf.used >= mixer->frames_per_block,
5478 1.28.2.8 martin "mixer->hwbuf.used=%d mixer->frames_per_block=%d",
5479 1.28.2.8 martin mixer->hwbuf.used, mixer->frames_per_block);
5480 1.2 isaki
5481 1.2 isaki blksize = frametobyte(&mixer->hwbuf.fmt, mixer->frames_per_block);
5482 1.2 isaki
5483 1.2 isaki if (sc->hw_if->trigger_output) {
5484 1.2 isaki /* trigger (at once) */
5485 1.2 isaki if (!sc->sc_pbusy) {
5486 1.2 isaki start = mixer->hwbuf.mem;
5487 1.2 isaki end = (uint8_t *)start + auring_bytelen(&mixer->hwbuf);
5488 1.2 isaki params = format2_to_params(&mixer->hwbuf.fmt);
5489 1.2 isaki
5490 1.2 isaki error = sc->hw_if->trigger_output(sc->hw_hdl,
5491 1.2 isaki start, end, blksize, audio_pintr, sc, ¶ms);
5492 1.2 isaki if (error) {
5493 1.2 isaki device_printf(sc->sc_dev,
5494 1.15 isaki "trigger_output failed with %d\n", error);
5495 1.2 isaki return;
5496 1.2 isaki }
5497 1.2 isaki }
5498 1.2 isaki } else {
5499 1.2 isaki /* start (everytime) */
5500 1.2 isaki start = auring_headptr(&mixer->hwbuf);
5501 1.2 isaki
5502 1.2 isaki error = sc->hw_if->start_output(sc->hw_hdl,
5503 1.2 isaki start, blksize, audio_pintr, sc);
5504 1.2 isaki if (error) {
5505 1.2 isaki device_printf(sc->sc_dev,
5506 1.15 isaki "start_output failed with %d\n", error);
5507 1.2 isaki return;
5508 1.2 isaki }
5509 1.2 isaki }
5510 1.2 isaki }
5511 1.2 isaki
5512 1.2 isaki /*
5513 1.2 isaki * This is an interrupt handler for playback.
5514 1.2 isaki * It is called with sc_intr_lock held.
5515 1.2 isaki *
5516 1.2 isaki * It is usually called from hardware interrupt. However, note that
5517 1.2 isaki * for some drivers (e.g. uaudio) it is called from software interrupt.
5518 1.2 isaki */
5519 1.2 isaki static void
5520 1.2 isaki audio_pintr(void *arg)
5521 1.2 isaki {
5522 1.2 isaki struct audio_softc *sc;
5523 1.2 isaki audio_trackmixer_t *mixer;
5524 1.2 isaki
5525 1.2 isaki sc = arg;
5526 1.2 isaki KASSERT(mutex_owned(sc->sc_intr_lock));
5527 1.2 isaki
5528 1.2 isaki if (sc->sc_dying)
5529 1.2 isaki return;
5530 1.2 isaki if (sc->sc_pbusy == false) {
5531 1.28.2.14 martin #if defined(DIAGNOSTIC)
5532 1.28.2.14 martin device_printf(sc->sc_dev,
5533 1.28.2.14 martin "DIAGNOSTIC: %s raised stray interrupt\n",
5534 1.28.2.14 martin device_xname(sc->hw_dev));
5535 1.28.2.14 martin #endif
5536 1.2 isaki return;
5537 1.2 isaki }
5538 1.2 isaki
5539 1.2 isaki mixer = sc->sc_pmixer;
5540 1.2 isaki mixer->hw_complete_counter += mixer->frames_per_block;
5541 1.2 isaki mixer->hwseq++;
5542 1.2 isaki
5543 1.2 isaki auring_take(&mixer->hwbuf, mixer->frames_per_block);
5544 1.2 isaki
5545 1.2 isaki TRACE(4,
5546 1.2 isaki "HW_INT ++hwseq=%" PRIu64 " cmplcnt=%" PRIu64 " hwbuf=%d/%d/%d",
5547 1.2 isaki mixer->hwseq, mixer->hw_complete_counter,
5548 1.2 isaki mixer->hwbuf.head, mixer->hwbuf.used, mixer->hwbuf.capacity);
5549 1.2 isaki
5550 1.2 isaki #if !defined(_KERNEL)
5551 1.2 isaki /* This is a debug code for userland test. */
5552 1.2 isaki return;
5553 1.2 isaki #endif
5554 1.2 isaki
5555 1.2 isaki #if defined(AUDIO_HW_SINGLE_BUFFER)
5556 1.2 isaki /*
5557 1.2 isaki * Create a new block here and output it immediately.
5558 1.2 isaki * It makes a latency lower but needs machine power.
5559 1.2 isaki */
5560 1.2 isaki audio_pmixer_process(sc);
5561 1.2 isaki audio_pmixer_output(sc);
5562 1.2 isaki #else
5563 1.2 isaki /*
5564 1.2 isaki * It is called when block N output is done.
5565 1.2 isaki * Output immediately block N+1 created by the last interrupt.
5566 1.2 isaki * And then create block N+2 for the next interrupt.
5567 1.2 isaki * This method makes playback robust even on slower machines.
5568 1.2 isaki * Instead the latency is increased by one block.
5569 1.2 isaki */
5570 1.2 isaki
5571 1.2 isaki /* At first, output ready block. */
5572 1.2 isaki if (mixer->hwbuf.used >= mixer->frames_per_block) {
5573 1.2 isaki audio_pmixer_output(sc);
5574 1.2 isaki }
5575 1.2 isaki
5576 1.2 isaki bool later = false;
5577 1.2 isaki
5578 1.2 isaki if (mixer->hwbuf.used < mixer->frames_per_block) {
5579 1.2 isaki later = true;
5580 1.2 isaki }
5581 1.2 isaki
5582 1.2 isaki /* Then, process next block. */
5583 1.2 isaki audio_pmixer_process(sc);
5584 1.2 isaki
5585 1.2 isaki if (later) {
5586 1.2 isaki audio_pmixer_output(sc);
5587 1.2 isaki }
5588 1.2 isaki #endif
5589 1.2 isaki
5590 1.2 isaki /*
5591 1.2 isaki * When this interrupt is the real hardware interrupt, disabling
5592 1.2 isaki * preemption here is not necessary. But some drivers (e.g. uaudio)
5593 1.2 isaki * emulate it by software interrupt, so kpreempt_disable is necessary.
5594 1.2 isaki */
5595 1.2 isaki kpreempt_disable();
5596 1.2 isaki softint_schedule(mixer->sih);
5597 1.2 isaki kpreempt_enable();
5598 1.2 isaki }
5599 1.2 isaki
5600 1.2 isaki /*
5601 1.2 isaki * Starts record mixer.
5602 1.2 isaki * Must be called only if sc_rbusy is false.
5603 1.2 isaki * Must be called with sc_lock held.
5604 1.2 isaki * Must not be called from the interrupt context.
5605 1.2 isaki */
5606 1.2 isaki static void
5607 1.2 isaki audio_rmixer_start(struct audio_softc *sc)
5608 1.2 isaki {
5609 1.2 isaki
5610 1.2 isaki KASSERT(mutex_owned(sc->sc_lock));
5611 1.2 isaki KASSERT(sc->sc_rbusy == false);
5612 1.2 isaki
5613 1.2 isaki mutex_enter(sc->sc_intr_lock);
5614 1.2 isaki
5615 1.2 isaki TRACE(2, "%s", (audiodebug >= 3) ? "begin" : "");
5616 1.2 isaki audio_rmixer_input(sc);
5617 1.2 isaki sc->sc_rbusy = true;
5618 1.2 isaki TRACE(3, "end");
5619 1.2 isaki
5620 1.2 isaki mutex_exit(sc->sc_intr_lock);
5621 1.2 isaki }
5622 1.2 isaki
5623 1.2 isaki /*
5624 1.2 isaki * When recording with MD filter:
5625 1.2 isaki *
5626 1.2 isaki * hwbuf [............] NBLKHW blocks ring buffer
5627 1.2 isaki * |
5628 1.2 isaki * | convert from hw format
5629 1.2 isaki * v
5630 1.2 isaki * codecbuf [....] 1 block (ring) buffer
5631 1.2 isaki * | |
5632 1.2 isaki * v v
5633 1.2 isaki * track track ...
5634 1.2 isaki *
5635 1.2 isaki * When recording without MD filter:
5636 1.2 isaki *
5637 1.2 isaki * hwbuf [............] NBLKHW blocks ring buffer
5638 1.2 isaki * | |
5639 1.2 isaki * v v
5640 1.2 isaki * track track ...
5641 1.2 isaki *
5642 1.2 isaki * hwbuf: HW encoding, HW precision, HW ch, HW freq.
5643 1.2 isaki * codecbuf: slinear_NE, internal precision, HW ch, HW freq.
5644 1.2 isaki */
5645 1.2 isaki
5646 1.2 isaki /*
5647 1.2 isaki * Distribute a recorded block to all recording tracks.
5648 1.2 isaki */
5649 1.2 isaki static void
5650 1.2 isaki audio_rmixer_process(struct audio_softc *sc)
5651 1.2 isaki {
5652 1.2 isaki audio_trackmixer_t *mixer;
5653 1.2 isaki audio_ring_t *mixersrc;
5654 1.2 isaki audio_file_t *f;
5655 1.2 isaki aint_t *p;
5656 1.2 isaki int count;
5657 1.2 isaki int bytes;
5658 1.2 isaki int i;
5659 1.2 isaki
5660 1.2 isaki mixer = sc->sc_rmixer;
5661 1.2 isaki
5662 1.2 isaki /*
5663 1.2 isaki * count is the number of frames to be retrieved this time.
5664 1.2 isaki * count should be one block.
5665 1.2 isaki */
5666 1.2 isaki count = auring_get_contig_used(&mixer->hwbuf);
5667 1.2 isaki count = uimin(count, mixer->frames_per_block);
5668 1.2 isaki if (count <= 0) {
5669 1.2 isaki TRACE(4, "count %d: too short", count);
5670 1.2 isaki return;
5671 1.2 isaki }
5672 1.2 isaki bytes = frametobyte(&mixer->track_fmt, count);
5673 1.2 isaki
5674 1.2 isaki /* Hardware driver's codec */
5675 1.2 isaki if (mixer->codec) {
5676 1.2 isaki mixer->codecarg.src = auring_headptr(&mixer->hwbuf);
5677 1.2 isaki mixer->codecarg.dst = auring_tailptr(&mixer->codecbuf);
5678 1.2 isaki mixer->codecarg.count = count;
5679 1.2 isaki mixer->codec(&mixer->codecarg);
5680 1.2 isaki auring_take(&mixer->hwbuf, mixer->codecarg.count);
5681 1.2 isaki auring_push(&mixer->codecbuf, mixer->codecarg.count);
5682 1.2 isaki mixersrc = &mixer->codecbuf;
5683 1.2 isaki } else {
5684 1.2 isaki mixersrc = &mixer->hwbuf;
5685 1.2 isaki }
5686 1.2 isaki
5687 1.2 isaki if (mixer->swap_endian) {
5688 1.2 isaki /* inplace conversion */
5689 1.2 isaki p = auring_headptr_aint(mixersrc);
5690 1.2 isaki for (i = 0; i < count * mixer->track_fmt.channels; i++, p++) {
5691 1.2 isaki *p = bswap16(*p);
5692 1.2 isaki }
5693 1.2 isaki }
5694 1.2 isaki
5695 1.2 isaki /* Distribute to all tracks. */
5696 1.2 isaki SLIST_FOREACH(f, &sc->sc_files, entry) {
5697 1.2 isaki audio_track_t *track = f->rtrack;
5698 1.2 isaki audio_ring_t *input;
5699 1.2 isaki
5700 1.2 isaki if (track == NULL)
5701 1.2 isaki continue;
5702 1.2 isaki
5703 1.2 isaki if (track->is_pause) {
5704 1.2 isaki TRACET(4, track, "skip; paused");
5705 1.2 isaki continue;
5706 1.2 isaki }
5707 1.2 isaki
5708 1.2 isaki if (audio_track_lock_tryenter(track) == false) {
5709 1.2 isaki TRACET(4, track, "skip; in use");
5710 1.2 isaki continue;
5711 1.2 isaki }
5712 1.2 isaki
5713 1.2 isaki /* If the track buffer is full, discard the oldest one? */
5714 1.2 isaki input = track->input;
5715 1.2 isaki if (input->capacity - input->used < mixer->frames_per_block) {
5716 1.2 isaki int drops = mixer->frames_per_block -
5717 1.2 isaki (input->capacity - input->used);
5718 1.2 isaki track->dropframes += drops;
5719 1.2 isaki TRACET(4, track, "drop %d frames: inp=%d/%d/%d",
5720 1.2 isaki drops,
5721 1.2 isaki input->head, input->used, input->capacity);
5722 1.2 isaki auring_take(input, drops);
5723 1.2 isaki }
5724 1.28.2.8 martin KASSERTMSG(input->used % mixer->frames_per_block == 0,
5725 1.28.2.8 martin "input->used=%d mixer->frames_per_block=%d",
5726 1.28.2.8 martin input->used, mixer->frames_per_block);
5727 1.2 isaki
5728 1.2 isaki memcpy(auring_tailptr_aint(input),
5729 1.2 isaki auring_headptr_aint(mixersrc),
5730 1.2 isaki bytes);
5731 1.2 isaki auring_push(input, count);
5732 1.2 isaki
5733 1.2 isaki /* XXX sequence counter? */
5734 1.2 isaki
5735 1.2 isaki audio_track_lock_exit(track);
5736 1.2 isaki }
5737 1.2 isaki
5738 1.2 isaki auring_take(mixersrc, count);
5739 1.2 isaki }
5740 1.2 isaki
5741 1.2 isaki /*
5742 1.2 isaki * Input one block from HW to hwbuf.
5743 1.2 isaki * Must be called with sc_intr_lock held.
5744 1.2 isaki */
5745 1.2 isaki static void
5746 1.2 isaki audio_rmixer_input(struct audio_softc *sc)
5747 1.2 isaki {
5748 1.2 isaki audio_trackmixer_t *mixer;
5749 1.2 isaki audio_params_t params;
5750 1.2 isaki void *start;
5751 1.2 isaki void *end;
5752 1.2 isaki int blksize;
5753 1.2 isaki int error;
5754 1.2 isaki
5755 1.2 isaki mixer = sc->sc_rmixer;
5756 1.2 isaki blksize = frametobyte(&mixer->hwbuf.fmt, mixer->frames_per_block);
5757 1.2 isaki
5758 1.2 isaki if (sc->hw_if->trigger_input) {
5759 1.2 isaki /* trigger (at once) */
5760 1.2 isaki if (!sc->sc_rbusy) {
5761 1.2 isaki start = mixer->hwbuf.mem;
5762 1.2 isaki end = (uint8_t *)start + auring_bytelen(&mixer->hwbuf);
5763 1.2 isaki params = format2_to_params(&mixer->hwbuf.fmt);
5764 1.2 isaki
5765 1.2 isaki error = sc->hw_if->trigger_input(sc->hw_hdl,
5766 1.2 isaki start, end, blksize, audio_rintr, sc, ¶ms);
5767 1.2 isaki if (error) {
5768 1.2 isaki device_printf(sc->sc_dev,
5769 1.15 isaki "trigger_input failed with %d\n", error);
5770 1.2 isaki return;
5771 1.2 isaki }
5772 1.2 isaki }
5773 1.2 isaki } else {
5774 1.2 isaki /* start (everytime) */
5775 1.2 isaki start = auring_tailptr(&mixer->hwbuf);
5776 1.2 isaki
5777 1.2 isaki error = sc->hw_if->start_input(sc->hw_hdl,
5778 1.2 isaki start, blksize, audio_rintr, sc);
5779 1.2 isaki if (error) {
5780 1.2 isaki device_printf(sc->sc_dev,
5781 1.15 isaki "start_input failed with %d\n", error);
5782 1.2 isaki return;
5783 1.2 isaki }
5784 1.2 isaki }
5785 1.2 isaki }
5786 1.2 isaki
5787 1.2 isaki /*
5788 1.2 isaki * This is an interrupt handler for recording.
5789 1.2 isaki * It is called with sc_intr_lock.
5790 1.2 isaki *
5791 1.2 isaki * It is usually called from hardware interrupt. However, note that
5792 1.2 isaki * for some drivers (e.g. uaudio) it is called from software interrupt.
5793 1.2 isaki */
5794 1.2 isaki static void
5795 1.2 isaki audio_rintr(void *arg)
5796 1.2 isaki {
5797 1.2 isaki struct audio_softc *sc;
5798 1.2 isaki audio_trackmixer_t *mixer;
5799 1.2 isaki
5800 1.2 isaki sc = arg;
5801 1.2 isaki KASSERT(mutex_owned(sc->sc_intr_lock));
5802 1.2 isaki
5803 1.2 isaki if (sc->sc_dying)
5804 1.2 isaki return;
5805 1.2 isaki if (sc->sc_rbusy == false) {
5806 1.28.2.14 martin #if defined(DIAGNOSTIC)
5807 1.28.2.14 martin device_printf(sc->sc_dev,
5808 1.28.2.14 martin "DIAGNOSTIC: %s raised stray interrupt\n",
5809 1.28.2.14 martin device_xname(sc->hw_dev));
5810 1.28.2.14 martin #endif
5811 1.2 isaki return;
5812 1.2 isaki }
5813 1.2 isaki
5814 1.2 isaki mixer = sc->sc_rmixer;
5815 1.2 isaki mixer->hw_complete_counter += mixer->frames_per_block;
5816 1.2 isaki mixer->hwseq++;
5817 1.2 isaki
5818 1.2 isaki auring_push(&mixer->hwbuf, mixer->frames_per_block);
5819 1.2 isaki
5820 1.2 isaki TRACE(4,
5821 1.2 isaki "HW_INT ++hwseq=%" PRIu64 " cmplcnt=%" PRIu64 " hwbuf=%d/%d/%d",
5822 1.2 isaki mixer->hwseq, mixer->hw_complete_counter,
5823 1.2 isaki mixer->hwbuf.head, mixer->hwbuf.used, mixer->hwbuf.capacity);
5824 1.2 isaki
5825 1.2 isaki /* Distrubute recorded block */
5826 1.2 isaki audio_rmixer_process(sc);
5827 1.2 isaki
5828 1.2 isaki /* Request next block */
5829 1.2 isaki audio_rmixer_input(sc);
5830 1.2 isaki
5831 1.2 isaki /*
5832 1.2 isaki * When this interrupt is the real hardware interrupt, disabling
5833 1.2 isaki * preemption here is not necessary. But some drivers (e.g. uaudio)
5834 1.2 isaki * emulate it by software interrupt, so kpreempt_disable is necessary.
5835 1.2 isaki */
5836 1.2 isaki kpreempt_disable();
5837 1.2 isaki softint_schedule(mixer->sih);
5838 1.2 isaki kpreempt_enable();
5839 1.2 isaki }
5840 1.2 isaki
5841 1.2 isaki /*
5842 1.2 isaki * Halts playback mixer.
5843 1.2 isaki * This function also clears related parameters, so call this function
5844 1.2 isaki * instead of calling halt_output directly.
5845 1.2 isaki * Must be called only if sc_pbusy is true.
5846 1.2 isaki * Must be called with sc_lock && sc_exlock held.
5847 1.2 isaki */
5848 1.2 isaki static int
5849 1.2 isaki audio_pmixer_halt(struct audio_softc *sc)
5850 1.2 isaki {
5851 1.2 isaki int error;
5852 1.2 isaki
5853 1.2 isaki TRACE(2, "");
5854 1.2 isaki KASSERT(mutex_owned(sc->sc_lock));
5855 1.2 isaki KASSERT(sc->sc_exlock);
5856 1.2 isaki
5857 1.2 isaki mutex_enter(sc->sc_intr_lock);
5858 1.2 isaki error = sc->hw_if->halt_output(sc->hw_hdl);
5859 1.2 isaki mutex_exit(sc->sc_intr_lock);
5860 1.2 isaki
5861 1.2 isaki /* Halts anyway even if some error has occurred. */
5862 1.2 isaki sc->sc_pbusy = false;
5863 1.2 isaki sc->sc_pmixer->hwbuf.head = 0;
5864 1.2 isaki sc->sc_pmixer->hwbuf.used = 0;
5865 1.2 isaki sc->sc_pmixer->mixseq = 0;
5866 1.2 isaki sc->sc_pmixer->hwseq = 0;
5867 1.2 isaki
5868 1.2 isaki return error;
5869 1.2 isaki }
5870 1.2 isaki
5871 1.2 isaki /*
5872 1.2 isaki * Halts recording mixer.
5873 1.2 isaki * This function also clears related parameters, so call this function
5874 1.2 isaki * instead of calling halt_input directly.
5875 1.2 isaki * Must be called only if sc_rbusy is true.
5876 1.2 isaki * Must be called with sc_lock && sc_exlock held.
5877 1.2 isaki */
5878 1.2 isaki static int
5879 1.2 isaki audio_rmixer_halt(struct audio_softc *sc)
5880 1.2 isaki {
5881 1.2 isaki int error;
5882 1.2 isaki
5883 1.2 isaki TRACE(2, "");
5884 1.2 isaki KASSERT(mutex_owned(sc->sc_lock));
5885 1.2 isaki KASSERT(sc->sc_exlock);
5886 1.2 isaki
5887 1.2 isaki mutex_enter(sc->sc_intr_lock);
5888 1.2 isaki error = sc->hw_if->halt_input(sc->hw_hdl);
5889 1.2 isaki mutex_exit(sc->sc_intr_lock);
5890 1.2 isaki
5891 1.2 isaki /* Halts anyway even if some error has occurred. */
5892 1.2 isaki sc->sc_rbusy = false;
5893 1.2 isaki sc->sc_rmixer->hwbuf.head = 0;
5894 1.2 isaki sc->sc_rmixer->hwbuf.used = 0;
5895 1.2 isaki sc->sc_rmixer->mixseq = 0;
5896 1.2 isaki sc->sc_rmixer->hwseq = 0;
5897 1.2 isaki
5898 1.2 isaki return error;
5899 1.2 isaki }
5900 1.2 isaki
5901 1.2 isaki /*
5902 1.2 isaki * Flush this track.
5903 1.2 isaki * Halts all operations, clears all buffers, reset error counters.
5904 1.2 isaki * XXX I'm not sure...
5905 1.2 isaki */
5906 1.2 isaki static void
5907 1.2 isaki audio_track_clear(struct audio_softc *sc, audio_track_t *track)
5908 1.2 isaki {
5909 1.2 isaki
5910 1.2 isaki KASSERT(track);
5911 1.2 isaki TRACET(3, track, "clear");
5912 1.2 isaki
5913 1.2 isaki audio_track_lock_enter(track);
5914 1.2 isaki
5915 1.2 isaki track->usrbuf.used = 0;
5916 1.2 isaki /* Clear all internal parameters. */
5917 1.2 isaki if (track->codec.filter) {
5918 1.2 isaki track->codec.srcbuf.used = 0;
5919 1.2 isaki track->codec.srcbuf.head = 0;
5920 1.2 isaki }
5921 1.2 isaki if (track->chvol.filter) {
5922 1.2 isaki track->chvol.srcbuf.used = 0;
5923 1.2 isaki track->chvol.srcbuf.head = 0;
5924 1.2 isaki }
5925 1.2 isaki if (track->chmix.filter) {
5926 1.2 isaki track->chmix.srcbuf.used = 0;
5927 1.2 isaki track->chmix.srcbuf.head = 0;
5928 1.2 isaki }
5929 1.2 isaki if (track->freq.filter) {
5930 1.2 isaki track->freq.srcbuf.used = 0;
5931 1.2 isaki track->freq.srcbuf.head = 0;
5932 1.2 isaki if (track->freq_step < 65536)
5933 1.2 isaki track->freq_current = 65536;
5934 1.2 isaki else
5935 1.2 isaki track->freq_current = 0;
5936 1.2 isaki memset(track->freq_prev, 0, sizeof(track->freq_prev));
5937 1.2 isaki memset(track->freq_curr, 0, sizeof(track->freq_curr));
5938 1.2 isaki }
5939 1.2 isaki /* Clear buffer, then operation halts naturally. */
5940 1.2 isaki track->outbuf.used = 0;
5941 1.2 isaki
5942 1.2 isaki /* Clear counters. */
5943 1.2 isaki track->dropframes = 0;
5944 1.2 isaki
5945 1.2 isaki audio_track_lock_exit(track);
5946 1.2 isaki }
5947 1.2 isaki
5948 1.2 isaki /*
5949 1.2 isaki * Drain the track.
5950 1.2 isaki * track must be present and for playback.
5951 1.2 isaki * If successful, it returns 0. Otherwise returns errno.
5952 1.2 isaki * Must be called with sc_lock held.
5953 1.2 isaki */
5954 1.2 isaki static int
5955 1.2 isaki audio_track_drain(struct audio_softc *sc, audio_track_t *track)
5956 1.2 isaki {
5957 1.2 isaki audio_trackmixer_t *mixer;
5958 1.2 isaki int done;
5959 1.2 isaki int error;
5960 1.2 isaki
5961 1.2 isaki KASSERT(track);
5962 1.2 isaki TRACET(3, track, "start");
5963 1.2 isaki mixer = track->mixer;
5964 1.2 isaki KASSERT(mutex_owned(sc->sc_lock));
5965 1.2 isaki
5966 1.2 isaki /* Ignore them if pause. */
5967 1.2 isaki if (track->is_pause) {
5968 1.2 isaki TRACET(3, track, "pause -> clear");
5969 1.2 isaki track->pstate = AUDIO_STATE_CLEAR;
5970 1.2 isaki }
5971 1.2 isaki /* Terminate early here if there is no data in the track. */
5972 1.2 isaki if (track->pstate == AUDIO_STATE_CLEAR) {
5973 1.2 isaki TRACET(3, track, "no need to drain");
5974 1.2 isaki return 0;
5975 1.2 isaki }
5976 1.2 isaki track->pstate = AUDIO_STATE_DRAINING;
5977 1.2 isaki
5978 1.2 isaki for (;;) {
5979 1.10 isaki /* I want to display it before condition evaluation. */
5980 1.2 isaki TRACET(3, track, "pid=%d.%d trkseq=%d hwseq=%d out=%d/%d/%d",
5981 1.2 isaki (int)curproc->p_pid, (int)curlwp->l_lid,
5982 1.2 isaki (int)track->seq, (int)mixer->hwseq,
5983 1.2 isaki track->outbuf.head, track->outbuf.used,
5984 1.2 isaki track->outbuf.capacity);
5985 1.2 isaki
5986 1.2 isaki /* Condition to terminate */
5987 1.2 isaki audio_track_lock_enter(track);
5988 1.2 isaki done = (track->usrbuf.used < frametobyte(&track->inputfmt, 1) &&
5989 1.2 isaki track->outbuf.used == 0 &&
5990 1.2 isaki track->seq <= mixer->hwseq);
5991 1.2 isaki audio_track_lock_exit(track);
5992 1.2 isaki if (done)
5993 1.2 isaki break;
5994 1.2 isaki
5995 1.2 isaki TRACET(3, track, "sleep");
5996 1.2 isaki error = audio_track_waitio(sc, track);
5997 1.2 isaki if (error)
5998 1.2 isaki return error;
5999 1.2 isaki
6000 1.2 isaki /* XXX call audio_track_play here ? */
6001 1.2 isaki }
6002 1.2 isaki
6003 1.2 isaki track->pstate = AUDIO_STATE_CLEAR;
6004 1.2 isaki TRACET(3, track, "done trk_inp=%d trk_out=%d",
6005 1.2 isaki (int)track->inputcounter, (int)track->outputcounter);
6006 1.2 isaki return 0;
6007 1.2 isaki }
6008 1.2 isaki
6009 1.2 isaki /*
6010 1.28.2.2 martin * Send signal to process.
6011 1.28.2.2 martin * This is intended to be called only from audio_softintr_{rd,wr}.
6012 1.28.2.12 martin * Must be called without sc_intr_lock held.
6013 1.28.2.2 martin */
6014 1.28.2.2 martin static inline void
6015 1.28.2.2 martin audio_psignal(struct audio_softc *sc, pid_t pid, int signum)
6016 1.28.2.2 martin {
6017 1.28.2.2 martin proc_t *p;
6018 1.28.2.2 martin
6019 1.28.2.2 martin KASSERT(pid != 0);
6020 1.28.2.2 martin
6021 1.28.2.2 martin /*
6022 1.28.2.2 martin * psignal() must be called without spin lock held.
6023 1.28.2.2 martin */
6024 1.28.2.2 martin
6025 1.28.2.2 martin mutex_enter(proc_lock);
6026 1.28.2.2 martin p = proc_find(pid);
6027 1.28.2.2 martin if (p)
6028 1.28.2.2 martin psignal(p, signum);
6029 1.28.2.2 martin mutex_exit(proc_lock);
6030 1.28.2.2 martin }
6031 1.28.2.2 martin
6032 1.28.2.2 martin /*
6033 1.2 isaki * This is software interrupt handler for record.
6034 1.2 isaki * It is called from recording hardware interrupt everytime.
6035 1.2 isaki * It does:
6036 1.2 isaki * - Deliver SIGIO for all async processes.
6037 1.2 isaki * - Notify to audio_read() that data has arrived.
6038 1.2 isaki * - selnotify() for select/poll-ing processes.
6039 1.2 isaki */
6040 1.2 isaki /*
6041 1.2 isaki * XXX If a process issues FIOASYNC between hardware interrupt and
6042 1.2 isaki * software interrupt, (stray) SIGIO will be sent to the process
6043 1.2 isaki * despite the fact that it has not receive recorded data yet.
6044 1.2 isaki */
6045 1.2 isaki static void
6046 1.2 isaki audio_softintr_rd(void *cookie)
6047 1.2 isaki {
6048 1.2 isaki struct audio_softc *sc = cookie;
6049 1.2 isaki audio_file_t *f;
6050 1.2 isaki pid_t pid;
6051 1.2 isaki
6052 1.2 isaki mutex_enter(sc->sc_lock);
6053 1.2 isaki
6054 1.2 isaki SLIST_FOREACH(f, &sc->sc_files, entry) {
6055 1.2 isaki audio_track_t *track = f->rtrack;
6056 1.2 isaki
6057 1.2 isaki if (track == NULL)
6058 1.2 isaki continue;
6059 1.2 isaki
6060 1.2 isaki TRACET(4, track, "broadcast; inp=%d/%d/%d",
6061 1.2 isaki track->input->head,
6062 1.2 isaki track->input->used,
6063 1.2 isaki track->input->capacity);
6064 1.2 isaki
6065 1.2 isaki pid = f->async_audio;
6066 1.2 isaki if (pid != 0) {
6067 1.2 isaki TRACEF(4, f, "sending SIGIO %d", pid);
6068 1.28.2.2 martin audio_psignal(sc, pid, SIGIO);
6069 1.2 isaki }
6070 1.2 isaki }
6071 1.2 isaki
6072 1.2 isaki /* Notify that data has arrived. */
6073 1.2 isaki selnotify(&sc->sc_rsel, 0, NOTE_SUBMIT);
6074 1.2 isaki KNOTE(&sc->sc_rsel.sel_klist, 0);
6075 1.2 isaki cv_broadcast(&sc->sc_rmixer->outcv);
6076 1.2 isaki
6077 1.2 isaki mutex_exit(sc->sc_lock);
6078 1.2 isaki }
6079 1.2 isaki
6080 1.2 isaki /*
6081 1.2 isaki * This is software interrupt handler for playback.
6082 1.2 isaki * It is called from playback hardware interrupt everytime.
6083 1.2 isaki * It does:
6084 1.2 isaki * - Deliver SIGIO for all async and writable (used < lowat) processes.
6085 1.2 isaki * - Notify to audio_write() that outbuf block available.
6086 1.2 isaki * - selnotify() for select/poll-ing processes if there are any writable
6087 1.2 isaki * (used < lowat) processes. Checking each descriptor will be done by
6088 1.2 isaki * filt_audiowrite_event().
6089 1.2 isaki */
6090 1.2 isaki static void
6091 1.2 isaki audio_softintr_wr(void *cookie)
6092 1.2 isaki {
6093 1.2 isaki struct audio_softc *sc = cookie;
6094 1.2 isaki audio_file_t *f;
6095 1.2 isaki bool found;
6096 1.2 isaki pid_t pid;
6097 1.2 isaki
6098 1.2 isaki TRACE(4, "called");
6099 1.2 isaki found = false;
6100 1.2 isaki
6101 1.2 isaki mutex_enter(sc->sc_lock);
6102 1.2 isaki
6103 1.2 isaki SLIST_FOREACH(f, &sc->sc_files, entry) {
6104 1.2 isaki audio_track_t *track = f->ptrack;
6105 1.2 isaki
6106 1.2 isaki if (track == NULL)
6107 1.2 isaki continue;
6108 1.2 isaki
6109 1.2 isaki TRACET(4, track, "broadcast; trseq=%d out=%d/%d/%d",
6110 1.2 isaki (int)track->seq,
6111 1.2 isaki track->outbuf.head,
6112 1.2 isaki track->outbuf.used,
6113 1.2 isaki track->outbuf.capacity);
6114 1.2 isaki
6115 1.2 isaki /*
6116 1.2 isaki * Send a signal if the process is async mode and
6117 1.2 isaki * used is lower than lowat.
6118 1.2 isaki */
6119 1.2 isaki if (track->usrbuf.used <= track->usrbuf_usedlow &&
6120 1.2 isaki !track->is_pause) {
6121 1.28.2.2 martin /* For selnotify */
6122 1.2 isaki found = true;
6123 1.28.2.2 martin /* For SIGIO */
6124 1.2 isaki pid = f->async_audio;
6125 1.2 isaki if (pid != 0) {
6126 1.2 isaki TRACEF(4, f, "sending SIGIO %d", pid);
6127 1.28.2.2 martin audio_psignal(sc, pid, SIGIO);
6128 1.2 isaki }
6129 1.2 isaki }
6130 1.2 isaki }
6131 1.2 isaki
6132 1.2 isaki /*
6133 1.2 isaki * Notify for select/poll when someone become writable.
6134 1.2 isaki * It needs sc_lock (and not sc_intr_lock).
6135 1.2 isaki */
6136 1.2 isaki if (found) {
6137 1.2 isaki TRACE(4, "selnotify");
6138 1.2 isaki selnotify(&sc->sc_wsel, 0, NOTE_SUBMIT);
6139 1.2 isaki KNOTE(&sc->sc_wsel.sel_klist, 0);
6140 1.2 isaki }
6141 1.2 isaki
6142 1.2 isaki /* Notify to audio_write() that outbuf available. */
6143 1.2 isaki cv_broadcast(&sc->sc_pmixer->outcv);
6144 1.2 isaki
6145 1.2 isaki mutex_exit(sc->sc_lock);
6146 1.2 isaki }
6147 1.2 isaki
6148 1.2 isaki /*
6149 1.2 isaki * Check (and convert) the format *p came from userland.
6150 1.2 isaki * If successful, it writes back the converted format to *p if necessary
6151 1.2 isaki * and returns 0. Otherwise returns errno (*p may change even this case).
6152 1.2 isaki */
6153 1.2 isaki static int
6154 1.2 isaki audio_check_params(audio_format2_t *p)
6155 1.2 isaki {
6156 1.2 isaki
6157 1.2 isaki /* Convert obsoleted AUDIO_ENCODING_PCM* */
6158 1.2 isaki /* XXX Is this conversion right? */
6159 1.2 isaki if (p->encoding == AUDIO_ENCODING_PCM16) {
6160 1.2 isaki if (p->precision == 8)
6161 1.2 isaki p->encoding = AUDIO_ENCODING_ULINEAR;
6162 1.2 isaki else
6163 1.2 isaki p->encoding = AUDIO_ENCODING_SLINEAR;
6164 1.2 isaki } else if (p->encoding == AUDIO_ENCODING_PCM8) {
6165 1.2 isaki if (p->precision == 8)
6166 1.2 isaki p->encoding = AUDIO_ENCODING_ULINEAR;
6167 1.2 isaki else
6168 1.2 isaki return EINVAL;
6169 1.2 isaki }
6170 1.2 isaki
6171 1.2 isaki /*
6172 1.2 isaki * Convert obsoleted AUDIO_ENCODING_[SU]LINEAR without endianness
6173 1.2 isaki * suffix.
6174 1.2 isaki */
6175 1.2 isaki if (p->encoding == AUDIO_ENCODING_SLINEAR)
6176 1.2 isaki p->encoding = AUDIO_ENCODING_SLINEAR_NE;
6177 1.2 isaki if (p->encoding == AUDIO_ENCODING_ULINEAR)
6178 1.2 isaki p->encoding = AUDIO_ENCODING_ULINEAR_NE;
6179 1.2 isaki
6180 1.2 isaki switch (p->encoding) {
6181 1.2 isaki case AUDIO_ENCODING_ULAW:
6182 1.2 isaki case AUDIO_ENCODING_ALAW:
6183 1.2 isaki if (p->precision != 8)
6184 1.2 isaki return EINVAL;
6185 1.2 isaki break;
6186 1.2 isaki case AUDIO_ENCODING_ADPCM:
6187 1.2 isaki if (p->precision != 4 && p->precision != 8)
6188 1.2 isaki return EINVAL;
6189 1.2 isaki break;
6190 1.2 isaki case AUDIO_ENCODING_SLINEAR_LE:
6191 1.2 isaki case AUDIO_ENCODING_SLINEAR_BE:
6192 1.2 isaki case AUDIO_ENCODING_ULINEAR_LE:
6193 1.2 isaki case AUDIO_ENCODING_ULINEAR_BE:
6194 1.2 isaki if (p->precision != 8 && p->precision != 16 &&
6195 1.2 isaki p->precision != 24 && p->precision != 32)
6196 1.2 isaki return EINVAL;
6197 1.2 isaki
6198 1.2 isaki /* 8bit format does not have endianness. */
6199 1.2 isaki if (p->precision == 8) {
6200 1.2 isaki if (p->encoding == AUDIO_ENCODING_SLINEAR_OE)
6201 1.2 isaki p->encoding = AUDIO_ENCODING_SLINEAR_NE;
6202 1.2 isaki if (p->encoding == AUDIO_ENCODING_ULINEAR_OE)
6203 1.2 isaki p->encoding = AUDIO_ENCODING_ULINEAR_NE;
6204 1.2 isaki }
6205 1.2 isaki
6206 1.2 isaki if (p->precision > p->stride)
6207 1.2 isaki return EINVAL;
6208 1.2 isaki break;
6209 1.2 isaki case AUDIO_ENCODING_MPEG_L1_STREAM:
6210 1.2 isaki case AUDIO_ENCODING_MPEG_L1_PACKETS:
6211 1.2 isaki case AUDIO_ENCODING_MPEG_L1_SYSTEM:
6212 1.2 isaki case AUDIO_ENCODING_MPEG_L2_STREAM:
6213 1.2 isaki case AUDIO_ENCODING_MPEG_L2_PACKETS:
6214 1.2 isaki case AUDIO_ENCODING_MPEG_L2_SYSTEM:
6215 1.2 isaki case AUDIO_ENCODING_AC3:
6216 1.2 isaki break;
6217 1.2 isaki default:
6218 1.2 isaki return EINVAL;
6219 1.2 isaki }
6220 1.2 isaki
6221 1.2 isaki /* sanity check # of channels*/
6222 1.2 isaki if (p->channels < 1 || p->channels > AUDIO_MAX_CHANNELS)
6223 1.2 isaki return EINVAL;
6224 1.2 isaki
6225 1.2 isaki return 0;
6226 1.2 isaki }
6227 1.2 isaki
6228 1.2 isaki /*
6229 1.2 isaki * Initialize playback and record mixers.
6230 1.2 isaki * mode (AUMODE_{PLAY,RECORD}) indicates the mixer to be initalized.
6231 1.2 isaki * phwfmt and rhwfmt indicate the hardware format. pfil and rfil indicate
6232 1.2 isaki * the filter registration information. These four must not be NULL.
6233 1.2 isaki * If successful returns 0. Otherwise returns errno.
6234 1.28.2.12 martin * Must be called with sc_exlock held and without sc_lock held.
6235 1.2 isaki * Must not be called if there are any tracks.
6236 1.2 isaki * Caller should check that the initialization succeed by whether
6237 1.2 isaki * sc_[pr]mixer is not NULL.
6238 1.2 isaki */
6239 1.2 isaki static int
6240 1.2 isaki audio_mixers_init(struct audio_softc *sc, int mode,
6241 1.2 isaki const audio_format2_t *phwfmt, const audio_format2_t *rhwfmt,
6242 1.2 isaki const audio_filter_reg_t *pfil, const audio_filter_reg_t *rfil)
6243 1.2 isaki {
6244 1.2 isaki int error;
6245 1.2 isaki
6246 1.2 isaki KASSERT(phwfmt != NULL);
6247 1.2 isaki KASSERT(rhwfmt != NULL);
6248 1.2 isaki KASSERT(pfil != NULL);
6249 1.2 isaki KASSERT(rfil != NULL);
6250 1.28.2.12 martin KASSERT(sc->sc_exlock);
6251 1.2 isaki
6252 1.2 isaki if ((mode & AUMODE_PLAY)) {
6253 1.26 isaki if (sc->sc_pmixer == NULL) {
6254 1.26 isaki sc->sc_pmixer = kmem_zalloc(sizeof(*sc->sc_pmixer),
6255 1.26 isaki KM_SLEEP);
6256 1.26 isaki } else {
6257 1.26 isaki /* destroy() doesn't free memory. */
6258 1.2 isaki audio_mixer_destroy(sc, sc->sc_pmixer);
6259 1.26 isaki memset(sc->sc_pmixer, 0, sizeof(*sc->sc_pmixer));
6260 1.2 isaki }
6261 1.2 isaki error = audio_mixer_init(sc, AUMODE_PLAY, phwfmt, pfil);
6262 1.2 isaki if (error) {
6263 1.2 isaki aprint_error_dev(sc->sc_dev,
6264 1.2 isaki "configuring playback mode failed\n");
6265 1.2 isaki kmem_free(sc->sc_pmixer, sizeof(*sc->sc_pmixer));
6266 1.2 isaki sc->sc_pmixer = NULL;
6267 1.2 isaki return error;
6268 1.2 isaki }
6269 1.2 isaki }
6270 1.2 isaki if ((mode & AUMODE_RECORD)) {
6271 1.26 isaki if (sc->sc_rmixer == NULL) {
6272 1.26 isaki sc->sc_rmixer = kmem_zalloc(sizeof(*sc->sc_rmixer),
6273 1.26 isaki KM_SLEEP);
6274 1.26 isaki } else {
6275 1.26 isaki /* destroy() doesn't free memory. */
6276 1.2 isaki audio_mixer_destroy(sc, sc->sc_rmixer);
6277 1.26 isaki memset(sc->sc_rmixer, 0, sizeof(*sc->sc_rmixer));
6278 1.2 isaki }
6279 1.2 isaki error = audio_mixer_init(sc, AUMODE_RECORD, rhwfmt, rfil);
6280 1.2 isaki if (error) {
6281 1.2 isaki aprint_error_dev(sc->sc_dev,
6282 1.2 isaki "configuring record mode failed\n");
6283 1.2 isaki kmem_free(sc->sc_rmixer, sizeof(*sc->sc_rmixer));
6284 1.2 isaki sc->sc_rmixer = NULL;
6285 1.2 isaki return error;
6286 1.2 isaki }
6287 1.2 isaki }
6288 1.2 isaki
6289 1.2 isaki return 0;
6290 1.2 isaki }
6291 1.2 isaki
6292 1.2 isaki /*
6293 1.2 isaki * Select a frequency.
6294 1.2 isaki * Prioritize 48kHz and 44.1kHz. Otherwise choose the highest one.
6295 1.2 isaki * XXX Better algorithm?
6296 1.2 isaki */
6297 1.2 isaki static int
6298 1.2 isaki audio_select_freq(const struct audio_format *fmt)
6299 1.2 isaki {
6300 1.2 isaki int freq;
6301 1.2 isaki int high;
6302 1.2 isaki int low;
6303 1.2 isaki int j;
6304 1.2 isaki
6305 1.2 isaki if (fmt->frequency_type == 0) {
6306 1.2 isaki low = fmt->frequency[0];
6307 1.2 isaki high = fmt->frequency[1];
6308 1.2 isaki freq = 48000;
6309 1.2 isaki if (low <= freq && freq <= high) {
6310 1.2 isaki return freq;
6311 1.2 isaki }
6312 1.2 isaki freq = 44100;
6313 1.2 isaki if (low <= freq && freq <= high) {
6314 1.2 isaki return freq;
6315 1.2 isaki }
6316 1.2 isaki return high;
6317 1.2 isaki } else {
6318 1.2 isaki for (j = 0; j < fmt->frequency_type; j++) {
6319 1.2 isaki if (fmt->frequency[j] == 48000) {
6320 1.2 isaki return fmt->frequency[j];
6321 1.2 isaki }
6322 1.2 isaki }
6323 1.2 isaki high = 0;
6324 1.2 isaki for (j = 0; j < fmt->frequency_type; j++) {
6325 1.2 isaki if (fmt->frequency[j] == 44100) {
6326 1.2 isaki return fmt->frequency[j];
6327 1.2 isaki }
6328 1.2 isaki if (fmt->frequency[j] > high) {
6329 1.2 isaki high = fmt->frequency[j];
6330 1.2 isaki }
6331 1.2 isaki }
6332 1.2 isaki return high;
6333 1.2 isaki }
6334 1.2 isaki }
6335 1.2 isaki
6336 1.2 isaki /*
6337 1.2 isaki * Choose the most preferred hardware format.
6338 1.2 isaki * If successful, it will store the chosen format into *cand and return 0.
6339 1.2 isaki * Otherwise, return errno.
6340 1.28.2.12 martin * Must be called without sc_lock held.
6341 1.2 isaki */
6342 1.2 isaki static int
6343 1.28.2.12 martin audio_hw_probe(struct audio_softc *sc, audio_format2_t *cand, int mode)
6344 1.2 isaki {
6345 1.2 isaki audio_format_query_t query;
6346 1.2 isaki int cand_score;
6347 1.2 isaki int score;
6348 1.2 isaki int i;
6349 1.2 isaki int error;
6350 1.2 isaki
6351 1.2 isaki /*
6352 1.2 isaki * Score each formats and choose the highest one.
6353 1.2 isaki *
6354 1.2 isaki * +---- priority(0-3)
6355 1.2 isaki * |+--- encoding/precision
6356 1.2 isaki * ||+-- channels
6357 1.2 isaki * score = 0x000000PEC
6358 1.2 isaki */
6359 1.2 isaki
6360 1.2 isaki cand_score = 0;
6361 1.2 isaki for (i = 0; ; i++) {
6362 1.2 isaki memset(&query, 0, sizeof(query));
6363 1.2 isaki query.index = i;
6364 1.2 isaki
6365 1.28.2.12 martin mutex_enter(sc->sc_lock);
6366 1.2 isaki error = sc->hw_if->query_format(sc->hw_hdl, &query);
6367 1.28.2.12 martin mutex_exit(sc->sc_lock);
6368 1.2 isaki if (error == EINVAL)
6369 1.2 isaki break;
6370 1.2 isaki if (error)
6371 1.2 isaki return error;
6372 1.2 isaki
6373 1.2 isaki #if defined(AUDIO_DEBUG)
6374 1.2 isaki DPRINTF(1, "fmt[%d] %c%c pri=%d %s,%d/%dbit,%dch,", i,
6375 1.2 isaki (query.fmt.mode & AUMODE_PLAY) ? 'P' : '-',
6376 1.2 isaki (query.fmt.mode & AUMODE_RECORD) ? 'R' : '-',
6377 1.2 isaki query.fmt.priority,
6378 1.2 isaki audio_encoding_name(query.fmt.encoding),
6379 1.2 isaki query.fmt.validbits,
6380 1.2 isaki query.fmt.precision,
6381 1.2 isaki query.fmt.channels);
6382 1.2 isaki if (query.fmt.frequency_type == 0) {
6383 1.2 isaki DPRINTF(1, "{%d-%d",
6384 1.2 isaki query.fmt.frequency[0], query.fmt.frequency[1]);
6385 1.2 isaki } else {
6386 1.2 isaki int j;
6387 1.2 isaki for (j = 0; j < query.fmt.frequency_type; j++) {
6388 1.2 isaki DPRINTF(1, "%c%d",
6389 1.2 isaki (j == 0) ? '{' : ',',
6390 1.2 isaki query.fmt.frequency[j]);
6391 1.2 isaki }
6392 1.2 isaki }
6393 1.2 isaki DPRINTF(1, "}\n");
6394 1.2 isaki #endif
6395 1.2 isaki
6396 1.2 isaki if ((query.fmt.mode & mode) == 0) {
6397 1.2 isaki DPRINTF(1, "fmt[%d] skip; mode not match %d\n", i,
6398 1.2 isaki mode);
6399 1.2 isaki continue;
6400 1.2 isaki }
6401 1.2 isaki
6402 1.2 isaki if (query.fmt.priority < 0) {
6403 1.2 isaki DPRINTF(1, "fmt[%d] skip; unsupported encoding\n", i);
6404 1.2 isaki continue;
6405 1.2 isaki }
6406 1.2 isaki
6407 1.2 isaki /* Score */
6408 1.2 isaki score = (query.fmt.priority & 3) * 0x100;
6409 1.2 isaki if (query.fmt.encoding == AUDIO_ENCODING_SLINEAR_NE &&
6410 1.2 isaki query.fmt.validbits == AUDIO_INTERNAL_BITS &&
6411 1.2 isaki query.fmt.precision == AUDIO_INTERNAL_BITS) {
6412 1.2 isaki score += 0x20;
6413 1.2 isaki } else if (query.fmt.encoding == AUDIO_ENCODING_SLINEAR_OE &&
6414 1.2 isaki query.fmt.validbits == AUDIO_INTERNAL_BITS &&
6415 1.2 isaki query.fmt.precision == AUDIO_INTERNAL_BITS) {
6416 1.2 isaki score += 0x10;
6417 1.2 isaki }
6418 1.2 isaki score += query.fmt.channels;
6419 1.2 isaki
6420 1.2 isaki if (score < cand_score) {
6421 1.2 isaki DPRINTF(1, "fmt[%d] skip; score 0x%x < 0x%x\n", i,
6422 1.2 isaki score, cand_score);
6423 1.2 isaki continue;
6424 1.2 isaki }
6425 1.2 isaki
6426 1.2 isaki /* Update candidate */
6427 1.2 isaki cand_score = score;
6428 1.2 isaki cand->encoding = query.fmt.encoding;
6429 1.2 isaki cand->precision = query.fmt.validbits;
6430 1.2 isaki cand->stride = query.fmt.precision;
6431 1.2 isaki cand->channels = query.fmt.channels;
6432 1.2 isaki cand->sample_rate = audio_select_freq(&query.fmt);
6433 1.2 isaki DPRINTF(1, "fmt[%d] candidate (score=0x%x)"
6434 1.2 isaki " pri=%d %s,%d/%d,%dch,%dHz\n", i,
6435 1.2 isaki cand_score, query.fmt.priority,
6436 1.2 isaki audio_encoding_name(query.fmt.encoding),
6437 1.2 isaki cand->precision, cand->stride,
6438 1.2 isaki cand->channels, cand->sample_rate);
6439 1.2 isaki }
6440 1.2 isaki
6441 1.2 isaki if (cand_score == 0) {
6442 1.2 isaki DPRINTF(1, "%s no fmt\n", __func__);
6443 1.2 isaki return ENXIO;
6444 1.2 isaki }
6445 1.2 isaki DPRINTF(1, "%s selected: %s,%d/%d,%dch,%dHz\n", __func__,
6446 1.2 isaki audio_encoding_name(cand->encoding),
6447 1.2 isaki cand->precision, cand->stride, cand->channels, cand->sample_rate);
6448 1.2 isaki return 0;
6449 1.2 isaki }
6450 1.2 isaki
6451 1.2 isaki /*
6452 1.2 isaki * Validate fmt with query_format.
6453 1.2 isaki * If fmt is included in the result of query_format, returns 0.
6454 1.2 isaki * Otherwise returns EINVAL.
6455 1.28.2.12 martin * Must be called without sc_lock held.
6456 1.2 isaki */
6457 1.2 isaki static int
6458 1.2 isaki audio_hw_validate_format(struct audio_softc *sc, int mode,
6459 1.2 isaki const audio_format2_t *fmt)
6460 1.2 isaki {
6461 1.2 isaki audio_format_query_t query;
6462 1.2 isaki struct audio_format *q;
6463 1.2 isaki int index;
6464 1.2 isaki int error;
6465 1.2 isaki int j;
6466 1.2 isaki
6467 1.2 isaki for (index = 0; ; index++) {
6468 1.2 isaki query.index = index;
6469 1.28.2.12 martin mutex_enter(sc->sc_lock);
6470 1.2 isaki error = sc->hw_if->query_format(sc->hw_hdl, &query);
6471 1.28.2.12 martin mutex_exit(sc->sc_lock);
6472 1.2 isaki if (error == EINVAL)
6473 1.2 isaki break;
6474 1.2 isaki if (error)
6475 1.2 isaki return error;
6476 1.2 isaki
6477 1.2 isaki q = &query.fmt;
6478 1.2 isaki /*
6479 1.2 isaki * Note that fmt is audio_format2_t (precision/stride) but
6480 1.2 isaki * q is audio_format_t (validbits/precision).
6481 1.2 isaki */
6482 1.2 isaki if ((q->mode & mode) == 0) {
6483 1.2 isaki continue;
6484 1.2 isaki }
6485 1.2 isaki if (fmt->encoding != q->encoding) {
6486 1.2 isaki continue;
6487 1.2 isaki }
6488 1.2 isaki if (fmt->precision != q->validbits) {
6489 1.2 isaki continue;
6490 1.2 isaki }
6491 1.2 isaki if (fmt->stride != q->precision) {
6492 1.2 isaki continue;
6493 1.2 isaki }
6494 1.2 isaki if (fmt->channels != q->channels) {
6495 1.2 isaki continue;
6496 1.2 isaki }
6497 1.2 isaki if (q->frequency_type == 0) {
6498 1.2 isaki if (fmt->sample_rate < q->frequency[0] ||
6499 1.2 isaki fmt->sample_rate > q->frequency[1]) {
6500 1.2 isaki continue;
6501 1.2 isaki }
6502 1.2 isaki } else {
6503 1.2 isaki for (j = 0; j < q->frequency_type; j++) {
6504 1.2 isaki if (fmt->sample_rate == q->frequency[j])
6505 1.2 isaki break;
6506 1.2 isaki }
6507 1.2 isaki if (j == query.fmt.frequency_type) {
6508 1.2 isaki continue;
6509 1.2 isaki }
6510 1.2 isaki }
6511 1.2 isaki
6512 1.2 isaki /* Matched. */
6513 1.2 isaki return 0;
6514 1.2 isaki }
6515 1.2 isaki
6516 1.2 isaki return EINVAL;
6517 1.2 isaki }
6518 1.2 isaki
6519 1.2 isaki /*
6520 1.2 isaki * Set track mixer's format depending on ai->mode.
6521 1.2 isaki * If AUMODE_PLAY is set in ai->mode, it set up the playback mixer
6522 1.2 isaki * with ai.play.{channels, sample_rate}.
6523 1.2 isaki * If AUMODE_RECORD is set in ai->mode, it set up the recording mixer
6524 1.2 isaki * with ai.record.{channels, sample_rate}.
6525 1.2 isaki * All other fields in ai are ignored.
6526 1.2 isaki * If successful returns 0. Otherwise returns errno.
6527 1.2 isaki * This function does not roll back even if it fails.
6528 1.28.2.12 martin * Must be called with sc_exlock held and without sc_lock held.
6529 1.2 isaki */
6530 1.2 isaki static int
6531 1.2 isaki audio_mixers_set_format(struct audio_softc *sc, const struct audio_info *ai)
6532 1.2 isaki {
6533 1.2 isaki audio_format2_t phwfmt;
6534 1.2 isaki audio_format2_t rhwfmt;
6535 1.2 isaki audio_filter_reg_t pfil;
6536 1.2 isaki audio_filter_reg_t rfil;
6537 1.2 isaki int mode;
6538 1.2 isaki int error;
6539 1.2 isaki
6540 1.28.2.12 martin KASSERT(sc->sc_exlock);
6541 1.2 isaki
6542 1.2 isaki /*
6543 1.2 isaki * Even when setting either one of playback and recording,
6544 1.2 isaki * both must be halted.
6545 1.2 isaki */
6546 1.2 isaki if (sc->sc_popens + sc->sc_ropens > 0)
6547 1.2 isaki return EBUSY;
6548 1.2 isaki
6549 1.2 isaki if (!SPECIFIED(ai->mode) || ai->mode == 0)
6550 1.2 isaki return ENOTTY;
6551 1.2 isaki
6552 1.2 isaki /* Only channels and sample_rate are changeable. */
6553 1.2 isaki mode = ai->mode;
6554 1.2 isaki if ((mode & AUMODE_PLAY)) {
6555 1.2 isaki phwfmt.encoding = ai->play.encoding;
6556 1.2 isaki phwfmt.precision = ai->play.precision;
6557 1.2 isaki phwfmt.stride = ai->play.precision;
6558 1.2 isaki phwfmt.channels = ai->play.channels;
6559 1.2 isaki phwfmt.sample_rate = ai->play.sample_rate;
6560 1.2 isaki }
6561 1.2 isaki if ((mode & AUMODE_RECORD)) {
6562 1.2 isaki rhwfmt.encoding = ai->record.encoding;
6563 1.2 isaki rhwfmt.precision = ai->record.precision;
6564 1.2 isaki rhwfmt.stride = ai->record.precision;
6565 1.2 isaki rhwfmt.channels = ai->record.channels;
6566 1.2 isaki rhwfmt.sample_rate = ai->record.sample_rate;
6567 1.2 isaki }
6568 1.2 isaki
6569 1.2 isaki /* On non-independent devices, use the same format for both. */
6570 1.14 isaki if ((sc->sc_props & AUDIO_PROP_INDEPENDENT) == 0) {
6571 1.2 isaki if (mode == AUMODE_RECORD) {
6572 1.2 isaki phwfmt = rhwfmt;
6573 1.2 isaki } else {
6574 1.2 isaki rhwfmt = phwfmt;
6575 1.2 isaki }
6576 1.2 isaki mode = AUMODE_PLAY | AUMODE_RECORD;
6577 1.2 isaki }
6578 1.2 isaki
6579 1.2 isaki /* Then, unset the direction not exist on the hardware. */
6580 1.14 isaki if ((sc->sc_props & AUDIO_PROP_PLAYBACK) == 0)
6581 1.2 isaki mode &= ~AUMODE_PLAY;
6582 1.14 isaki if ((sc->sc_props & AUDIO_PROP_CAPTURE) == 0)
6583 1.2 isaki mode &= ~AUMODE_RECORD;
6584 1.2 isaki
6585 1.2 isaki /* debug */
6586 1.2 isaki if ((mode & AUMODE_PLAY)) {
6587 1.2 isaki TRACE(1, "play=%s/%d/%d/%dch/%dHz",
6588 1.2 isaki audio_encoding_name(phwfmt.encoding),
6589 1.2 isaki phwfmt.precision,
6590 1.2 isaki phwfmt.stride,
6591 1.2 isaki phwfmt.channels,
6592 1.2 isaki phwfmt.sample_rate);
6593 1.2 isaki }
6594 1.2 isaki if ((mode & AUMODE_RECORD)) {
6595 1.2 isaki TRACE(1, "rec =%s/%d/%d/%dch/%dHz",
6596 1.2 isaki audio_encoding_name(rhwfmt.encoding),
6597 1.2 isaki rhwfmt.precision,
6598 1.2 isaki rhwfmt.stride,
6599 1.2 isaki rhwfmt.channels,
6600 1.2 isaki rhwfmt.sample_rate);
6601 1.2 isaki }
6602 1.2 isaki
6603 1.2 isaki /* Check the format */
6604 1.2 isaki if ((mode & AUMODE_PLAY)) {
6605 1.2 isaki if (audio_hw_validate_format(sc, AUMODE_PLAY, &phwfmt)) {
6606 1.2 isaki TRACE(1, "invalid format");
6607 1.2 isaki return EINVAL;
6608 1.2 isaki }
6609 1.2 isaki }
6610 1.2 isaki if ((mode & AUMODE_RECORD)) {
6611 1.2 isaki if (audio_hw_validate_format(sc, AUMODE_RECORD, &rhwfmt)) {
6612 1.2 isaki TRACE(1, "invalid format");
6613 1.2 isaki return EINVAL;
6614 1.2 isaki }
6615 1.2 isaki }
6616 1.2 isaki
6617 1.2 isaki /* Configure the mixers. */
6618 1.2 isaki memset(&pfil, 0, sizeof(pfil));
6619 1.2 isaki memset(&rfil, 0, sizeof(rfil));
6620 1.2 isaki error = audio_hw_set_format(sc, mode, &phwfmt, &rhwfmt, &pfil, &rfil);
6621 1.2 isaki if (error)
6622 1.2 isaki return error;
6623 1.2 isaki
6624 1.2 isaki error = audio_mixers_init(sc, mode, &phwfmt, &rhwfmt, &pfil, &rfil);
6625 1.2 isaki if (error)
6626 1.2 isaki return error;
6627 1.2 isaki
6628 1.28.2.10 martin /*
6629 1.28.2.10 martin * Reinitialize the sticky parameters for /dev/sound.
6630 1.28.2.10 martin * If the number of the hardware channels becomes less than the number
6631 1.28.2.10 martin * of channels that sticky parameters remember, subsequent /dev/sound
6632 1.28.2.10 martin * open will fail. To prevent this, reinitialize the sticky
6633 1.28.2.10 martin * parameters whenever the hardware format is changed.
6634 1.28.2.10 martin */
6635 1.28.2.10 martin sc->sc_sound_pparams = params_to_format2(&audio_default);
6636 1.28.2.10 martin sc->sc_sound_rparams = params_to_format2(&audio_default);
6637 1.28.2.10 martin sc->sc_sound_ppause = false;
6638 1.28.2.10 martin sc->sc_sound_rpause = false;
6639 1.28.2.10 martin
6640 1.2 isaki return 0;
6641 1.2 isaki }
6642 1.2 isaki
6643 1.2 isaki /*
6644 1.2 isaki * Store current mixers format into *ai.
6645 1.28.2.12 martin * Must be called with sc_exlock held.
6646 1.2 isaki */
6647 1.2 isaki static void
6648 1.2 isaki audio_mixers_get_format(struct audio_softc *sc, struct audio_info *ai)
6649 1.2 isaki {
6650 1.28.2.12 martin
6651 1.28.2.12 martin KASSERT(sc->sc_exlock);
6652 1.28.2.12 martin
6653 1.2 isaki /*
6654 1.2 isaki * There is no stride information in audio_info but it doesn't matter.
6655 1.2 isaki * trackmixer always treats stride and precision as the same.
6656 1.2 isaki */
6657 1.2 isaki AUDIO_INITINFO(ai);
6658 1.2 isaki ai->mode = 0;
6659 1.2 isaki if (sc->sc_pmixer) {
6660 1.2 isaki audio_format2_t *fmt = &sc->sc_pmixer->track_fmt;
6661 1.2 isaki ai->play.encoding = fmt->encoding;
6662 1.2 isaki ai->play.precision = fmt->precision;
6663 1.2 isaki ai->play.channels = fmt->channels;
6664 1.2 isaki ai->play.sample_rate = fmt->sample_rate;
6665 1.2 isaki ai->mode |= AUMODE_PLAY;
6666 1.2 isaki }
6667 1.2 isaki if (sc->sc_rmixer) {
6668 1.2 isaki audio_format2_t *fmt = &sc->sc_rmixer->track_fmt;
6669 1.2 isaki ai->record.encoding = fmt->encoding;
6670 1.2 isaki ai->record.precision = fmt->precision;
6671 1.2 isaki ai->record.channels = fmt->channels;
6672 1.2 isaki ai->record.sample_rate = fmt->sample_rate;
6673 1.2 isaki ai->mode |= AUMODE_RECORD;
6674 1.2 isaki }
6675 1.2 isaki }
6676 1.2 isaki
6677 1.2 isaki /*
6678 1.2 isaki * audio_info details:
6679 1.2 isaki *
6680 1.2 isaki * ai.{play,record}.sample_rate (R/W)
6681 1.2 isaki * ai.{play,record}.encoding (R/W)
6682 1.2 isaki * ai.{play,record}.precision (R/W)
6683 1.2 isaki * ai.{play,record}.channels (R/W)
6684 1.2 isaki * These specify the playback or recording format.
6685 1.2 isaki * Ignore members within an inactive track.
6686 1.2 isaki *
6687 1.2 isaki * ai.mode (R/W)
6688 1.2 isaki * It specifies the playback or recording mode, AUMODE_*.
6689 1.2 isaki * Currently, a mode change operation by ai.mode after opening is
6690 1.2 isaki * prohibited. In addition, AUMODE_PLAY_ALL no longer makes sense.
6691 1.2 isaki * However, it's possible to get or to set for backward compatibility.
6692 1.2 isaki *
6693 1.2 isaki * ai.{hiwat,lowat} (R/W)
6694 1.2 isaki * These specify the high water mark and low water mark for playback
6695 1.2 isaki * track. The unit is block.
6696 1.2 isaki *
6697 1.2 isaki * ai.{play,record}.gain (R/W)
6698 1.2 isaki * It specifies the HW mixer volume in 0-255.
6699 1.2 isaki * It is historical reason that the gain is connected to HW mixer.
6700 1.2 isaki *
6701 1.2 isaki * ai.{play,record}.balance (R/W)
6702 1.2 isaki * It specifies the left-right balance of HW mixer in 0-64.
6703 1.2 isaki * 32 means the center.
6704 1.2 isaki * It is historical reason that the balance is connected to HW mixer.
6705 1.2 isaki *
6706 1.2 isaki * ai.{play,record}.port (R/W)
6707 1.2 isaki * It specifies the input/output port of HW mixer.
6708 1.2 isaki *
6709 1.2 isaki * ai.monitor_gain (R/W)
6710 1.2 isaki * It specifies the recording monitor gain(?) of HW mixer.
6711 1.2 isaki *
6712 1.2 isaki * ai.{play,record}.pause (R/W)
6713 1.2 isaki * Non-zero means the track is paused.
6714 1.2 isaki *
6715 1.2 isaki * ai.play.seek (R/-)
6716 1.2 isaki * It indicates the number of bytes written but not processed.
6717 1.2 isaki * ai.record.seek (R/-)
6718 1.2 isaki * It indicates the number of bytes to be able to read.
6719 1.2 isaki *
6720 1.2 isaki * ai.{play,record}.avail_ports (R/-)
6721 1.2 isaki * Mixer info.
6722 1.2 isaki *
6723 1.2 isaki * ai.{play,record}.buffer_size (R/-)
6724 1.2 isaki * It indicates the buffer size in bytes. Internally it means usrbuf.
6725 1.2 isaki *
6726 1.2 isaki * ai.{play,record}.samples (R/-)
6727 1.2 isaki * It indicates the total number of bytes played or recorded.
6728 1.2 isaki *
6729 1.2 isaki * ai.{play,record}.eof (R/-)
6730 1.2 isaki * It indicates the number of times reached EOF(?).
6731 1.2 isaki *
6732 1.2 isaki * ai.{play,record}.error (R/-)
6733 1.2 isaki * Non-zero indicates overflow/underflow has occured.
6734 1.2 isaki *
6735 1.2 isaki * ai.{play,record}.waiting (R/-)
6736 1.2 isaki * Non-zero indicates that other process waits to open.
6737 1.2 isaki * It will never happen anymore.
6738 1.2 isaki *
6739 1.2 isaki * ai.{play,record}.open (R/-)
6740 1.2 isaki * Non-zero indicates the direction is opened by this process(?).
6741 1.2 isaki * XXX Is this better to indicate that "the device is opened by
6742 1.2 isaki * at least one process"?
6743 1.2 isaki *
6744 1.2 isaki * ai.{play,record}.active (R/-)
6745 1.2 isaki * Non-zero indicates that I/O is currently active.
6746 1.2 isaki *
6747 1.2 isaki * ai.blocksize (R/-)
6748 1.2 isaki * It indicates the block size in bytes.
6749 1.2 isaki * XXX The blocksize of playback and recording may be different.
6750 1.2 isaki */
6751 1.2 isaki
6752 1.2 isaki /*
6753 1.2 isaki * Pause consideration:
6754 1.2 isaki *
6755 1.28.2.13 martin * Pausing/unpausing never affect [pr]mixer. This single rule makes
6756 1.28.2.13 martin * operation simple. Note that playback and recording are asymmetric.
6757 1.28.2.13 martin *
6758 1.28.2.13 martin * For playback,
6759 1.28.2.13 martin * 1. Any playback open doesn't start pmixer regardless of initial pause
6760 1.28.2.13 martin * state of this track.
6761 1.28.2.13 martin * 2. The first write access among playback tracks only starts pmixer
6762 1.28.2.13 martin * regardless of this track's pause state.
6763 1.28.2.13 martin * 3. Even a pause of the last playback track doesn't stop pmixer.
6764 1.28.2.13 martin * 4. The last close of all playback tracks only stops pmixer.
6765 1.28.2.13 martin *
6766 1.28.2.13 martin * For recording,
6767 1.28.2.13 martin * 1. The first recording open only starts rmixer regardless of initial
6768 1.28.2.13 martin * pause state of this track.
6769 1.28.2.13 martin * 2. Even a pause of the last track doesn't stop rmixer.
6770 1.28.2.13 martin * 3. The last close of all recording tracks only stops rmixer.
6771 1.2 isaki */
6772 1.2 isaki
6773 1.2 isaki /*
6774 1.2 isaki * Set both track's parameters within a file depending on ai.
6775 1.2 isaki * Update sc_sound_[pr]* if set.
6776 1.28.2.12 martin * Must be called with sc_exlock held and without sc_lock held.
6777 1.2 isaki */
6778 1.2 isaki static int
6779 1.2 isaki audio_file_setinfo(struct audio_softc *sc, audio_file_t *file,
6780 1.2 isaki const struct audio_info *ai)
6781 1.2 isaki {
6782 1.2 isaki const struct audio_prinfo *pi;
6783 1.2 isaki const struct audio_prinfo *ri;
6784 1.2 isaki audio_track_t *ptrack;
6785 1.2 isaki audio_track_t *rtrack;
6786 1.2 isaki audio_format2_t pfmt;
6787 1.2 isaki audio_format2_t rfmt;
6788 1.2 isaki int pchanges;
6789 1.2 isaki int rchanges;
6790 1.2 isaki int mode;
6791 1.2 isaki struct audio_info saved_ai;
6792 1.2 isaki audio_format2_t saved_pfmt;
6793 1.2 isaki audio_format2_t saved_rfmt;
6794 1.2 isaki int error;
6795 1.2 isaki
6796 1.2 isaki KASSERT(sc->sc_exlock);
6797 1.2 isaki
6798 1.2 isaki pi = &ai->play;
6799 1.2 isaki ri = &ai->record;
6800 1.2 isaki pchanges = 0;
6801 1.2 isaki rchanges = 0;
6802 1.2 isaki
6803 1.2 isaki ptrack = file->ptrack;
6804 1.2 isaki rtrack = file->rtrack;
6805 1.2 isaki
6806 1.2 isaki #if defined(AUDIO_DEBUG)
6807 1.2 isaki if (audiodebug >= 2) {
6808 1.2 isaki char buf[256];
6809 1.2 isaki char p[64];
6810 1.2 isaki int buflen;
6811 1.2 isaki int plen;
6812 1.2 isaki #define SPRINTF(var, fmt...) do { \
6813 1.2 isaki var##len += snprintf(var + var##len, sizeof(var) - var##len, fmt); \
6814 1.2 isaki } while (0)
6815 1.2 isaki
6816 1.2 isaki buflen = 0;
6817 1.2 isaki plen = 0;
6818 1.2 isaki if (SPECIFIED(pi->encoding))
6819 1.2 isaki SPRINTF(p, "/%s", audio_encoding_name(pi->encoding));
6820 1.2 isaki if (SPECIFIED(pi->precision))
6821 1.2 isaki SPRINTF(p, "/%dbit", pi->precision);
6822 1.2 isaki if (SPECIFIED(pi->channels))
6823 1.2 isaki SPRINTF(p, "/%dch", pi->channels);
6824 1.2 isaki if (SPECIFIED(pi->sample_rate))
6825 1.2 isaki SPRINTF(p, "/%dHz", pi->sample_rate);
6826 1.2 isaki if (plen > 0)
6827 1.2 isaki SPRINTF(buf, ",play.param=%s", p + 1);
6828 1.2 isaki
6829 1.2 isaki plen = 0;
6830 1.2 isaki if (SPECIFIED(ri->encoding))
6831 1.2 isaki SPRINTF(p, "/%s", audio_encoding_name(ri->encoding));
6832 1.2 isaki if (SPECIFIED(ri->precision))
6833 1.2 isaki SPRINTF(p, "/%dbit", ri->precision);
6834 1.2 isaki if (SPECIFIED(ri->channels))
6835 1.2 isaki SPRINTF(p, "/%dch", ri->channels);
6836 1.2 isaki if (SPECIFIED(ri->sample_rate))
6837 1.2 isaki SPRINTF(p, "/%dHz", ri->sample_rate);
6838 1.2 isaki if (plen > 0)
6839 1.2 isaki SPRINTF(buf, ",record.param=%s", p + 1);
6840 1.2 isaki
6841 1.2 isaki if (SPECIFIED(ai->mode))
6842 1.2 isaki SPRINTF(buf, ",mode=%d", ai->mode);
6843 1.2 isaki if (SPECIFIED(ai->hiwat))
6844 1.2 isaki SPRINTF(buf, ",hiwat=%d", ai->hiwat);
6845 1.2 isaki if (SPECIFIED(ai->lowat))
6846 1.2 isaki SPRINTF(buf, ",lowat=%d", ai->lowat);
6847 1.2 isaki if (SPECIFIED(ai->play.gain))
6848 1.2 isaki SPRINTF(buf, ",play.gain=%d", ai->play.gain);
6849 1.2 isaki if (SPECIFIED(ai->record.gain))
6850 1.2 isaki SPRINTF(buf, ",record.gain=%d", ai->record.gain);
6851 1.2 isaki if (SPECIFIED_CH(ai->play.balance))
6852 1.2 isaki SPRINTF(buf, ",play.balance=%d", ai->play.balance);
6853 1.2 isaki if (SPECIFIED_CH(ai->record.balance))
6854 1.2 isaki SPRINTF(buf, ",record.balance=%d", ai->record.balance);
6855 1.2 isaki if (SPECIFIED(ai->play.port))
6856 1.2 isaki SPRINTF(buf, ",play.port=%d", ai->play.port);
6857 1.2 isaki if (SPECIFIED(ai->record.port))
6858 1.2 isaki SPRINTF(buf, ",record.port=%d", ai->record.port);
6859 1.2 isaki if (SPECIFIED(ai->monitor_gain))
6860 1.2 isaki SPRINTF(buf, ",monitor_gain=%d", ai->monitor_gain);
6861 1.2 isaki if (SPECIFIED_CH(ai->play.pause))
6862 1.2 isaki SPRINTF(buf, ",play.pause=%d", ai->play.pause);
6863 1.2 isaki if (SPECIFIED_CH(ai->record.pause))
6864 1.2 isaki SPRINTF(buf, ",record.pause=%d", ai->record.pause);
6865 1.2 isaki
6866 1.2 isaki if (buflen > 0)
6867 1.2 isaki TRACE(2, "specified %s", buf + 1);
6868 1.2 isaki }
6869 1.2 isaki #endif
6870 1.2 isaki
6871 1.2 isaki AUDIO_INITINFO(&saved_ai);
6872 1.2 isaki /* XXX shut up gcc */
6873 1.2 isaki memset(&saved_pfmt, 0, sizeof(saved_pfmt));
6874 1.2 isaki memset(&saved_rfmt, 0, sizeof(saved_rfmt));
6875 1.2 isaki
6876 1.28.2.11 martin /*
6877 1.28.2.11 martin * Set default value and save current parameters.
6878 1.28.2.11 martin * For backward compatibility, use sticky parameters for nonexistent
6879 1.28.2.11 martin * track.
6880 1.28.2.11 martin */
6881 1.2 isaki if (ptrack) {
6882 1.2 isaki pfmt = ptrack->usrbuf.fmt;
6883 1.2 isaki saved_pfmt = ptrack->usrbuf.fmt;
6884 1.2 isaki saved_ai.play.pause = ptrack->is_pause;
6885 1.28.2.11 martin } else {
6886 1.28.2.11 martin pfmt = sc->sc_sound_pparams;
6887 1.2 isaki }
6888 1.2 isaki if (rtrack) {
6889 1.2 isaki rfmt = rtrack->usrbuf.fmt;
6890 1.2 isaki saved_rfmt = rtrack->usrbuf.fmt;
6891 1.2 isaki saved_ai.record.pause = rtrack->is_pause;
6892 1.28.2.11 martin } else {
6893 1.28.2.11 martin rfmt = sc->sc_sound_rparams;
6894 1.2 isaki }
6895 1.2 isaki saved_ai.mode = file->mode;
6896 1.2 isaki
6897 1.28.2.11 martin /*
6898 1.28.2.11 martin * Overwrite if specified.
6899 1.28.2.11 martin */
6900 1.2 isaki mode = file->mode;
6901 1.2 isaki if (SPECIFIED(ai->mode)) {
6902 1.2 isaki /*
6903 1.2 isaki * Setting ai->mode no longer does anything because it's
6904 1.2 isaki * prohibited to change playback/recording mode after open
6905 1.2 isaki * and AUMODE_PLAY_ALL is obsoleted. However, it still
6906 1.2 isaki * keeps the state of AUMODE_PLAY_ALL itself for backward
6907 1.2 isaki * compatibility.
6908 1.2 isaki * In the internal, only file->mode has the state of
6909 1.2 isaki * AUMODE_PLAY_ALL flag and track->mode in both track does
6910 1.2 isaki * not have.
6911 1.2 isaki */
6912 1.2 isaki if ((file->mode & AUMODE_PLAY)) {
6913 1.2 isaki mode = (file->mode & (AUMODE_PLAY | AUMODE_RECORD))
6914 1.2 isaki | (ai->mode & AUMODE_PLAY_ALL);
6915 1.2 isaki }
6916 1.2 isaki }
6917 1.2 isaki
6918 1.28.2.11 martin pchanges = audio_track_setinfo_check(ptrack, &pfmt, pi);
6919 1.28.2.11 martin if (pchanges == -1) {
6920 1.8 isaki #if defined(AUDIO_DEBUG)
6921 1.28.2.11 martin TRACEF(1, file, "check play.params failed: "
6922 1.28.2.11 martin "%s %ubit %uch %uHz",
6923 1.28.2.11 martin audio_encoding_name(pi->encoding),
6924 1.28.2.11 martin pi->precision,
6925 1.28.2.11 martin pi->channels,
6926 1.28.2.11 martin pi->sample_rate);
6927 1.8 isaki #endif
6928 1.28.2.11 martin return EINVAL;
6929 1.2 isaki }
6930 1.28.2.11 martin
6931 1.28.2.11 martin rchanges = audio_track_setinfo_check(rtrack, &rfmt, ri);
6932 1.28.2.11 martin if (rchanges == -1) {
6933 1.8 isaki #if defined(AUDIO_DEBUG)
6934 1.28.2.11 martin TRACEF(1, file, "check record.params failed: "
6935 1.28.2.11 martin "%s %ubit %uch %uHz",
6936 1.28.2.11 martin audio_encoding_name(ri->encoding),
6937 1.28.2.11 martin ri->precision,
6938 1.28.2.11 martin ri->channels,
6939 1.28.2.11 martin ri->sample_rate);
6940 1.8 isaki #endif
6941 1.28.2.11 martin return EINVAL;
6942 1.28.2.11 martin }
6943 1.28.2.11 martin
6944 1.28.2.11 martin if (SPECIFIED(ai->mode)) {
6945 1.28.2.11 martin pchanges = 1;
6946 1.28.2.11 martin rchanges = 1;
6947 1.2 isaki }
6948 1.2 isaki
6949 1.2 isaki /*
6950 1.2 isaki * Even when setting either one of playback and recording,
6951 1.2 isaki * both track must be halted.
6952 1.2 isaki */
6953 1.2 isaki if (pchanges || rchanges) {
6954 1.2 isaki audio_file_clear(sc, file);
6955 1.2 isaki #if defined(AUDIO_DEBUG)
6956 1.28.2.11 martin char nbuf[16];
6957 1.2 isaki char fmtbuf[64];
6958 1.2 isaki if (pchanges) {
6959 1.28.2.11 martin if (ptrack) {
6960 1.28.2.11 martin snprintf(nbuf, sizeof(nbuf), "%d", ptrack->id);
6961 1.28.2.11 martin } else {
6962 1.28.2.11 martin snprintf(nbuf, sizeof(nbuf), "-");
6963 1.28.2.11 martin }
6964 1.2 isaki audio_format2_tostr(fmtbuf, sizeof(fmtbuf), &pfmt);
6965 1.28.2.11 martin DPRINTF(1, "audio track#%s play mode: %s\n",
6966 1.28.2.11 martin nbuf, fmtbuf);
6967 1.2 isaki }
6968 1.2 isaki if (rchanges) {
6969 1.28.2.11 martin if (rtrack) {
6970 1.28.2.11 martin snprintf(nbuf, sizeof(nbuf), "%d", rtrack->id);
6971 1.28.2.11 martin } else {
6972 1.28.2.11 martin snprintf(nbuf, sizeof(nbuf), "-");
6973 1.28.2.11 martin }
6974 1.2 isaki audio_format2_tostr(fmtbuf, sizeof(fmtbuf), &rfmt);
6975 1.28.2.11 martin DPRINTF(1, "audio track#%s rec mode: %s\n",
6976 1.28.2.11 martin nbuf, fmtbuf);
6977 1.2 isaki }
6978 1.2 isaki #endif
6979 1.2 isaki }
6980 1.2 isaki
6981 1.2 isaki /* Set mixer parameters */
6982 1.28.2.12 martin mutex_enter(sc->sc_lock);
6983 1.2 isaki error = audio_hw_setinfo(sc, ai, &saved_ai);
6984 1.28.2.12 martin mutex_exit(sc->sc_lock);
6985 1.2 isaki if (error)
6986 1.2 isaki goto abort1;
6987 1.2 isaki
6988 1.28.2.11 martin /*
6989 1.28.2.11 martin * Set to track and update sticky parameters.
6990 1.28.2.11 martin */
6991 1.2 isaki error = 0;
6992 1.2 isaki file->mode = mode;
6993 1.28.2.11 martin
6994 1.28.2.11 martin if (SPECIFIED_CH(pi->pause)) {
6995 1.28.2.11 martin if (ptrack)
6996 1.2 isaki ptrack->is_pause = pi->pause;
6997 1.28.2.11 martin sc->sc_sound_ppause = pi->pause;
6998 1.28.2.11 martin }
6999 1.28.2.11 martin if (pchanges) {
7000 1.28.2.11 martin if (ptrack) {
7001 1.2 isaki audio_track_lock_enter(ptrack);
7002 1.2 isaki error = audio_track_set_format(ptrack, &pfmt);
7003 1.2 isaki audio_track_lock_exit(ptrack);
7004 1.2 isaki if (error) {
7005 1.2 isaki TRACET(1, ptrack, "set play.params failed");
7006 1.2 isaki goto abort2;
7007 1.2 isaki }
7008 1.2 isaki }
7009 1.28.2.11 martin sc->sc_sound_pparams = pfmt;
7010 1.28.2.11 martin }
7011 1.28.2.11 martin /* Change water marks after initializing the buffers. */
7012 1.28.2.11 martin if (SPECIFIED(ai->hiwat) || SPECIFIED(ai->lowat)) {
7013 1.28.2.11 martin if (ptrack)
7014 1.2 isaki audio_track_setinfo_water(ptrack, ai);
7015 1.2 isaki }
7016 1.28.2.11 martin
7017 1.28.2.11 martin if (SPECIFIED_CH(ri->pause)) {
7018 1.28.2.11 martin if (rtrack)
7019 1.2 isaki rtrack->is_pause = ri->pause;
7020 1.28.2.11 martin sc->sc_sound_rpause = ri->pause;
7021 1.28.2.11 martin }
7022 1.28.2.11 martin if (rchanges) {
7023 1.28.2.11 martin if (rtrack) {
7024 1.2 isaki audio_track_lock_enter(rtrack);
7025 1.2 isaki error = audio_track_set_format(rtrack, &rfmt);
7026 1.2 isaki audio_track_lock_exit(rtrack);
7027 1.2 isaki if (error) {
7028 1.2 isaki TRACET(1, rtrack, "set record.params failed");
7029 1.2 isaki goto abort3;
7030 1.2 isaki }
7031 1.2 isaki }
7032 1.28.2.11 martin sc->sc_sound_rparams = rfmt;
7033 1.2 isaki }
7034 1.2 isaki
7035 1.2 isaki return 0;
7036 1.2 isaki
7037 1.2 isaki /* Rollback */
7038 1.2 isaki abort3:
7039 1.2 isaki if (error != ENOMEM) {
7040 1.2 isaki rtrack->is_pause = saved_ai.record.pause;
7041 1.2 isaki audio_track_lock_enter(rtrack);
7042 1.2 isaki audio_track_set_format(rtrack, &saved_rfmt);
7043 1.2 isaki audio_track_lock_exit(rtrack);
7044 1.2 isaki }
7045 1.28.2.11 martin sc->sc_sound_rpause = saved_ai.record.pause;
7046 1.28.2.11 martin sc->sc_sound_rparams = saved_rfmt;
7047 1.2 isaki abort2:
7048 1.2 isaki if (ptrack && error != ENOMEM) {
7049 1.2 isaki ptrack->is_pause = saved_ai.play.pause;
7050 1.2 isaki audio_track_lock_enter(ptrack);
7051 1.2 isaki audio_track_set_format(ptrack, &saved_pfmt);
7052 1.2 isaki audio_track_lock_exit(ptrack);
7053 1.2 isaki }
7054 1.28.2.11 martin sc->sc_sound_ppause = saved_ai.play.pause;
7055 1.28.2.11 martin sc->sc_sound_pparams = saved_pfmt;
7056 1.2 isaki file->mode = saved_ai.mode;
7057 1.2 isaki abort1:
7058 1.28.2.12 martin mutex_enter(sc->sc_lock);
7059 1.2 isaki audio_hw_setinfo(sc, &saved_ai, NULL);
7060 1.28.2.12 martin mutex_exit(sc->sc_lock);
7061 1.2 isaki
7062 1.2 isaki return error;
7063 1.2 isaki }
7064 1.2 isaki
7065 1.2 isaki /*
7066 1.2 isaki * Write SPECIFIED() parameters within info back to fmt.
7067 1.28.2.11 martin * Note that track can be NULL here.
7068 1.2 isaki * Return value of 1 indicates that fmt is modified.
7069 1.2 isaki * Return value of 0 indicates that fmt is not modified.
7070 1.2 isaki * Return value of -1 indicates that error EINVAL has occurred.
7071 1.2 isaki */
7072 1.2 isaki static int
7073 1.28.2.11 martin audio_track_setinfo_check(audio_track_t *track,
7074 1.28.2.11 martin audio_format2_t *fmt, const struct audio_prinfo *info)
7075 1.2 isaki {
7076 1.28.2.11 martin const audio_format2_t *hwfmt;
7077 1.2 isaki int changes;
7078 1.2 isaki
7079 1.2 isaki changes = 0;
7080 1.2 isaki if (SPECIFIED(info->sample_rate)) {
7081 1.2 isaki if (info->sample_rate < AUDIO_MIN_FREQUENCY)
7082 1.2 isaki return -1;
7083 1.2 isaki if (info->sample_rate > AUDIO_MAX_FREQUENCY)
7084 1.2 isaki return -1;
7085 1.2 isaki fmt->sample_rate = info->sample_rate;
7086 1.2 isaki changes = 1;
7087 1.2 isaki }
7088 1.2 isaki if (SPECIFIED(info->encoding)) {
7089 1.2 isaki fmt->encoding = info->encoding;
7090 1.2 isaki changes = 1;
7091 1.2 isaki }
7092 1.2 isaki if (SPECIFIED(info->precision)) {
7093 1.2 isaki fmt->precision = info->precision;
7094 1.2 isaki /* we don't have API to specify stride */
7095 1.2 isaki fmt->stride = info->precision;
7096 1.2 isaki changes = 1;
7097 1.2 isaki }
7098 1.2 isaki if (SPECIFIED(info->channels)) {
7099 1.28.2.10 martin /*
7100 1.28.2.10 martin * We can convert between monaural and stereo each other.
7101 1.28.2.10 martin * We can reduce than the number of channels that the hardware
7102 1.28.2.10 martin * supports.
7103 1.28.2.10 martin */
7104 1.28.2.11 martin if (info->channels > 2) {
7105 1.28.2.11 martin if (track) {
7106 1.28.2.11 martin hwfmt = &track->mixer->hwbuf.fmt;
7107 1.28.2.11 martin if (info->channels > hwfmt->channels)
7108 1.28.2.11 martin return -1;
7109 1.28.2.11 martin } else {
7110 1.28.2.11 martin /*
7111 1.28.2.11 martin * This should never happen.
7112 1.28.2.11 martin * If track == NULL, channels should be <= 2.
7113 1.28.2.11 martin */
7114 1.28.2.11 martin return -1;
7115 1.28.2.11 martin }
7116 1.28.2.11 martin }
7117 1.2 isaki fmt->channels = info->channels;
7118 1.2 isaki changes = 1;
7119 1.2 isaki }
7120 1.2 isaki
7121 1.2 isaki if (changes) {
7122 1.8 isaki if (audio_check_params(fmt) != 0)
7123 1.2 isaki return -1;
7124 1.2 isaki }
7125 1.2 isaki
7126 1.2 isaki return changes;
7127 1.2 isaki }
7128 1.2 isaki
7129 1.2 isaki /*
7130 1.2 isaki * Change water marks for playback track if specfied.
7131 1.2 isaki */
7132 1.2 isaki static void
7133 1.2 isaki audio_track_setinfo_water(audio_track_t *track, const struct audio_info *ai)
7134 1.2 isaki {
7135 1.2 isaki u_int blks;
7136 1.2 isaki u_int maxblks;
7137 1.2 isaki u_int blksize;
7138 1.2 isaki
7139 1.2 isaki KASSERT(audio_track_is_playback(track));
7140 1.2 isaki
7141 1.2 isaki blksize = track->usrbuf_blksize;
7142 1.2 isaki maxblks = track->usrbuf.capacity / blksize;
7143 1.2 isaki
7144 1.2 isaki if (SPECIFIED(ai->hiwat)) {
7145 1.2 isaki blks = ai->hiwat;
7146 1.2 isaki if (blks > maxblks)
7147 1.2 isaki blks = maxblks;
7148 1.2 isaki if (blks < 2)
7149 1.2 isaki blks = 2;
7150 1.2 isaki track->usrbuf_usedhigh = blks * blksize;
7151 1.2 isaki }
7152 1.2 isaki if (SPECIFIED(ai->lowat)) {
7153 1.2 isaki blks = ai->lowat;
7154 1.2 isaki if (blks > maxblks - 1)
7155 1.2 isaki blks = maxblks - 1;
7156 1.2 isaki track->usrbuf_usedlow = blks * blksize;
7157 1.2 isaki }
7158 1.2 isaki if (SPECIFIED(ai->hiwat) || SPECIFIED(ai->lowat)) {
7159 1.2 isaki if (track->usrbuf_usedlow > track->usrbuf_usedhigh - blksize) {
7160 1.2 isaki track->usrbuf_usedlow = track->usrbuf_usedhigh -
7161 1.2 isaki blksize;
7162 1.2 isaki }
7163 1.2 isaki }
7164 1.2 isaki }
7165 1.2 isaki
7166 1.2 isaki /*
7167 1.2 isaki * Set hardware part of *ai.
7168 1.2 isaki * The parameters handled here are *.port, *.gain, *.balance and monitor_gain.
7169 1.2 isaki * If oldai is specified, previous parameters are stored.
7170 1.2 isaki * This function itself does not roll back if error occurred.
7171 1.28.2.12 martin * Must be called with sc_lock && sc_exlock held.
7172 1.2 isaki */
7173 1.2 isaki static int
7174 1.2 isaki audio_hw_setinfo(struct audio_softc *sc, const struct audio_info *newai,
7175 1.2 isaki struct audio_info *oldai)
7176 1.2 isaki {
7177 1.2 isaki const struct audio_prinfo *newpi;
7178 1.2 isaki const struct audio_prinfo *newri;
7179 1.2 isaki struct audio_prinfo *oldpi;
7180 1.2 isaki struct audio_prinfo *oldri;
7181 1.2 isaki u_int pgain;
7182 1.2 isaki u_int rgain;
7183 1.2 isaki u_char pbalance;
7184 1.2 isaki u_char rbalance;
7185 1.2 isaki int error;
7186 1.2 isaki
7187 1.2 isaki KASSERT(mutex_owned(sc->sc_lock));
7188 1.2 isaki KASSERT(sc->sc_exlock);
7189 1.2 isaki
7190 1.2 isaki /* XXX shut up gcc */
7191 1.2 isaki oldpi = NULL;
7192 1.2 isaki oldri = NULL;
7193 1.2 isaki
7194 1.2 isaki newpi = &newai->play;
7195 1.2 isaki newri = &newai->record;
7196 1.2 isaki if (oldai) {
7197 1.2 isaki oldpi = &oldai->play;
7198 1.2 isaki oldri = &oldai->record;
7199 1.2 isaki }
7200 1.2 isaki error = 0;
7201 1.2 isaki
7202 1.2 isaki /*
7203 1.2 isaki * It looks like unnecessary to halt HW mixers to set HW mixers.
7204 1.2 isaki * mixer_ioctl(MIXER_WRITE) also doesn't halt.
7205 1.2 isaki */
7206 1.2 isaki
7207 1.2 isaki if (SPECIFIED(newpi->port)) {
7208 1.2 isaki if (oldai)
7209 1.2 isaki oldpi->port = au_get_port(sc, &sc->sc_outports);
7210 1.2 isaki error = au_set_port(sc, &sc->sc_outports, newpi->port);
7211 1.2 isaki if (error) {
7212 1.2 isaki device_printf(sc->sc_dev,
7213 1.2 isaki "setting play.port=%d failed with %d\n",
7214 1.2 isaki newpi->port, error);
7215 1.2 isaki goto abort;
7216 1.2 isaki }
7217 1.2 isaki }
7218 1.2 isaki if (SPECIFIED(newri->port)) {
7219 1.2 isaki if (oldai)
7220 1.2 isaki oldri->port = au_get_port(sc, &sc->sc_inports);
7221 1.2 isaki error = au_set_port(sc, &sc->sc_inports, newri->port);
7222 1.2 isaki if (error) {
7223 1.2 isaki device_printf(sc->sc_dev,
7224 1.2 isaki "setting record.port=%d failed with %d\n",
7225 1.2 isaki newri->port, error);
7226 1.2 isaki goto abort;
7227 1.2 isaki }
7228 1.2 isaki }
7229 1.2 isaki
7230 1.2 isaki /* Backup play.{gain,balance} */
7231 1.2 isaki if (SPECIFIED(newpi->gain) || SPECIFIED_CH(newpi->balance)) {
7232 1.2 isaki au_get_gain(sc, &sc->sc_outports, &pgain, &pbalance);
7233 1.2 isaki if (oldai) {
7234 1.2 isaki oldpi->gain = pgain;
7235 1.2 isaki oldpi->balance = pbalance;
7236 1.2 isaki }
7237 1.2 isaki }
7238 1.2 isaki /* Backup record.{gain,balance} */
7239 1.2 isaki if (SPECIFIED(newri->gain) || SPECIFIED_CH(newri->balance)) {
7240 1.2 isaki au_get_gain(sc, &sc->sc_inports, &rgain, &rbalance);
7241 1.2 isaki if (oldai) {
7242 1.2 isaki oldri->gain = rgain;
7243 1.2 isaki oldri->balance = rbalance;
7244 1.2 isaki }
7245 1.2 isaki }
7246 1.2 isaki if (SPECIFIED(newpi->gain)) {
7247 1.2 isaki error = au_set_gain(sc, &sc->sc_outports,
7248 1.2 isaki newpi->gain, pbalance);
7249 1.2 isaki if (error) {
7250 1.2 isaki device_printf(sc->sc_dev,
7251 1.2 isaki "setting play.gain=%d failed with %d\n",
7252 1.2 isaki newpi->gain, error);
7253 1.2 isaki goto abort;
7254 1.2 isaki }
7255 1.2 isaki }
7256 1.2 isaki if (SPECIFIED(newri->gain)) {
7257 1.2 isaki error = au_set_gain(sc, &sc->sc_inports,
7258 1.2 isaki newri->gain, rbalance);
7259 1.2 isaki if (error) {
7260 1.2 isaki device_printf(sc->sc_dev,
7261 1.2 isaki "setting record.gain=%d failed with %d\n",
7262 1.2 isaki newri->gain, error);
7263 1.2 isaki goto abort;
7264 1.2 isaki }
7265 1.2 isaki }
7266 1.2 isaki if (SPECIFIED_CH(newpi->balance)) {
7267 1.2 isaki error = au_set_gain(sc, &sc->sc_outports,
7268 1.2 isaki pgain, newpi->balance);
7269 1.2 isaki if (error) {
7270 1.2 isaki device_printf(sc->sc_dev,
7271 1.2 isaki "setting play.balance=%d failed with %d\n",
7272 1.2 isaki newpi->balance, error);
7273 1.2 isaki goto abort;
7274 1.2 isaki }
7275 1.2 isaki }
7276 1.2 isaki if (SPECIFIED_CH(newri->balance)) {
7277 1.2 isaki error = au_set_gain(sc, &sc->sc_inports,
7278 1.2 isaki rgain, newri->balance);
7279 1.2 isaki if (error) {
7280 1.2 isaki device_printf(sc->sc_dev,
7281 1.2 isaki "setting record.balance=%d failed with %d\n",
7282 1.2 isaki newri->balance, error);
7283 1.2 isaki goto abort;
7284 1.2 isaki }
7285 1.2 isaki }
7286 1.2 isaki
7287 1.2 isaki if (SPECIFIED(newai->monitor_gain) && sc->sc_monitor_port != -1) {
7288 1.2 isaki if (oldai)
7289 1.2 isaki oldai->monitor_gain = au_get_monitor_gain(sc);
7290 1.2 isaki error = au_set_monitor_gain(sc, newai->monitor_gain);
7291 1.2 isaki if (error) {
7292 1.2 isaki device_printf(sc->sc_dev,
7293 1.2 isaki "setting monitor_gain=%d failed with %d\n",
7294 1.2 isaki newai->monitor_gain, error);
7295 1.2 isaki goto abort;
7296 1.2 isaki }
7297 1.2 isaki }
7298 1.2 isaki
7299 1.2 isaki /* XXX TODO */
7300 1.2 isaki /* sc->sc_ai = *ai; */
7301 1.2 isaki
7302 1.2 isaki error = 0;
7303 1.2 isaki abort:
7304 1.2 isaki return error;
7305 1.2 isaki }
7306 1.2 isaki
7307 1.2 isaki /*
7308 1.2 isaki * Setup the hardware with mixer format phwfmt, rhwfmt.
7309 1.2 isaki * The arguments have following restrictions:
7310 1.2 isaki * - setmode is the direction you want to set, AUMODE_PLAY or AUMODE_RECORD,
7311 1.2 isaki * or both.
7312 1.2 isaki * - phwfmt and rhwfmt must not be NULL regardless of setmode.
7313 1.2 isaki * - On non-independent devices, phwfmt and rhwfmt must have the same
7314 1.2 isaki * parameters.
7315 1.2 isaki * - pfil and rfil must be zero-filled.
7316 1.2 isaki * If successful,
7317 1.2 isaki * - phwfmt, rhwfmt will be overwritten by hardware format.
7318 1.2 isaki * - pfil, rfil will be filled with filter information specified by the
7319 1.2 isaki * hardware driver.
7320 1.2 isaki * and then returns 0. Otherwise returns errno.
7321 1.28.2.12 martin * Must be called without sc_lock held.
7322 1.2 isaki */
7323 1.2 isaki static int
7324 1.2 isaki audio_hw_set_format(struct audio_softc *sc, int setmode,
7325 1.2 isaki audio_format2_t *phwfmt, audio_format2_t *rhwfmt,
7326 1.2 isaki audio_filter_reg_t *pfil, audio_filter_reg_t *rfil)
7327 1.2 isaki {
7328 1.2 isaki audio_params_t pp, rp;
7329 1.2 isaki int error;
7330 1.2 isaki
7331 1.2 isaki KASSERT(phwfmt != NULL);
7332 1.2 isaki KASSERT(rhwfmt != NULL);
7333 1.2 isaki
7334 1.2 isaki pp = format2_to_params(phwfmt);
7335 1.2 isaki rp = format2_to_params(rhwfmt);
7336 1.2 isaki
7337 1.28.2.12 martin mutex_enter(sc->sc_lock);
7338 1.2 isaki error = sc->hw_if->set_format(sc->hw_hdl, setmode,
7339 1.2 isaki &pp, &rp, pfil, rfil);
7340 1.2 isaki if (error) {
7341 1.28.2.12 martin mutex_exit(sc->sc_lock);
7342 1.2 isaki device_printf(sc->sc_dev,
7343 1.2 isaki "set_format failed with %d\n", error);
7344 1.2 isaki return error;
7345 1.2 isaki }
7346 1.2 isaki
7347 1.2 isaki if (sc->hw_if->commit_settings) {
7348 1.2 isaki error = sc->hw_if->commit_settings(sc->hw_hdl);
7349 1.2 isaki if (error) {
7350 1.28.2.12 martin mutex_exit(sc->sc_lock);
7351 1.2 isaki device_printf(sc->sc_dev,
7352 1.2 isaki "commit_settings failed with %d\n", error);
7353 1.2 isaki return error;
7354 1.2 isaki }
7355 1.2 isaki }
7356 1.28.2.12 martin mutex_exit(sc->sc_lock);
7357 1.2 isaki
7358 1.2 isaki return 0;
7359 1.2 isaki }
7360 1.2 isaki
7361 1.2 isaki /*
7362 1.2 isaki * Fill audio_info structure. If need_mixerinfo is true, it will also
7363 1.2 isaki * fill the hardware mixer information.
7364 1.28.2.12 martin * Must be called with sc_exlock held and without sc_lock held.
7365 1.2 isaki */
7366 1.2 isaki static int
7367 1.2 isaki audiogetinfo(struct audio_softc *sc, struct audio_info *ai, int need_mixerinfo,
7368 1.2 isaki audio_file_t *file)
7369 1.2 isaki {
7370 1.2 isaki struct audio_prinfo *ri, *pi;
7371 1.2 isaki audio_track_t *track;
7372 1.2 isaki audio_track_t *ptrack;
7373 1.2 isaki audio_track_t *rtrack;
7374 1.2 isaki int gain;
7375 1.2 isaki
7376 1.28.2.12 martin KASSERT(sc->sc_exlock);
7377 1.2 isaki
7378 1.2 isaki ri = &ai->record;
7379 1.2 isaki pi = &ai->play;
7380 1.2 isaki ptrack = file->ptrack;
7381 1.2 isaki rtrack = file->rtrack;
7382 1.2 isaki
7383 1.2 isaki memset(ai, 0, sizeof(*ai));
7384 1.2 isaki
7385 1.2 isaki if (ptrack) {
7386 1.2 isaki pi->sample_rate = ptrack->usrbuf.fmt.sample_rate;
7387 1.2 isaki pi->channels = ptrack->usrbuf.fmt.channels;
7388 1.2 isaki pi->precision = ptrack->usrbuf.fmt.precision;
7389 1.2 isaki pi->encoding = ptrack->usrbuf.fmt.encoding;
7390 1.28.2.11 martin pi->pause = ptrack->is_pause;
7391 1.2 isaki } else {
7392 1.28.2.11 martin /* Use sticky parameters if the track is not available. */
7393 1.28.2.11 martin pi->sample_rate = sc->sc_sound_pparams.sample_rate;
7394 1.28.2.11 martin pi->channels = sc->sc_sound_pparams.channels;
7395 1.28.2.11 martin pi->precision = sc->sc_sound_pparams.precision;
7396 1.28.2.11 martin pi->encoding = sc->sc_sound_pparams.encoding;
7397 1.28.2.11 martin pi->pause = sc->sc_sound_ppause;
7398 1.2 isaki }
7399 1.2 isaki if (rtrack) {
7400 1.2 isaki ri->sample_rate = rtrack->usrbuf.fmt.sample_rate;
7401 1.2 isaki ri->channels = rtrack->usrbuf.fmt.channels;
7402 1.2 isaki ri->precision = rtrack->usrbuf.fmt.precision;
7403 1.2 isaki ri->encoding = rtrack->usrbuf.fmt.encoding;
7404 1.28.2.11 martin ri->pause = rtrack->is_pause;
7405 1.2 isaki } else {
7406 1.28.2.11 martin /* Use sticky parameters if the track is not available. */
7407 1.28.2.11 martin ri->sample_rate = sc->sc_sound_rparams.sample_rate;
7408 1.28.2.11 martin ri->channels = sc->sc_sound_rparams.channels;
7409 1.28.2.11 martin ri->precision = sc->sc_sound_rparams.precision;
7410 1.28.2.11 martin ri->encoding = sc->sc_sound_rparams.encoding;
7411 1.28.2.11 martin ri->pause = sc->sc_sound_rpause;
7412 1.2 isaki }
7413 1.2 isaki
7414 1.2 isaki if (ptrack) {
7415 1.2 isaki pi->seek = ptrack->usrbuf.used;
7416 1.2 isaki pi->samples = ptrack->usrbuf_stamp;
7417 1.2 isaki pi->eof = ptrack->eofcounter;
7418 1.2 isaki pi->error = (ptrack->dropframes != 0) ? 1 : 0;
7419 1.2 isaki pi->open = 1;
7420 1.2 isaki pi->buffer_size = ptrack->usrbuf.capacity;
7421 1.2 isaki }
7422 1.28.2.11 martin pi->waiting = 0; /* open never hangs */
7423 1.28.2.11 martin pi->active = sc->sc_pbusy;
7424 1.28.2.11 martin
7425 1.2 isaki if (rtrack) {
7426 1.2 isaki ri->seek = rtrack->usrbuf.used;
7427 1.2 isaki ri->samples = rtrack->usrbuf_stamp;
7428 1.2 isaki ri->eof = 0;
7429 1.2 isaki ri->error = (rtrack->dropframes != 0) ? 1 : 0;
7430 1.2 isaki ri->open = 1;
7431 1.2 isaki ri->buffer_size = rtrack->usrbuf.capacity;
7432 1.2 isaki }
7433 1.28.2.11 martin ri->waiting = 0; /* open never hangs */
7434 1.28.2.11 martin ri->active = sc->sc_rbusy;
7435 1.2 isaki
7436 1.2 isaki /*
7437 1.2 isaki * XXX There may be different number of channels between playback
7438 1.2 isaki * and recording, so that blocksize also may be different.
7439 1.2 isaki * But struct audio_info has an united blocksize...
7440 1.2 isaki * Here, I use play info precedencely if ptrack is available,
7441 1.2 isaki * otherwise record info.
7442 1.2 isaki *
7443 1.2 isaki * XXX hiwat/lowat is a playback-only parameter. What should I
7444 1.2 isaki * return for a record-only descriptor?
7445 1.2 isaki */
7446 1.3 maya track = ptrack ? ptrack : rtrack;
7447 1.2 isaki if (track) {
7448 1.2 isaki ai->blocksize = track->usrbuf_blksize;
7449 1.2 isaki ai->hiwat = track->usrbuf_usedhigh / track->usrbuf_blksize;
7450 1.2 isaki ai->lowat = track->usrbuf_usedlow / track->usrbuf_blksize;
7451 1.2 isaki }
7452 1.2 isaki ai->mode = file->mode;
7453 1.2 isaki
7454 1.28.2.11 martin /*
7455 1.28.2.11 martin * For backward compatibility, we have to pad these five fields
7456 1.28.2.11 martin * a fake non-zero value even if there are no tracks.
7457 1.28.2.11 martin */
7458 1.28.2.11 martin if (ptrack == NULL)
7459 1.28.2.11 martin pi->buffer_size = 65536;
7460 1.28.2.11 martin if (rtrack == NULL)
7461 1.28.2.11 martin ri->buffer_size = 65536;
7462 1.28.2.11 martin if (ptrack == NULL && rtrack == NULL) {
7463 1.28.2.11 martin ai->blocksize = 2048;
7464 1.28.2.11 martin ai->hiwat = ai->play.buffer_size / ai->blocksize;
7465 1.28.2.11 martin ai->lowat = ai->hiwat * 3 / 4;
7466 1.28.2.11 martin }
7467 1.28.2.11 martin
7468 1.2 isaki if (need_mixerinfo) {
7469 1.28.2.12 martin mutex_enter(sc->sc_lock);
7470 1.2 isaki
7471 1.2 isaki pi->port = au_get_port(sc, &sc->sc_outports);
7472 1.2 isaki ri->port = au_get_port(sc, &sc->sc_inports);
7473 1.2 isaki
7474 1.2 isaki pi->avail_ports = sc->sc_outports.allports;
7475 1.2 isaki ri->avail_ports = sc->sc_inports.allports;
7476 1.2 isaki
7477 1.2 isaki au_get_gain(sc, &sc->sc_outports, &pi->gain, &pi->balance);
7478 1.2 isaki au_get_gain(sc, &sc->sc_inports, &ri->gain, &ri->balance);
7479 1.2 isaki
7480 1.2 isaki if (sc->sc_monitor_port != -1) {
7481 1.2 isaki gain = au_get_monitor_gain(sc);
7482 1.2 isaki if (gain != -1)
7483 1.2 isaki ai->monitor_gain = gain;
7484 1.2 isaki }
7485 1.28.2.12 martin mutex_exit(sc->sc_lock);
7486 1.2 isaki }
7487 1.2 isaki
7488 1.2 isaki return 0;
7489 1.2 isaki }
7490 1.2 isaki
7491 1.2 isaki /*
7492 1.2 isaki * Return true if playback is configured.
7493 1.2 isaki * This function can be used after audioattach.
7494 1.2 isaki */
7495 1.2 isaki static bool
7496 1.2 isaki audio_can_playback(struct audio_softc *sc)
7497 1.2 isaki {
7498 1.2 isaki
7499 1.2 isaki return (sc->sc_pmixer != NULL);
7500 1.2 isaki }
7501 1.2 isaki
7502 1.2 isaki /*
7503 1.2 isaki * Return true if recording is configured.
7504 1.2 isaki * This function can be used after audioattach.
7505 1.2 isaki */
7506 1.2 isaki static bool
7507 1.2 isaki audio_can_capture(struct audio_softc *sc)
7508 1.2 isaki {
7509 1.2 isaki
7510 1.2 isaki return (sc->sc_rmixer != NULL);
7511 1.2 isaki }
7512 1.2 isaki
7513 1.2 isaki /*
7514 1.2 isaki * Get the afp->index'th item from the valid one of format[].
7515 1.2 isaki * If found, stores it to afp->fmt and returns 0. Otherwise return EINVAL.
7516 1.2 isaki *
7517 1.2 isaki * This is common routines for query_format.
7518 1.2 isaki * If your hardware driver has struct audio_format[], the simplest case
7519 1.2 isaki * you can write your query_format interface as follows:
7520 1.2 isaki *
7521 1.2 isaki * struct audio_format foo_format[] = { ... };
7522 1.2 isaki *
7523 1.2 isaki * int
7524 1.2 isaki * foo_query_format(void *hdl, audio_format_query_t *afp)
7525 1.2 isaki * {
7526 1.2 isaki * return audio_query_format(foo_format, __arraycount(foo_format), afp);
7527 1.2 isaki * }
7528 1.2 isaki */
7529 1.2 isaki int
7530 1.2 isaki audio_query_format(const struct audio_format *format, int nformats,
7531 1.2 isaki audio_format_query_t *afp)
7532 1.2 isaki {
7533 1.2 isaki const struct audio_format *f;
7534 1.2 isaki int idx;
7535 1.2 isaki int i;
7536 1.2 isaki
7537 1.2 isaki idx = 0;
7538 1.2 isaki for (i = 0; i < nformats; i++) {
7539 1.2 isaki f = &format[i];
7540 1.2 isaki if (!AUFMT_IS_VALID(f))
7541 1.2 isaki continue;
7542 1.2 isaki if (afp->index == idx) {
7543 1.2 isaki afp->fmt = *f;
7544 1.2 isaki return 0;
7545 1.2 isaki }
7546 1.2 isaki idx++;
7547 1.2 isaki }
7548 1.2 isaki return EINVAL;
7549 1.2 isaki }
7550 1.2 isaki
7551 1.2 isaki /*
7552 1.2 isaki * This function is provided for the hardware driver's set_format() to
7553 1.2 isaki * find index matches with 'param' from array of audio_format_t 'formats'.
7554 1.2 isaki * 'mode' is either of AUMODE_PLAY or AUMODE_RECORD.
7555 1.2 isaki * It returns the matched index and never fails. Because param passed to
7556 1.2 isaki * set_format() is selected from query_format().
7557 1.2 isaki * This function will be an alternative to auconv_set_converter() to
7558 1.2 isaki * find index.
7559 1.2 isaki */
7560 1.2 isaki int
7561 1.2 isaki audio_indexof_format(const struct audio_format *formats, int nformats,
7562 1.2 isaki int mode, const audio_params_t *param)
7563 1.2 isaki {
7564 1.2 isaki const struct audio_format *f;
7565 1.2 isaki int index;
7566 1.2 isaki int j;
7567 1.2 isaki
7568 1.2 isaki for (index = 0; index < nformats; index++) {
7569 1.2 isaki f = &formats[index];
7570 1.2 isaki
7571 1.2 isaki if (!AUFMT_IS_VALID(f))
7572 1.2 isaki continue;
7573 1.2 isaki if ((f->mode & mode) == 0)
7574 1.2 isaki continue;
7575 1.2 isaki if (f->encoding != param->encoding)
7576 1.2 isaki continue;
7577 1.2 isaki if (f->validbits != param->precision)
7578 1.2 isaki continue;
7579 1.2 isaki if (f->channels != param->channels)
7580 1.2 isaki continue;
7581 1.2 isaki
7582 1.2 isaki if (f->frequency_type == 0) {
7583 1.2 isaki if (param->sample_rate < f->frequency[0] ||
7584 1.2 isaki param->sample_rate > f->frequency[1])
7585 1.2 isaki continue;
7586 1.2 isaki } else {
7587 1.2 isaki for (j = 0; j < f->frequency_type; j++) {
7588 1.2 isaki if (param->sample_rate == f->frequency[j])
7589 1.2 isaki break;
7590 1.2 isaki }
7591 1.2 isaki if (j == f->frequency_type)
7592 1.2 isaki continue;
7593 1.2 isaki }
7594 1.2 isaki
7595 1.2 isaki /* Then, matched */
7596 1.2 isaki return index;
7597 1.2 isaki }
7598 1.2 isaki
7599 1.2 isaki /* Not matched. This should not be happened. */
7600 1.2 isaki panic("%s: cannot find matched format\n", __func__);
7601 1.2 isaki }
7602 1.2 isaki
7603 1.2 isaki /*
7604 1.2 isaki * Get or set hardware blocksize in msec.
7605 1.2 isaki * XXX It's for debug.
7606 1.2 isaki */
7607 1.2 isaki static int
7608 1.2 isaki audio_sysctl_blk_ms(SYSCTLFN_ARGS)
7609 1.2 isaki {
7610 1.2 isaki struct sysctlnode node;
7611 1.2 isaki struct audio_softc *sc;
7612 1.2 isaki audio_format2_t phwfmt;
7613 1.2 isaki audio_format2_t rhwfmt;
7614 1.2 isaki audio_filter_reg_t pfil;
7615 1.2 isaki audio_filter_reg_t rfil;
7616 1.2 isaki int t;
7617 1.2 isaki int old_blk_ms;
7618 1.2 isaki int mode;
7619 1.2 isaki int error;
7620 1.2 isaki
7621 1.2 isaki node = *rnode;
7622 1.2 isaki sc = node.sysctl_data;
7623 1.2 isaki
7624 1.28.2.12 martin error = audio_exlock_enter(sc);
7625 1.28.2.12 martin if (error)
7626 1.28.2.12 martin return error;
7627 1.2 isaki
7628 1.2 isaki old_blk_ms = sc->sc_blk_ms;
7629 1.2 isaki t = old_blk_ms;
7630 1.2 isaki node.sysctl_data = &t;
7631 1.2 isaki error = sysctl_lookup(SYSCTLFN_CALL(&node));
7632 1.2 isaki if (error || newp == NULL)
7633 1.2 isaki goto abort;
7634 1.2 isaki
7635 1.2 isaki if (t < 0) {
7636 1.2 isaki error = EINVAL;
7637 1.2 isaki goto abort;
7638 1.2 isaki }
7639 1.2 isaki
7640 1.2 isaki if (sc->sc_popens + sc->sc_ropens > 0) {
7641 1.2 isaki error = EBUSY;
7642 1.2 isaki goto abort;
7643 1.2 isaki }
7644 1.2 isaki sc->sc_blk_ms = t;
7645 1.2 isaki mode = 0;
7646 1.2 isaki if (sc->sc_pmixer) {
7647 1.2 isaki mode |= AUMODE_PLAY;
7648 1.2 isaki phwfmt = sc->sc_pmixer->hwbuf.fmt;
7649 1.2 isaki }
7650 1.2 isaki if (sc->sc_rmixer) {
7651 1.2 isaki mode |= AUMODE_RECORD;
7652 1.2 isaki rhwfmt = sc->sc_rmixer->hwbuf.fmt;
7653 1.2 isaki }
7654 1.2 isaki
7655 1.2 isaki /* re-init hardware */
7656 1.2 isaki memset(&pfil, 0, sizeof(pfil));
7657 1.2 isaki memset(&rfil, 0, sizeof(rfil));
7658 1.2 isaki error = audio_hw_set_format(sc, mode, &phwfmt, &rhwfmt, &pfil, &rfil);
7659 1.2 isaki if (error) {
7660 1.2 isaki goto abort;
7661 1.2 isaki }
7662 1.2 isaki
7663 1.2 isaki /* re-init track mixer */
7664 1.2 isaki error = audio_mixers_init(sc, mode, &phwfmt, &rhwfmt, &pfil, &rfil);
7665 1.2 isaki if (error) {
7666 1.2 isaki /* Rollback */
7667 1.2 isaki sc->sc_blk_ms = old_blk_ms;
7668 1.2 isaki audio_mixers_init(sc, mode, &phwfmt, &rhwfmt, &pfil, &rfil);
7669 1.2 isaki goto abort;
7670 1.2 isaki }
7671 1.2 isaki error = 0;
7672 1.2 isaki abort:
7673 1.28.2.12 martin audio_exlock_exit(sc);
7674 1.2 isaki return error;
7675 1.2 isaki }
7676 1.2 isaki
7677 1.2 isaki /*
7678 1.2 isaki * Get or set multiuser mode.
7679 1.2 isaki */
7680 1.2 isaki static int
7681 1.2 isaki audio_sysctl_multiuser(SYSCTLFN_ARGS)
7682 1.2 isaki {
7683 1.2 isaki struct sysctlnode node;
7684 1.2 isaki struct audio_softc *sc;
7685 1.6 nakayama bool t;
7686 1.6 nakayama int error;
7687 1.2 isaki
7688 1.2 isaki node = *rnode;
7689 1.2 isaki sc = node.sysctl_data;
7690 1.2 isaki
7691 1.28.2.12 martin error = audio_exlock_enter(sc);
7692 1.28.2.12 martin if (error)
7693 1.28.2.12 martin return error;
7694 1.2 isaki
7695 1.2 isaki t = sc->sc_multiuser;
7696 1.2 isaki node.sysctl_data = &t;
7697 1.2 isaki error = sysctl_lookup(SYSCTLFN_CALL(&node));
7698 1.2 isaki if (error || newp == NULL)
7699 1.2 isaki goto abort;
7700 1.2 isaki
7701 1.2 isaki sc->sc_multiuser = t;
7702 1.2 isaki error = 0;
7703 1.2 isaki abort:
7704 1.28.2.12 martin audio_exlock_exit(sc);
7705 1.2 isaki return error;
7706 1.2 isaki }
7707 1.2 isaki
7708 1.2 isaki #if defined(AUDIO_DEBUG)
7709 1.2 isaki /*
7710 1.2 isaki * Get or set debug verbose level. (0..4)
7711 1.2 isaki * XXX It's for debug.
7712 1.2 isaki * XXX It is not separated per device.
7713 1.2 isaki */
7714 1.2 isaki static int
7715 1.2 isaki audio_sysctl_debug(SYSCTLFN_ARGS)
7716 1.2 isaki {
7717 1.2 isaki struct sysctlnode node;
7718 1.2 isaki int t;
7719 1.2 isaki int error;
7720 1.2 isaki
7721 1.2 isaki node = *rnode;
7722 1.2 isaki t = audiodebug;
7723 1.2 isaki node.sysctl_data = &t;
7724 1.2 isaki error = sysctl_lookup(SYSCTLFN_CALL(&node));
7725 1.2 isaki if (error || newp == NULL)
7726 1.2 isaki return error;
7727 1.2 isaki
7728 1.2 isaki if (t < 0 || t > 4)
7729 1.2 isaki return EINVAL;
7730 1.2 isaki audiodebug = t;
7731 1.2 isaki printf("audio: audiodebug = %d\n", audiodebug);
7732 1.2 isaki return 0;
7733 1.2 isaki }
7734 1.2 isaki #endif /* AUDIO_DEBUG */
7735 1.2 isaki
7736 1.2 isaki #ifdef AUDIO_PM_IDLE
7737 1.2 isaki static void
7738 1.2 isaki audio_idle(void *arg)
7739 1.2 isaki {
7740 1.2 isaki device_t dv = arg;
7741 1.2 isaki struct audio_softc *sc = device_private(dv);
7742 1.2 isaki
7743 1.2 isaki #ifdef PNP_DEBUG
7744 1.2 isaki extern int pnp_debug_idle;
7745 1.2 isaki if (pnp_debug_idle)
7746 1.2 isaki printf("%s: idle handler called\n", device_xname(dv));
7747 1.2 isaki #endif
7748 1.2 isaki
7749 1.2 isaki sc->sc_idle = true;
7750 1.2 isaki
7751 1.2 isaki /* XXX joerg Make pmf_device_suspend handle children? */
7752 1.2 isaki if (!pmf_device_suspend(dv, PMF_Q_SELF))
7753 1.2 isaki return;
7754 1.2 isaki
7755 1.2 isaki if (!pmf_device_suspend(sc->hw_dev, PMF_Q_SELF))
7756 1.2 isaki pmf_device_resume(dv, PMF_Q_SELF);
7757 1.2 isaki }
7758 1.2 isaki
7759 1.2 isaki static void
7760 1.2 isaki audio_activity(device_t dv, devactive_t type)
7761 1.2 isaki {
7762 1.2 isaki struct audio_softc *sc = device_private(dv);
7763 1.2 isaki
7764 1.2 isaki if (type != DVA_SYSTEM)
7765 1.2 isaki return;
7766 1.2 isaki
7767 1.2 isaki callout_schedule(&sc->sc_idle_counter, audio_idle_timeout * hz);
7768 1.2 isaki
7769 1.2 isaki sc->sc_idle = false;
7770 1.2 isaki if (!device_is_active(dv)) {
7771 1.2 isaki /* XXX joerg How to deal with a failing resume... */
7772 1.2 isaki pmf_device_resume(sc->hw_dev, PMF_Q_SELF);
7773 1.2 isaki pmf_device_resume(dv, PMF_Q_SELF);
7774 1.2 isaki }
7775 1.2 isaki }
7776 1.2 isaki #endif
7777 1.2 isaki
7778 1.2 isaki static bool
7779 1.2 isaki audio_suspend(device_t dv, const pmf_qual_t *qual)
7780 1.2 isaki {
7781 1.2 isaki struct audio_softc *sc = device_private(dv);
7782 1.2 isaki int error;
7783 1.2 isaki
7784 1.28.2.12 martin error = audio_exlock_mutex_enter(sc);
7785 1.2 isaki if (error)
7786 1.2 isaki return error;
7787 1.28.2.16 martin sc->sc_suspending = true;
7788 1.2 isaki audio_mixer_capture(sc);
7789 1.2 isaki
7790 1.2 isaki if (sc->sc_pbusy) {
7791 1.2 isaki audio_pmixer_halt(sc);
7792 1.28.2.16 martin /* Reuse this as need-to-restart flag while suspending */
7793 1.2 isaki sc->sc_pbusy = true;
7794 1.2 isaki }
7795 1.2 isaki if (sc->sc_rbusy) {
7796 1.2 isaki audio_rmixer_halt(sc);
7797 1.28.2.16 martin /* Reuse this as need-to-restart flag while suspending */
7798 1.2 isaki sc->sc_rbusy = true;
7799 1.2 isaki }
7800 1.2 isaki
7801 1.2 isaki #ifdef AUDIO_PM_IDLE
7802 1.2 isaki callout_halt(&sc->sc_idle_counter, sc->sc_lock);
7803 1.2 isaki #endif
7804 1.28.2.12 martin audio_exlock_mutex_exit(sc);
7805 1.2 isaki
7806 1.2 isaki return true;
7807 1.2 isaki }
7808 1.2 isaki
7809 1.2 isaki static bool
7810 1.2 isaki audio_resume(device_t dv, const pmf_qual_t *qual)
7811 1.2 isaki {
7812 1.2 isaki struct audio_softc *sc = device_private(dv);
7813 1.2 isaki struct audio_info ai;
7814 1.2 isaki int error;
7815 1.2 isaki
7816 1.28.2.12 martin error = audio_exlock_mutex_enter(sc);
7817 1.2 isaki if (error)
7818 1.2 isaki return error;
7819 1.2 isaki
7820 1.28.2.16 martin sc->sc_suspending = false;
7821 1.2 isaki audio_mixer_restore(sc);
7822 1.2 isaki /* XXX ? */
7823 1.2 isaki AUDIO_INITINFO(&ai);
7824 1.2 isaki audio_hw_setinfo(sc, &ai, NULL);
7825 1.2 isaki
7826 1.28.2.16 martin /*
7827 1.28.2.16 martin * During from suspend to resume here, sc_[pr]busy is used as
7828 1.28.2.16 martin * need-to-restart flag temporarily. After this point,
7829 1.28.2.16 martin * sc_[pr]busy is returned to its original usage (busy flag).
7830 1.28.2.16 martin * And note that sc_[pr]busy must be false to call [pr]mixer_start().
7831 1.28.2.16 martin */
7832 1.28.2.16 martin if (sc->sc_pbusy) {
7833 1.28.2.16 martin /* pmixer_start() requires pbusy is false */
7834 1.28.2.16 martin sc->sc_pbusy = false;
7835 1.2 isaki audio_pmixer_start(sc, true);
7836 1.28.2.16 martin }
7837 1.28.2.16 martin if (sc->sc_rbusy) {
7838 1.28.2.16 martin /* rmixer_start() requires rbusy is false */
7839 1.28.2.16 martin sc->sc_rbusy = false;
7840 1.2 isaki audio_rmixer_start(sc);
7841 1.28.2.16 martin }
7842 1.2 isaki
7843 1.28.2.12 martin audio_exlock_mutex_exit(sc);
7844 1.2 isaki
7845 1.2 isaki return true;
7846 1.2 isaki }
7847 1.2 isaki
7848 1.8 isaki #if defined(AUDIO_DEBUG)
7849 1.2 isaki static void
7850 1.2 isaki audio_format2_tostr(char *buf, size_t bufsize, const audio_format2_t *fmt)
7851 1.2 isaki {
7852 1.2 isaki int n;
7853 1.2 isaki
7854 1.2 isaki n = 0;
7855 1.2 isaki n += snprintf(buf + n, bufsize - n, "%s",
7856 1.2 isaki audio_encoding_name(fmt->encoding));
7857 1.2 isaki if (fmt->precision == fmt->stride) {
7858 1.2 isaki n += snprintf(buf + n, bufsize - n, " %dbit", fmt->precision);
7859 1.2 isaki } else {
7860 1.2 isaki n += snprintf(buf + n, bufsize - n, " %d/%dbit",
7861 1.2 isaki fmt->precision, fmt->stride);
7862 1.2 isaki }
7863 1.2 isaki
7864 1.2 isaki snprintf(buf + n, bufsize - n, " %uch %uHz",
7865 1.2 isaki fmt->channels, fmt->sample_rate);
7866 1.2 isaki }
7867 1.2 isaki #endif
7868 1.2 isaki
7869 1.2 isaki #if defined(AUDIO_DEBUG)
7870 1.2 isaki static void
7871 1.2 isaki audio_print_format2(const char *s, const audio_format2_t *fmt)
7872 1.2 isaki {
7873 1.2 isaki char fmtstr[64];
7874 1.2 isaki
7875 1.2 isaki audio_format2_tostr(fmtstr, sizeof(fmtstr), fmt);
7876 1.2 isaki printf("%s %s\n", s, fmtstr);
7877 1.2 isaki }
7878 1.2 isaki #endif
7879 1.2 isaki
7880 1.2 isaki #ifdef DIAGNOSTIC
7881 1.2 isaki void
7882 1.28.2.8 martin audio_diagnostic_format2(const char *where, const audio_format2_t *fmt)
7883 1.2 isaki {
7884 1.2 isaki
7885 1.28.2.8 martin KASSERTMSG(fmt, "called from %s", where);
7886 1.2 isaki
7887 1.2 isaki /* XXX MSM6258 vs(4) only has 4bit stride format. */
7888 1.2 isaki if (fmt->encoding == AUDIO_ENCODING_ADPCM) {
7889 1.2 isaki KASSERTMSG(fmt->stride == 4 || fmt->stride == 8,
7890 1.28.2.8 martin "called from %s: fmt->stride=%d", where, fmt->stride);
7891 1.2 isaki } else {
7892 1.2 isaki KASSERTMSG(fmt->stride % NBBY == 0,
7893 1.28.2.8 martin "called from %s: fmt->stride=%d", where, fmt->stride);
7894 1.2 isaki }
7895 1.2 isaki KASSERTMSG(fmt->precision <= fmt->stride,
7896 1.28.2.8 martin "called from %s: fmt->precision=%d fmt->stride=%d",
7897 1.28.2.8 martin where, fmt->precision, fmt->stride);
7898 1.2 isaki KASSERTMSG(1 <= fmt->channels && fmt->channels <= AUDIO_MAX_CHANNELS,
7899 1.28.2.8 martin "called from %s: fmt->channels=%d", where, fmt->channels);
7900 1.2 isaki
7901 1.2 isaki /* XXX No check for encodings? */
7902 1.2 isaki }
7903 1.2 isaki
7904 1.2 isaki void
7905 1.28.2.8 martin audio_diagnostic_filter_arg(const char *where, const audio_filter_arg_t *arg)
7906 1.2 isaki {
7907 1.2 isaki
7908 1.2 isaki KASSERT(arg != NULL);
7909 1.2 isaki KASSERT(arg->src != NULL);
7910 1.2 isaki KASSERT(arg->dst != NULL);
7911 1.28.2.8 martin audio_diagnostic_format2(where, arg->srcfmt);
7912 1.28.2.8 martin audio_diagnostic_format2(where, arg->dstfmt);
7913 1.28.2.8 martin KASSERT(arg->count > 0);
7914 1.2 isaki }
7915 1.2 isaki
7916 1.2 isaki void
7917 1.28.2.8 martin audio_diagnostic_ring(const char *where, const audio_ring_t *ring)
7918 1.2 isaki {
7919 1.2 isaki
7920 1.28.2.8 martin KASSERTMSG(ring, "called from %s", where);
7921 1.28.2.8 martin audio_diagnostic_format2(where, &ring->fmt);
7922 1.2 isaki KASSERTMSG(0 <= ring->capacity && ring->capacity < INT_MAX / 2,
7923 1.28.2.8 martin "called from %s: ring->capacity=%d", where, ring->capacity);
7924 1.2 isaki KASSERTMSG(0 <= ring->used && ring->used <= ring->capacity,
7925 1.28.2.8 martin "called from %s: ring->used=%d ring->capacity=%d",
7926 1.28.2.8 martin where, ring->used, ring->capacity);
7927 1.2 isaki if (ring->capacity == 0) {
7928 1.2 isaki KASSERTMSG(ring->mem == NULL,
7929 1.28.2.8 martin "called from %s: capacity == 0 but mem != NULL", where);
7930 1.2 isaki } else {
7931 1.2 isaki KASSERTMSG(ring->mem != NULL,
7932 1.28.2.8 martin "called from %s: capacity != 0 but mem == NULL", where);
7933 1.2 isaki KASSERTMSG(0 <= ring->head && ring->head < ring->capacity,
7934 1.28.2.8 martin "called from %s: ring->head=%d ring->capacity=%d",
7935 1.28.2.8 martin where, ring->head, ring->capacity);
7936 1.2 isaki }
7937 1.2 isaki }
7938 1.2 isaki #endif /* DIAGNOSTIC */
7939 1.2 isaki
7940 1.2 isaki
7941 1.2 isaki /*
7942 1.2 isaki * Mixer driver
7943 1.2 isaki */
7944 1.28.2.12 martin
7945 1.28.2.12 martin /*
7946 1.28.2.12 martin * Must be called without sc_lock held.
7947 1.28.2.12 martin */
7948 1.2 isaki int
7949 1.2 isaki mixer_open(dev_t dev, struct audio_softc *sc, int flags, int ifmt,
7950 1.2 isaki struct lwp *l)
7951 1.2 isaki {
7952 1.2 isaki struct file *fp;
7953 1.2 isaki audio_file_t *af;
7954 1.2 isaki int error, fd;
7955 1.2 isaki
7956 1.2 isaki TRACE(1, "flags=0x%x", flags);
7957 1.2 isaki
7958 1.2 isaki error = fd_allocfile(&fp, &fd);
7959 1.2 isaki if (error)
7960 1.2 isaki return error;
7961 1.2 isaki
7962 1.2 isaki af = kmem_zalloc(sizeof(*af), KM_SLEEP);
7963 1.2 isaki af->sc = sc;
7964 1.2 isaki af->dev = dev;
7965 1.2 isaki
7966 1.2 isaki error = fd_clone(fp, fd, flags, &audio_fileops, af);
7967 1.2 isaki KASSERT(error == EMOVEFD);
7968 1.2 isaki
7969 1.2 isaki return error;
7970 1.2 isaki }
7971 1.2 isaki
7972 1.2 isaki /*
7973 1.28.2.12 martin * Add a process to those to be signalled on mixer activity.
7974 1.28.2.12 martin * If the process has already been added, do nothing.
7975 1.28.2.12 martin * Must be called with sc_exlock held and without sc_lock held.
7976 1.28.2.12 martin */
7977 1.28.2.12 martin static void
7978 1.28.2.12 martin mixer_async_add(struct audio_softc *sc, pid_t pid)
7979 1.28.2.12 martin {
7980 1.28.2.12 martin int i;
7981 1.28.2.12 martin
7982 1.28.2.12 martin KASSERT(sc->sc_exlock);
7983 1.28.2.12 martin
7984 1.28.2.12 martin /* If already exists, returns without doing anything. */
7985 1.28.2.12 martin for (i = 0; i < sc->sc_am_used; i++) {
7986 1.28.2.12 martin if (sc->sc_am[i] == pid)
7987 1.28.2.12 martin return;
7988 1.28.2.12 martin }
7989 1.28.2.12 martin
7990 1.28.2.12 martin /* Extend array if necessary. */
7991 1.28.2.12 martin if (sc->sc_am_used >= sc->sc_am_capacity) {
7992 1.28.2.12 martin sc->sc_am_capacity += AM_CAPACITY;
7993 1.28.2.12 martin sc->sc_am = kern_realloc(sc->sc_am,
7994 1.28.2.12 martin sc->sc_am_capacity * sizeof(pid_t), M_WAITOK);
7995 1.28.2.12 martin TRACE(2, "realloc am_capacity=%d", sc->sc_am_capacity);
7996 1.28.2.12 martin }
7997 1.28.2.12 martin
7998 1.28.2.12 martin TRACE(2, "am[%d]=%d", sc->sc_am_used, (int)pid);
7999 1.28.2.12 martin sc->sc_am[sc->sc_am_used++] = pid;
8000 1.28.2.12 martin }
8001 1.28.2.12 martin
8002 1.28.2.12 martin /*
8003 1.2 isaki * Remove a process from those to be signalled on mixer activity.
8004 1.28.2.12 martin * If the process has not been added, do nothing.
8005 1.28.2.12 martin * Must be called with sc_exlock held and without sc_lock held.
8006 1.2 isaki */
8007 1.2 isaki static void
8008 1.28.2.12 martin mixer_async_remove(struct audio_softc *sc, pid_t pid)
8009 1.2 isaki {
8010 1.28.2.12 martin int i;
8011 1.2 isaki
8012 1.28.2.12 martin KASSERT(sc->sc_exlock);
8013 1.2 isaki
8014 1.28.2.12 martin for (i = 0; i < sc->sc_am_used; i++) {
8015 1.28.2.12 martin if (sc->sc_am[i] == pid) {
8016 1.28.2.12 martin sc->sc_am[i] = sc->sc_am[--sc->sc_am_used];
8017 1.28.2.12 martin TRACE(2, "am[%d](%d) removed, used=%d",
8018 1.28.2.12 martin i, (int)pid, sc->sc_am_used);
8019 1.28.2.12 martin
8020 1.28.2.12 martin /* Empty array if no longer necessary. */
8021 1.28.2.12 martin if (sc->sc_am_used == 0) {
8022 1.28.2.12 martin kern_free(sc->sc_am);
8023 1.28.2.12 martin sc->sc_am = NULL;
8024 1.28.2.12 martin sc->sc_am_capacity = 0;
8025 1.28.2.12 martin TRACE(2, "released");
8026 1.28.2.12 martin }
8027 1.2 isaki return;
8028 1.2 isaki }
8029 1.2 isaki }
8030 1.2 isaki }
8031 1.2 isaki
8032 1.2 isaki /*
8033 1.2 isaki * Signal all processes waiting for the mixer.
8034 1.28.2.12 martin * Must be called with sc_exlock held.
8035 1.2 isaki */
8036 1.2 isaki static void
8037 1.2 isaki mixer_signal(struct audio_softc *sc)
8038 1.2 isaki {
8039 1.2 isaki proc_t *p;
8040 1.28.2.12 martin int i;
8041 1.2 isaki
8042 1.28.2.12 martin KASSERT(sc->sc_exlock);
8043 1.28.2.12 martin
8044 1.28.2.12 martin for (i = 0; i < sc->sc_am_used; i++) {
8045 1.2 isaki mutex_enter(proc_lock);
8046 1.28.2.12 martin p = proc_find(sc->sc_am[i]);
8047 1.28.2.12 martin if (p)
8048 1.2 isaki psignal(p, SIGIO);
8049 1.2 isaki mutex_exit(proc_lock);
8050 1.2 isaki }
8051 1.2 isaki }
8052 1.2 isaki
8053 1.2 isaki /*
8054 1.2 isaki * Close a mixer device
8055 1.2 isaki */
8056 1.2 isaki int
8057 1.2 isaki mixer_close(struct audio_softc *sc, audio_file_t *file)
8058 1.2 isaki {
8059 1.28.2.12 martin int error;
8060 1.2 isaki
8061 1.28.2.12 martin error = audio_exlock_enter(sc);
8062 1.28.2.12 martin if (error)
8063 1.28.2.12 martin return error;
8064 1.2 isaki TRACE(1, "");
8065 1.28.2.12 martin mixer_async_remove(sc, curproc->p_pid);
8066 1.28.2.12 martin audio_exlock_exit(sc);
8067 1.2 isaki
8068 1.2 isaki return 0;
8069 1.2 isaki }
8070 1.2 isaki
8071 1.28.2.8 martin /*
8072 1.28.2.8 martin * Must be called without sc_lock nor sc_exlock held.
8073 1.28.2.8 martin */
8074 1.2 isaki int
8075 1.2 isaki mixer_ioctl(struct audio_softc *sc, u_long cmd, void *addr, int flag,
8076 1.2 isaki struct lwp *l)
8077 1.2 isaki {
8078 1.2 isaki mixer_devinfo_t *mi;
8079 1.2 isaki mixer_ctrl_t *mc;
8080 1.2 isaki int error;
8081 1.2 isaki
8082 1.2 isaki TRACE(2, "(%lu,'%c',%lu)",
8083 1.2 isaki IOCPARM_LEN(cmd), (char)IOCGROUP(cmd), cmd & 0xff);
8084 1.2 isaki error = EINVAL;
8085 1.2 isaki
8086 1.2 isaki /* we can return cached values if we are sleeping */
8087 1.2 isaki if (cmd != AUDIO_MIXER_READ) {
8088 1.2 isaki mutex_enter(sc->sc_lock);
8089 1.2 isaki device_active(sc->sc_dev, DVA_SYSTEM);
8090 1.2 isaki mutex_exit(sc->sc_lock);
8091 1.2 isaki }
8092 1.2 isaki
8093 1.2 isaki switch (cmd) {
8094 1.2 isaki case FIOASYNC:
8095 1.28.2.12 martin error = audio_exlock_enter(sc);
8096 1.28.2.12 martin if (error)
8097 1.28.2.12 martin break;
8098 1.2 isaki if (*(int *)addr) {
8099 1.28.2.12 martin mixer_async_add(sc, curproc->p_pid);
8100 1.2 isaki } else {
8101 1.28.2.12 martin mixer_async_remove(sc, curproc->p_pid);
8102 1.2 isaki }
8103 1.28.2.12 martin audio_exlock_exit(sc);
8104 1.2 isaki break;
8105 1.2 isaki
8106 1.2 isaki case AUDIO_GETDEV:
8107 1.2 isaki TRACE(2, "AUDIO_GETDEV");
8108 1.28.2.12 martin mutex_enter(sc->sc_lock);
8109 1.2 isaki error = sc->hw_if->getdev(sc->hw_hdl, (audio_device_t *)addr);
8110 1.28.2.12 martin mutex_exit(sc->sc_lock);
8111 1.2 isaki break;
8112 1.2 isaki
8113 1.2 isaki case AUDIO_MIXER_DEVINFO:
8114 1.2 isaki TRACE(2, "AUDIO_MIXER_DEVINFO");
8115 1.2 isaki mi = (mixer_devinfo_t *)addr;
8116 1.2 isaki
8117 1.2 isaki mi->un.v.delta = 0; /* default */
8118 1.2 isaki mutex_enter(sc->sc_lock);
8119 1.2 isaki error = audio_query_devinfo(sc, mi);
8120 1.2 isaki mutex_exit(sc->sc_lock);
8121 1.2 isaki break;
8122 1.2 isaki
8123 1.2 isaki case AUDIO_MIXER_READ:
8124 1.2 isaki TRACE(2, "AUDIO_MIXER_READ");
8125 1.2 isaki mc = (mixer_ctrl_t *)addr;
8126 1.2 isaki
8127 1.28.2.12 martin error = audio_exlock_mutex_enter(sc);
8128 1.2 isaki if (error)
8129 1.2 isaki break;
8130 1.2 isaki if (device_is_active(sc->hw_dev))
8131 1.2 isaki error = audio_get_port(sc, mc);
8132 1.2 isaki else if (mc->dev < 0 || mc->dev >= sc->sc_nmixer_states)
8133 1.2 isaki error = ENXIO;
8134 1.2 isaki else {
8135 1.2 isaki int dev = mc->dev;
8136 1.2 isaki memcpy(mc, &sc->sc_mixer_state[dev],
8137 1.2 isaki sizeof(mixer_ctrl_t));
8138 1.2 isaki error = 0;
8139 1.2 isaki }
8140 1.28.2.12 martin audio_exlock_mutex_exit(sc);
8141 1.2 isaki break;
8142 1.2 isaki
8143 1.2 isaki case AUDIO_MIXER_WRITE:
8144 1.2 isaki TRACE(2, "AUDIO_MIXER_WRITE");
8145 1.28.2.12 martin error = audio_exlock_mutex_enter(sc);
8146 1.2 isaki if (error)
8147 1.2 isaki break;
8148 1.2 isaki error = audio_set_port(sc, (mixer_ctrl_t *)addr);
8149 1.2 isaki if (error) {
8150 1.28.2.12 martin audio_exlock_mutex_exit(sc);
8151 1.2 isaki break;
8152 1.2 isaki }
8153 1.2 isaki
8154 1.2 isaki if (sc->hw_if->commit_settings) {
8155 1.2 isaki error = sc->hw_if->commit_settings(sc->hw_hdl);
8156 1.2 isaki if (error) {
8157 1.28.2.12 martin audio_exlock_mutex_exit(sc);
8158 1.2 isaki break;
8159 1.2 isaki }
8160 1.2 isaki }
8161 1.28.2.12 martin mutex_exit(sc->sc_lock);
8162 1.2 isaki mixer_signal(sc);
8163 1.28.2.12 martin audio_exlock_exit(sc);
8164 1.2 isaki break;
8165 1.2 isaki
8166 1.2 isaki default:
8167 1.2 isaki if (sc->hw_if->dev_ioctl) {
8168 1.28.2.12 martin mutex_enter(sc->sc_lock);
8169 1.2 isaki error = sc->hw_if->dev_ioctl(sc->hw_hdl,
8170 1.2 isaki cmd, addr, flag, l);
8171 1.28.2.12 martin mutex_exit(sc->sc_lock);
8172 1.2 isaki } else
8173 1.2 isaki error = EINVAL;
8174 1.2 isaki break;
8175 1.2 isaki }
8176 1.2 isaki TRACE(2, "(%lu,'%c',%lu) result %d",
8177 1.2 isaki IOCPARM_LEN(cmd), (char)IOCGROUP(cmd), cmd & 0xff, error);
8178 1.2 isaki return error;
8179 1.2 isaki }
8180 1.2 isaki
8181 1.2 isaki /*
8182 1.2 isaki * Must be called with sc_lock held.
8183 1.2 isaki */
8184 1.2 isaki int
8185 1.2 isaki au_portof(struct audio_softc *sc, char *name, int class)
8186 1.2 isaki {
8187 1.2 isaki mixer_devinfo_t mi;
8188 1.2 isaki
8189 1.2 isaki KASSERT(mutex_owned(sc->sc_lock));
8190 1.2 isaki
8191 1.2 isaki for (mi.index = 0; audio_query_devinfo(sc, &mi) == 0; mi.index++) {
8192 1.2 isaki if (mi.mixer_class == class && strcmp(mi.label.name, name) == 0)
8193 1.2 isaki return mi.index;
8194 1.2 isaki }
8195 1.2 isaki return -1;
8196 1.2 isaki }
8197 1.2 isaki
8198 1.2 isaki /*
8199 1.2 isaki * Must be called with sc_lock held.
8200 1.2 isaki */
8201 1.2 isaki void
8202 1.2 isaki au_setup_ports(struct audio_softc *sc, struct au_mixer_ports *ports,
8203 1.2 isaki mixer_devinfo_t *mi, const struct portname *tbl)
8204 1.2 isaki {
8205 1.2 isaki int i, j;
8206 1.2 isaki
8207 1.2 isaki KASSERT(mutex_owned(sc->sc_lock));
8208 1.2 isaki
8209 1.2 isaki ports->index = mi->index;
8210 1.2 isaki if (mi->type == AUDIO_MIXER_ENUM) {
8211 1.2 isaki ports->isenum = true;
8212 1.2 isaki for(i = 0; tbl[i].name; i++)
8213 1.2 isaki for(j = 0; j < mi->un.e.num_mem; j++)
8214 1.2 isaki if (strcmp(mi->un.e.member[j].label.name,
8215 1.2 isaki tbl[i].name) == 0) {
8216 1.2 isaki ports->allports |= tbl[i].mask;
8217 1.2 isaki ports->aumask[ports->nports] = tbl[i].mask;
8218 1.2 isaki ports->misel[ports->nports] =
8219 1.2 isaki mi->un.e.member[j].ord;
8220 1.2 isaki ports->miport[ports->nports] =
8221 1.2 isaki au_portof(sc, mi->un.e.member[j].label.name,
8222 1.2 isaki mi->mixer_class);
8223 1.2 isaki if (ports->mixerout != -1 &&
8224 1.2 isaki ports->miport[ports->nports] != -1)
8225 1.2 isaki ports->isdual = true;
8226 1.2 isaki ++ports->nports;
8227 1.2 isaki }
8228 1.2 isaki } else if (mi->type == AUDIO_MIXER_SET) {
8229 1.2 isaki for(i = 0; tbl[i].name; i++)
8230 1.2 isaki for(j = 0; j < mi->un.s.num_mem; j++)
8231 1.2 isaki if (strcmp(mi->un.s.member[j].label.name,
8232 1.2 isaki tbl[i].name) == 0) {
8233 1.2 isaki ports->allports |= tbl[i].mask;
8234 1.2 isaki ports->aumask[ports->nports] = tbl[i].mask;
8235 1.2 isaki ports->misel[ports->nports] =
8236 1.2 isaki mi->un.s.member[j].mask;
8237 1.2 isaki ports->miport[ports->nports] =
8238 1.2 isaki au_portof(sc, mi->un.s.member[j].label.name,
8239 1.2 isaki mi->mixer_class);
8240 1.2 isaki ++ports->nports;
8241 1.2 isaki }
8242 1.2 isaki }
8243 1.2 isaki }
8244 1.2 isaki
8245 1.2 isaki /*
8246 1.2 isaki * Must be called with sc_lock && sc_exlock held.
8247 1.2 isaki */
8248 1.2 isaki int
8249 1.2 isaki au_set_lr_value(struct audio_softc *sc, mixer_ctrl_t *ct, int l, int r)
8250 1.2 isaki {
8251 1.2 isaki
8252 1.2 isaki KASSERT(mutex_owned(sc->sc_lock));
8253 1.2 isaki KASSERT(sc->sc_exlock);
8254 1.2 isaki
8255 1.2 isaki ct->type = AUDIO_MIXER_VALUE;
8256 1.2 isaki ct->un.value.num_channels = 2;
8257 1.2 isaki ct->un.value.level[AUDIO_MIXER_LEVEL_LEFT] = l;
8258 1.2 isaki ct->un.value.level[AUDIO_MIXER_LEVEL_RIGHT] = r;
8259 1.2 isaki if (audio_set_port(sc, ct) == 0)
8260 1.2 isaki return 0;
8261 1.2 isaki ct->un.value.num_channels = 1;
8262 1.2 isaki ct->un.value.level[AUDIO_MIXER_LEVEL_MONO] = (l+r)/2;
8263 1.2 isaki return audio_set_port(sc, ct);
8264 1.2 isaki }
8265 1.2 isaki
8266 1.2 isaki /*
8267 1.2 isaki * Must be called with sc_lock && sc_exlock held.
8268 1.2 isaki */
8269 1.2 isaki int
8270 1.2 isaki au_get_lr_value(struct audio_softc *sc, mixer_ctrl_t *ct, int *l, int *r)
8271 1.2 isaki {
8272 1.2 isaki int error;
8273 1.2 isaki
8274 1.2 isaki KASSERT(mutex_owned(sc->sc_lock));
8275 1.2 isaki KASSERT(sc->sc_exlock);
8276 1.2 isaki
8277 1.2 isaki ct->un.value.num_channels = 2;
8278 1.2 isaki if (audio_get_port(sc, ct) == 0) {
8279 1.2 isaki *l = ct->un.value.level[AUDIO_MIXER_LEVEL_LEFT];
8280 1.2 isaki *r = ct->un.value.level[AUDIO_MIXER_LEVEL_RIGHT];
8281 1.2 isaki } else {
8282 1.2 isaki ct->un.value.num_channels = 1;
8283 1.2 isaki error = audio_get_port(sc, ct);
8284 1.2 isaki if (error)
8285 1.2 isaki return error;
8286 1.2 isaki *r = *l = ct->un.value.level[AUDIO_MIXER_LEVEL_MONO];
8287 1.2 isaki }
8288 1.2 isaki return 0;
8289 1.2 isaki }
8290 1.2 isaki
8291 1.2 isaki /*
8292 1.2 isaki * Must be called with sc_lock && sc_exlock held.
8293 1.2 isaki */
8294 1.2 isaki int
8295 1.2 isaki au_set_gain(struct audio_softc *sc, struct au_mixer_ports *ports,
8296 1.2 isaki int gain, int balance)
8297 1.2 isaki {
8298 1.2 isaki mixer_ctrl_t ct;
8299 1.2 isaki int i, error;
8300 1.2 isaki int l, r;
8301 1.2 isaki u_int mask;
8302 1.2 isaki int nset;
8303 1.2 isaki
8304 1.2 isaki KASSERT(mutex_owned(sc->sc_lock));
8305 1.2 isaki KASSERT(sc->sc_exlock);
8306 1.2 isaki
8307 1.2 isaki if (balance == AUDIO_MID_BALANCE) {
8308 1.2 isaki l = r = gain;
8309 1.2 isaki } else if (balance < AUDIO_MID_BALANCE) {
8310 1.2 isaki l = gain;
8311 1.2 isaki r = (balance * gain) / AUDIO_MID_BALANCE;
8312 1.2 isaki } else {
8313 1.2 isaki r = gain;
8314 1.2 isaki l = ((AUDIO_RIGHT_BALANCE - balance) * gain)
8315 1.2 isaki / AUDIO_MID_BALANCE;
8316 1.2 isaki }
8317 1.2 isaki TRACE(2, "gain=%d balance=%d, l=%d r=%d", gain, balance, l, r);
8318 1.2 isaki
8319 1.2 isaki if (ports->index == -1) {
8320 1.2 isaki usemaster:
8321 1.2 isaki if (ports->master == -1)
8322 1.2 isaki return 0; /* just ignore it silently */
8323 1.2 isaki ct.dev = ports->master;
8324 1.2 isaki error = au_set_lr_value(sc, &ct, l, r);
8325 1.2 isaki } else {
8326 1.2 isaki ct.dev = ports->index;
8327 1.2 isaki if (ports->isenum) {
8328 1.2 isaki ct.type = AUDIO_MIXER_ENUM;
8329 1.2 isaki error = audio_get_port(sc, &ct);
8330 1.2 isaki if (error)
8331 1.2 isaki return error;
8332 1.2 isaki if (ports->isdual) {
8333 1.2 isaki if (ports->cur_port == -1)
8334 1.2 isaki ct.dev = ports->master;
8335 1.2 isaki else
8336 1.2 isaki ct.dev = ports->miport[ports->cur_port];
8337 1.2 isaki error = au_set_lr_value(sc, &ct, l, r);
8338 1.2 isaki } else {
8339 1.2 isaki for(i = 0; i < ports->nports; i++)
8340 1.2 isaki if (ports->misel[i] == ct.un.ord) {
8341 1.2 isaki ct.dev = ports->miport[i];
8342 1.2 isaki if (ct.dev == -1 ||
8343 1.2 isaki au_set_lr_value(sc, &ct, l, r))
8344 1.2 isaki goto usemaster;
8345 1.2 isaki else
8346 1.2 isaki break;
8347 1.2 isaki }
8348 1.2 isaki }
8349 1.2 isaki } else {
8350 1.2 isaki ct.type = AUDIO_MIXER_SET;
8351 1.2 isaki error = audio_get_port(sc, &ct);
8352 1.2 isaki if (error)
8353 1.2 isaki return error;
8354 1.2 isaki mask = ct.un.mask;
8355 1.2 isaki nset = 0;
8356 1.2 isaki for(i = 0; i < ports->nports; i++) {
8357 1.2 isaki if (ports->misel[i] & mask) {
8358 1.2 isaki ct.dev = ports->miport[i];
8359 1.2 isaki if (ct.dev != -1 &&
8360 1.2 isaki au_set_lr_value(sc, &ct, l, r) == 0)
8361 1.2 isaki nset++;
8362 1.2 isaki }
8363 1.2 isaki }
8364 1.2 isaki if (nset == 0)
8365 1.2 isaki goto usemaster;
8366 1.2 isaki }
8367 1.2 isaki }
8368 1.2 isaki if (!error)
8369 1.2 isaki mixer_signal(sc);
8370 1.2 isaki return error;
8371 1.2 isaki }
8372 1.2 isaki
8373 1.2 isaki /*
8374 1.2 isaki * Must be called with sc_lock && sc_exlock held.
8375 1.2 isaki */
8376 1.2 isaki void
8377 1.2 isaki au_get_gain(struct audio_softc *sc, struct au_mixer_ports *ports,
8378 1.2 isaki u_int *pgain, u_char *pbalance)
8379 1.2 isaki {
8380 1.2 isaki mixer_ctrl_t ct;
8381 1.2 isaki int i, l, r, n;
8382 1.2 isaki int lgain, rgain;
8383 1.2 isaki
8384 1.2 isaki KASSERT(mutex_owned(sc->sc_lock));
8385 1.2 isaki KASSERT(sc->sc_exlock);
8386 1.2 isaki
8387 1.2 isaki lgain = AUDIO_MAX_GAIN / 2;
8388 1.2 isaki rgain = AUDIO_MAX_GAIN / 2;
8389 1.2 isaki if (ports->index == -1) {
8390 1.2 isaki usemaster:
8391 1.2 isaki if (ports->master == -1)
8392 1.2 isaki goto bad;
8393 1.2 isaki ct.dev = ports->master;
8394 1.2 isaki ct.type = AUDIO_MIXER_VALUE;
8395 1.2 isaki if (au_get_lr_value(sc, &ct, &lgain, &rgain))
8396 1.2 isaki goto bad;
8397 1.2 isaki } else {
8398 1.2 isaki ct.dev = ports->index;
8399 1.2 isaki if (ports->isenum) {
8400 1.2 isaki ct.type = AUDIO_MIXER_ENUM;
8401 1.2 isaki if (audio_get_port(sc, &ct))
8402 1.2 isaki goto bad;
8403 1.2 isaki ct.type = AUDIO_MIXER_VALUE;
8404 1.2 isaki if (ports->isdual) {
8405 1.2 isaki if (ports->cur_port == -1)
8406 1.2 isaki ct.dev = ports->master;
8407 1.2 isaki else
8408 1.2 isaki ct.dev = ports->miport[ports->cur_port];
8409 1.2 isaki au_get_lr_value(sc, &ct, &lgain, &rgain);
8410 1.2 isaki } else {
8411 1.2 isaki for(i = 0; i < ports->nports; i++)
8412 1.2 isaki if (ports->misel[i] == ct.un.ord) {
8413 1.2 isaki ct.dev = ports->miport[i];
8414 1.2 isaki if (ct.dev == -1 ||
8415 1.2 isaki au_get_lr_value(sc, &ct,
8416 1.2 isaki &lgain, &rgain))
8417 1.2 isaki goto usemaster;
8418 1.2 isaki else
8419 1.2 isaki break;
8420 1.2 isaki }
8421 1.2 isaki }
8422 1.2 isaki } else {
8423 1.2 isaki ct.type = AUDIO_MIXER_SET;
8424 1.2 isaki if (audio_get_port(sc, &ct))
8425 1.2 isaki goto bad;
8426 1.2 isaki ct.type = AUDIO_MIXER_VALUE;
8427 1.2 isaki lgain = rgain = n = 0;
8428 1.2 isaki for(i = 0; i < ports->nports; i++) {
8429 1.2 isaki if (ports->misel[i] & ct.un.mask) {
8430 1.2 isaki ct.dev = ports->miport[i];
8431 1.2 isaki if (ct.dev == -1 ||
8432 1.2 isaki au_get_lr_value(sc, &ct, &l, &r))
8433 1.2 isaki goto usemaster;
8434 1.2 isaki else {
8435 1.2 isaki lgain += l;
8436 1.2 isaki rgain += r;
8437 1.2 isaki n++;
8438 1.2 isaki }
8439 1.2 isaki }
8440 1.2 isaki }
8441 1.2 isaki if (n != 0) {
8442 1.2 isaki lgain /= n;
8443 1.2 isaki rgain /= n;
8444 1.2 isaki }
8445 1.2 isaki }
8446 1.2 isaki }
8447 1.2 isaki bad:
8448 1.2 isaki if (lgain == rgain) { /* handles lgain==rgain==0 */
8449 1.2 isaki *pgain = lgain;
8450 1.2 isaki *pbalance = AUDIO_MID_BALANCE;
8451 1.2 isaki } else if (lgain < rgain) {
8452 1.2 isaki *pgain = rgain;
8453 1.2 isaki /* balance should be > AUDIO_MID_BALANCE */
8454 1.2 isaki *pbalance = AUDIO_RIGHT_BALANCE -
8455 1.2 isaki (AUDIO_MID_BALANCE * lgain) / rgain;
8456 1.2 isaki } else /* lgain > rgain */ {
8457 1.2 isaki *pgain = lgain;
8458 1.2 isaki /* balance should be < AUDIO_MID_BALANCE */
8459 1.2 isaki *pbalance = (AUDIO_MID_BALANCE * rgain) / lgain;
8460 1.2 isaki }
8461 1.2 isaki }
8462 1.2 isaki
8463 1.2 isaki /*
8464 1.2 isaki * Must be called with sc_lock && sc_exlock held.
8465 1.2 isaki */
8466 1.2 isaki int
8467 1.2 isaki au_set_port(struct audio_softc *sc, struct au_mixer_ports *ports, u_int port)
8468 1.2 isaki {
8469 1.2 isaki mixer_ctrl_t ct;
8470 1.2 isaki int i, error, use_mixerout;
8471 1.2 isaki
8472 1.2 isaki KASSERT(mutex_owned(sc->sc_lock));
8473 1.2 isaki KASSERT(sc->sc_exlock);
8474 1.2 isaki
8475 1.2 isaki use_mixerout = 1;
8476 1.2 isaki if (port == 0) {
8477 1.2 isaki if (ports->allports == 0)
8478 1.2 isaki return 0; /* Allow this special case. */
8479 1.2 isaki else if (ports->isdual) {
8480 1.2 isaki if (ports->cur_port == -1) {
8481 1.2 isaki return 0;
8482 1.2 isaki } else {
8483 1.2 isaki port = ports->aumask[ports->cur_port];
8484 1.2 isaki ports->cur_port = -1;
8485 1.2 isaki use_mixerout = 0;
8486 1.2 isaki }
8487 1.2 isaki }
8488 1.2 isaki }
8489 1.2 isaki if (ports->index == -1)
8490 1.2 isaki return EINVAL;
8491 1.2 isaki ct.dev = ports->index;
8492 1.2 isaki if (ports->isenum) {
8493 1.2 isaki if (port & (port-1))
8494 1.2 isaki return EINVAL; /* Only one port allowed */
8495 1.2 isaki ct.type = AUDIO_MIXER_ENUM;
8496 1.2 isaki error = EINVAL;
8497 1.2 isaki for(i = 0; i < ports->nports; i++)
8498 1.2 isaki if (ports->aumask[i] == port) {
8499 1.2 isaki if (ports->isdual && use_mixerout) {
8500 1.2 isaki ct.un.ord = ports->mixerout;
8501 1.2 isaki ports->cur_port = i;
8502 1.2 isaki } else {
8503 1.2 isaki ct.un.ord = ports->misel[i];
8504 1.2 isaki }
8505 1.2 isaki error = audio_set_port(sc, &ct);
8506 1.2 isaki break;
8507 1.2 isaki }
8508 1.2 isaki } else {
8509 1.2 isaki ct.type = AUDIO_MIXER_SET;
8510 1.2 isaki ct.un.mask = 0;
8511 1.2 isaki for(i = 0; i < ports->nports; i++)
8512 1.2 isaki if (ports->aumask[i] & port)
8513 1.2 isaki ct.un.mask |= ports->misel[i];
8514 1.2 isaki if (port != 0 && ct.un.mask == 0)
8515 1.2 isaki error = EINVAL;
8516 1.2 isaki else
8517 1.2 isaki error = audio_set_port(sc, &ct);
8518 1.2 isaki }
8519 1.2 isaki if (!error)
8520 1.2 isaki mixer_signal(sc);
8521 1.2 isaki return error;
8522 1.2 isaki }
8523 1.2 isaki
8524 1.2 isaki /*
8525 1.2 isaki * Must be called with sc_lock && sc_exlock held.
8526 1.2 isaki */
8527 1.2 isaki int
8528 1.2 isaki au_get_port(struct audio_softc *sc, struct au_mixer_ports *ports)
8529 1.2 isaki {
8530 1.2 isaki mixer_ctrl_t ct;
8531 1.2 isaki int i, aumask;
8532 1.2 isaki
8533 1.2 isaki KASSERT(mutex_owned(sc->sc_lock));
8534 1.2 isaki KASSERT(sc->sc_exlock);
8535 1.2 isaki
8536 1.2 isaki if (ports->index == -1)
8537 1.2 isaki return 0;
8538 1.2 isaki ct.dev = ports->index;
8539 1.2 isaki ct.type = ports->isenum ? AUDIO_MIXER_ENUM : AUDIO_MIXER_SET;
8540 1.2 isaki if (audio_get_port(sc, &ct))
8541 1.2 isaki return 0;
8542 1.2 isaki aumask = 0;
8543 1.2 isaki if (ports->isenum) {
8544 1.2 isaki if (ports->isdual && ports->cur_port != -1) {
8545 1.2 isaki if (ports->mixerout == ct.un.ord)
8546 1.2 isaki aumask = ports->aumask[ports->cur_port];
8547 1.2 isaki else
8548 1.2 isaki ports->cur_port = -1;
8549 1.2 isaki }
8550 1.2 isaki if (aumask == 0)
8551 1.2 isaki for(i = 0; i < ports->nports; i++)
8552 1.2 isaki if (ports->misel[i] == ct.un.ord)
8553 1.2 isaki aumask = ports->aumask[i];
8554 1.2 isaki } else {
8555 1.2 isaki for(i = 0; i < ports->nports; i++)
8556 1.2 isaki if (ct.un.mask & ports->misel[i])
8557 1.2 isaki aumask |= ports->aumask[i];
8558 1.2 isaki }
8559 1.2 isaki return aumask;
8560 1.2 isaki }
8561 1.2 isaki
8562 1.2 isaki /*
8563 1.2 isaki * It returns 0 if success, otherwise errno.
8564 1.2 isaki * Must be called only if sc->sc_monitor_port != -1.
8565 1.2 isaki * Must be called with sc_lock && sc_exlock held.
8566 1.2 isaki */
8567 1.2 isaki static int
8568 1.2 isaki au_set_monitor_gain(struct audio_softc *sc, int monitor_gain)
8569 1.2 isaki {
8570 1.2 isaki mixer_ctrl_t ct;
8571 1.2 isaki
8572 1.2 isaki KASSERT(mutex_owned(sc->sc_lock));
8573 1.2 isaki KASSERT(sc->sc_exlock);
8574 1.2 isaki
8575 1.2 isaki ct.dev = sc->sc_monitor_port;
8576 1.2 isaki ct.type = AUDIO_MIXER_VALUE;
8577 1.2 isaki ct.un.value.num_channels = 1;
8578 1.2 isaki ct.un.value.level[AUDIO_MIXER_LEVEL_MONO] = monitor_gain;
8579 1.2 isaki return audio_set_port(sc, &ct);
8580 1.2 isaki }
8581 1.2 isaki
8582 1.2 isaki /*
8583 1.2 isaki * It returns monitor gain if success, otherwise -1.
8584 1.2 isaki * Must be called only if sc->sc_monitor_port != -1.
8585 1.2 isaki * Must be called with sc_lock && sc_exlock held.
8586 1.2 isaki */
8587 1.2 isaki static int
8588 1.2 isaki au_get_monitor_gain(struct audio_softc *sc)
8589 1.2 isaki {
8590 1.2 isaki mixer_ctrl_t ct;
8591 1.2 isaki
8592 1.2 isaki KASSERT(mutex_owned(sc->sc_lock));
8593 1.2 isaki KASSERT(sc->sc_exlock);
8594 1.2 isaki
8595 1.2 isaki ct.dev = sc->sc_monitor_port;
8596 1.2 isaki ct.type = AUDIO_MIXER_VALUE;
8597 1.2 isaki ct.un.value.num_channels = 1;
8598 1.2 isaki if (audio_get_port(sc, &ct))
8599 1.2 isaki return -1;
8600 1.2 isaki return ct.un.value.level[AUDIO_MIXER_LEVEL_MONO];
8601 1.2 isaki }
8602 1.2 isaki
8603 1.2 isaki /*
8604 1.2 isaki * Must be called with sc_lock && sc_exlock held.
8605 1.2 isaki */
8606 1.2 isaki static int
8607 1.2 isaki audio_set_port(struct audio_softc *sc, mixer_ctrl_t *mc)
8608 1.2 isaki {
8609 1.2 isaki
8610 1.2 isaki KASSERT(mutex_owned(sc->sc_lock));
8611 1.2 isaki KASSERT(sc->sc_exlock);
8612 1.2 isaki
8613 1.2 isaki return sc->hw_if->set_port(sc->hw_hdl, mc);
8614 1.2 isaki }
8615 1.2 isaki
8616 1.2 isaki /*
8617 1.2 isaki * Must be called with sc_lock && sc_exlock held.
8618 1.2 isaki */
8619 1.2 isaki static int
8620 1.2 isaki audio_get_port(struct audio_softc *sc, mixer_ctrl_t *mc)
8621 1.2 isaki {
8622 1.2 isaki
8623 1.2 isaki KASSERT(mutex_owned(sc->sc_lock));
8624 1.2 isaki KASSERT(sc->sc_exlock);
8625 1.2 isaki
8626 1.2 isaki return sc->hw_if->get_port(sc->hw_hdl, mc);
8627 1.2 isaki }
8628 1.2 isaki
8629 1.2 isaki /*
8630 1.2 isaki * Must be called with sc_lock && sc_exlock held.
8631 1.2 isaki */
8632 1.2 isaki static void
8633 1.2 isaki audio_mixer_capture(struct audio_softc *sc)
8634 1.2 isaki {
8635 1.2 isaki mixer_devinfo_t mi;
8636 1.2 isaki mixer_ctrl_t *mc;
8637 1.2 isaki
8638 1.2 isaki KASSERT(mutex_owned(sc->sc_lock));
8639 1.2 isaki KASSERT(sc->sc_exlock);
8640 1.2 isaki
8641 1.2 isaki for (mi.index = 0;; mi.index++) {
8642 1.2 isaki if (audio_query_devinfo(sc, &mi) != 0)
8643 1.2 isaki break;
8644 1.2 isaki KASSERT(mi.index < sc->sc_nmixer_states);
8645 1.2 isaki if (mi.type == AUDIO_MIXER_CLASS)
8646 1.2 isaki continue;
8647 1.2 isaki mc = &sc->sc_mixer_state[mi.index];
8648 1.2 isaki mc->dev = mi.index;
8649 1.2 isaki mc->type = mi.type;
8650 1.2 isaki mc->un.value.num_channels = mi.un.v.num_channels;
8651 1.2 isaki (void)audio_get_port(sc, mc);
8652 1.2 isaki }
8653 1.2 isaki
8654 1.2 isaki return;
8655 1.2 isaki }
8656 1.2 isaki
8657 1.2 isaki /*
8658 1.2 isaki * Must be called with sc_lock && sc_exlock held.
8659 1.2 isaki */
8660 1.2 isaki static void
8661 1.2 isaki audio_mixer_restore(struct audio_softc *sc)
8662 1.2 isaki {
8663 1.2 isaki mixer_devinfo_t mi;
8664 1.2 isaki mixer_ctrl_t *mc;
8665 1.2 isaki
8666 1.2 isaki KASSERT(mutex_owned(sc->sc_lock));
8667 1.2 isaki KASSERT(sc->sc_exlock);
8668 1.2 isaki
8669 1.2 isaki for (mi.index = 0; ; mi.index++) {
8670 1.2 isaki if (audio_query_devinfo(sc, &mi) != 0)
8671 1.2 isaki break;
8672 1.2 isaki if (mi.type == AUDIO_MIXER_CLASS)
8673 1.2 isaki continue;
8674 1.2 isaki mc = &sc->sc_mixer_state[mi.index];
8675 1.2 isaki (void)audio_set_port(sc, mc);
8676 1.2 isaki }
8677 1.2 isaki if (sc->hw_if->commit_settings)
8678 1.2 isaki sc->hw_if->commit_settings(sc->hw_hdl);
8679 1.2 isaki
8680 1.2 isaki return;
8681 1.2 isaki }
8682 1.2 isaki
8683 1.2 isaki static void
8684 1.2 isaki audio_volume_down(device_t dv)
8685 1.2 isaki {
8686 1.2 isaki struct audio_softc *sc = device_private(dv);
8687 1.2 isaki mixer_devinfo_t mi;
8688 1.2 isaki int newgain;
8689 1.2 isaki u_int gain;
8690 1.2 isaki u_char balance;
8691 1.2 isaki
8692 1.28.2.12 martin if (audio_exlock_mutex_enter(sc) != 0)
8693 1.2 isaki return;
8694 1.2 isaki if (sc->sc_outports.index == -1 && sc->sc_outports.master != -1) {
8695 1.2 isaki mi.index = sc->sc_outports.master;
8696 1.2 isaki mi.un.v.delta = 0;
8697 1.2 isaki if (audio_query_devinfo(sc, &mi) == 0) {
8698 1.2 isaki au_get_gain(sc, &sc->sc_outports, &gain, &balance);
8699 1.2 isaki newgain = gain - mi.un.v.delta;
8700 1.2 isaki if (newgain < AUDIO_MIN_GAIN)
8701 1.2 isaki newgain = AUDIO_MIN_GAIN;
8702 1.2 isaki au_set_gain(sc, &sc->sc_outports, newgain, balance);
8703 1.2 isaki }
8704 1.2 isaki }
8705 1.28.2.12 martin audio_exlock_mutex_exit(sc);
8706 1.2 isaki }
8707 1.2 isaki
8708 1.2 isaki static void
8709 1.2 isaki audio_volume_up(device_t dv)
8710 1.2 isaki {
8711 1.2 isaki struct audio_softc *sc = device_private(dv);
8712 1.2 isaki mixer_devinfo_t mi;
8713 1.2 isaki u_int gain, newgain;
8714 1.2 isaki u_char balance;
8715 1.2 isaki
8716 1.28.2.12 martin if (audio_exlock_mutex_enter(sc) != 0)
8717 1.2 isaki return;
8718 1.2 isaki if (sc->sc_outports.index == -1 && sc->sc_outports.master != -1) {
8719 1.2 isaki mi.index = sc->sc_outports.master;
8720 1.2 isaki mi.un.v.delta = 0;
8721 1.2 isaki if (audio_query_devinfo(sc, &mi) == 0) {
8722 1.2 isaki au_get_gain(sc, &sc->sc_outports, &gain, &balance);
8723 1.2 isaki newgain = gain + mi.un.v.delta;
8724 1.2 isaki if (newgain > AUDIO_MAX_GAIN)
8725 1.2 isaki newgain = AUDIO_MAX_GAIN;
8726 1.2 isaki au_set_gain(sc, &sc->sc_outports, newgain, balance);
8727 1.2 isaki }
8728 1.2 isaki }
8729 1.28.2.12 martin audio_exlock_mutex_exit(sc);
8730 1.2 isaki }
8731 1.2 isaki
8732 1.2 isaki static void
8733 1.2 isaki audio_volume_toggle(device_t dv)
8734 1.2 isaki {
8735 1.2 isaki struct audio_softc *sc = device_private(dv);
8736 1.2 isaki u_int gain, newgain;
8737 1.2 isaki u_char balance;
8738 1.2 isaki
8739 1.28.2.12 martin if (audio_exlock_mutex_enter(sc) != 0)
8740 1.2 isaki return;
8741 1.2 isaki au_get_gain(sc, &sc->sc_outports, &gain, &balance);
8742 1.2 isaki if (gain != 0) {
8743 1.2 isaki sc->sc_lastgain = gain;
8744 1.2 isaki newgain = 0;
8745 1.2 isaki } else
8746 1.2 isaki newgain = sc->sc_lastgain;
8747 1.2 isaki au_set_gain(sc, &sc->sc_outports, newgain, balance);
8748 1.28.2.12 martin audio_exlock_mutex_exit(sc);
8749 1.2 isaki }
8750 1.2 isaki
8751 1.28.2.12 martin /*
8752 1.28.2.12 martin * Must be called with sc_lock held.
8753 1.28.2.12 martin */
8754 1.2 isaki static int
8755 1.2 isaki audio_query_devinfo(struct audio_softc *sc, mixer_devinfo_t *di)
8756 1.2 isaki {
8757 1.2 isaki
8758 1.2 isaki KASSERT(mutex_owned(sc->sc_lock));
8759 1.2 isaki
8760 1.2 isaki return sc->hw_if->query_devinfo(sc->hw_hdl, di);
8761 1.2 isaki }
8762 1.2 isaki
8763 1.2 isaki #endif /* NAUDIO > 0 */
8764 1.2 isaki
8765 1.2 isaki #if NAUDIO == 0 && (NMIDI > 0 || NMIDIBUS > 0)
8766 1.2 isaki #include <sys/param.h>
8767 1.2 isaki #include <sys/systm.h>
8768 1.2 isaki #include <sys/device.h>
8769 1.2 isaki #include <sys/audioio.h>
8770 1.2 isaki #include <dev/audio/audio_if.h>
8771 1.2 isaki #endif
8772 1.2 isaki
8773 1.2 isaki #if NAUDIO > 0 || (NMIDI > 0 || NMIDIBUS > 0)
8774 1.2 isaki int
8775 1.2 isaki audioprint(void *aux, const char *pnp)
8776 1.2 isaki {
8777 1.2 isaki struct audio_attach_args *arg;
8778 1.2 isaki const char *type;
8779 1.2 isaki
8780 1.2 isaki if (pnp != NULL) {
8781 1.2 isaki arg = aux;
8782 1.2 isaki switch (arg->type) {
8783 1.2 isaki case AUDIODEV_TYPE_AUDIO:
8784 1.2 isaki type = "audio";
8785 1.2 isaki break;
8786 1.2 isaki case AUDIODEV_TYPE_MIDI:
8787 1.2 isaki type = "midi";
8788 1.2 isaki break;
8789 1.2 isaki case AUDIODEV_TYPE_OPL:
8790 1.2 isaki type = "opl";
8791 1.2 isaki break;
8792 1.2 isaki case AUDIODEV_TYPE_MPU:
8793 1.2 isaki type = "mpu";
8794 1.2 isaki break;
8795 1.2 isaki default:
8796 1.2 isaki panic("audioprint: unknown type %d", arg->type);
8797 1.2 isaki }
8798 1.2 isaki aprint_normal("%s at %s", type, pnp);
8799 1.2 isaki }
8800 1.2 isaki return UNCONF;
8801 1.2 isaki }
8802 1.2 isaki
8803 1.2 isaki #endif /* NAUDIO > 0 || (NMIDI > 0 || NMIDIBUS > 0) */
8804 1.2 isaki
8805 1.2 isaki #ifdef _MODULE
8806 1.2 isaki
8807 1.2 isaki devmajor_t audio_bmajor = -1, audio_cmajor = -1;
8808 1.2 isaki
8809 1.2 isaki #include "ioconf.c"
8810 1.2 isaki
8811 1.2 isaki #endif
8812 1.2 isaki
8813 1.2 isaki MODULE(MODULE_CLASS_DRIVER, audio, NULL);
8814 1.2 isaki
8815 1.2 isaki static int
8816 1.2 isaki audio_modcmd(modcmd_t cmd, void *arg)
8817 1.2 isaki {
8818 1.2 isaki int error = 0;
8819 1.2 isaki
8820 1.2 isaki switch (cmd) {
8821 1.2 isaki case MODULE_CMD_INIT:
8822 1.28.2.9 martin /* XXX interrupt level? */
8823 1.28.2.9 martin audio_psref_class = psref_class_create("audio", IPL_SOFTSERIAL);
8824 1.28.2.9 martin #ifdef _MODULE
8825 1.2 isaki error = devsw_attach(audio_cd.cd_name, NULL, &audio_bmajor,
8826 1.2 isaki &audio_cdevsw, &audio_cmajor);
8827 1.2 isaki if (error)
8828 1.2 isaki break;
8829 1.2 isaki
8830 1.2 isaki error = config_init_component(cfdriver_ioconf_audio,
8831 1.2 isaki cfattach_ioconf_audio, cfdata_ioconf_audio);
8832 1.2 isaki if (error) {
8833 1.2 isaki devsw_detach(NULL, &audio_cdevsw);
8834 1.2 isaki }
8835 1.28.2.9 martin #endif
8836 1.2 isaki break;
8837 1.2 isaki case MODULE_CMD_FINI:
8838 1.28.2.9 martin #ifdef _MODULE
8839 1.2 isaki devsw_detach(NULL, &audio_cdevsw);
8840 1.2 isaki error = config_fini_component(cfdriver_ioconf_audio,
8841 1.2 isaki cfattach_ioconf_audio, cfdata_ioconf_audio);
8842 1.2 isaki if (error)
8843 1.2 isaki devsw_attach(audio_cd.cd_name, NULL, &audio_bmajor,
8844 1.2 isaki &audio_cdevsw, &audio_cmajor);
8845 1.28.2.9 martin #endif
8846 1.28.2.9 martin psref_class_destroy(audio_psref_class);
8847 1.2 isaki break;
8848 1.2 isaki default:
8849 1.2 isaki error = ENOTTY;
8850 1.2 isaki break;
8851 1.2 isaki }
8852 1.2 isaki
8853 1.2 isaki return error;
8854 1.2 isaki }
8855