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