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