Home | History | Annotate | Line # | Download | only in ic
ad1848.c revision 1.23.2.1
      1  1.23.2.1        ad /*	$NetBSD: ad1848.c,v 1.23.2.1 2006/11/18 21:34:07 ad Exp $	*/
      2       1.1        pk 
      3       1.5   mycroft /*-
      4       1.5   mycroft  * Copyright (c) 1999 The NetBSD Foundation, Inc.
      5       1.5   mycroft  * All rights reserved.
      6       1.5   mycroft  *
      7       1.5   mycroft  * This code is derived from software contributed to The NetBSD Foundation
      8       1.5   mycroft  * by Ken Hornstein and John Kohl.
      9       1.5   mycroft  *
     10       1.5   mycroft  * Redistribution and use in source and binary forms, with or without
     11       1.5   mycroft  * modification, are permitted provided that the following conditions
     12       1.5   mycroft  * are met:
     13       1.5   mycroft  * 1. Redistributions of source code must retain the above copyright
     14       1.5   mycroft  *    notice, this list of conditions and the following disclaimer.
     15       1.5   mycroft  * 2. Redistributions in binary form must reproduce the above copyright
     16       1.5   mycroft  *    notice, this list of conditions and the following disclaimer in the
     17       1.5   mycroft  *    documentation and/or other materials provided with the distribution.
     18       1.5   mycroft  * 3. All advertising materials mentioning features or use of this software
     19       1.5   mycroft  *    must display the following acknowledgement:
     20       1.7     itohy  *	This product includes software developed by the NetBSD
     21       1.7     itohy  *	Foundation, Inc. and its contributors.
     22       1.7     itohy  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23       1.7     itohy  *    contributors may be used to endorse or promote products derived
     24       1.5   mycroft  *    from this software without specific prior written permission.
     25       1.5   mycroft  *
     26       1.5   mycroft  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27       1.5   mycroft  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28       1.5   mycroft  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29       1.5   mycroft  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30       1.5   mycroft  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31       1.5   mycroft  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32       1.5   mycroft  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33       1.5   mycroft  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34       1.5   mycroft  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35       1.5   mycroft  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36       1.5   mycroft  * POSSIBILITY OF SUCH DAMAGE.
     37       1.5   mycroft  */
     38       1.1        pk /*
     39       1.1        pk  * Copyright (c) 1994 John Brezak
     40       1.1        pk  * Copyright (c) 1991-1993 Regents of the University of California.
     41       1.1        pk  * All rights reserved.
     42       1.1        pk  *
     43       1.1        pk  * Redistribution and use in source and binary forms, with or without
     44       1.1        pk  * modification, are permitted provided that the following conditions
     45       1.1        pk  * are met:
     46       1.1        pk  * 1. Redistributions of source code must retain the above copyright
     47       1.1        pk  *    notice, this list of conditions and the following disclaimer.
     48       1.1        pk  * 2. Redistributions in binary form must reproduce the above copyright
     49       1.1        pk  *    notice, this list of conditions and the following disclaimer in the
     50       1.1        pk  *    documentation and/or other materials provided with the distribution.
     51       1.1        pk  * 3. All advertising materials mentioning features or use of this software
     52       1.1        pk  *    must display the following acknowledgement:
     53       1.1        pk  *	This product includes software developed by the Computer Systems
     54       1.1        pk  *	Engineering Group at Lawrence Berkeley Laboratory.
     55       1.1        pk  * 4. Neither the name of the University nor of the Laboratory may be used
     56       1.1        pk  *    to endorse or promote products derived from this software without
     57       1.1        pk  *    specific prior written permission.
     58       1.1        pk  *
     59       1.1        pk  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     60       1.1        pk  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     61       1.1        pk  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     62       1.1        pk  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     63       1.1        pk  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     64       1.1        pk  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     65       1.1        pk  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     66       1.1        pk  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     67       1.1        pk  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     68       1.1        pk  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     69       1.1        pk  * SUCH DAMAGE.
     70       1.1        pk  *
     71       1.1        pk  */
     72       1.1        pk 
     73       1.1        pk /*
     74       1.1        pk  * Copyright by Hannu Savolainen 1994
     75       1.1        pk  *
     76       1.1        pk  * Redistribution and use in source and binary forms, with or without
     77       1.1        pk  * modification, are permitted provided that the following conditions are
     78       1.1        pk  * met: 1. Redistributions of source code must retain the above copyright
     79       1.1        pk  * notice, this list of conditions and the following disclaimer. 2.
     80       1.1        pk  * Redistributions in binary form must reproduce the above copyright notice,
     81       1.1        pk  * this list of conditions and the following disclaimer in the documentation
     82       1.1        pk  * and/or other materials provided with the distribution.
     83       1.1        pk  *
     84       1.1        pk  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND ANY
     85       1.1        pk  * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
     86       1.1        pk  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
     87       1.1        pk  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
     88       1.1        pk  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     89       1.1        pk  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     90       1.1        pk  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
     91       1.1        pk  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     92       1.1        pk  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     93       1.1        pk  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     94       1.1        pk  * SUCH DAMAGE.
     95       1.1        pk  *
     96       1.1        pk  */
     97       1.1        pk /*
     98       1.1        pk  * Portions of this code are from the VOXware support for the ad1848
     99       1.1        pk  * by Hannu Savolainen <hannu (at) voxware.pp.fi>
    100       1.1        pk  *
    101       1.1        pk  * Portions also supplied from the SoundBlaster driver for NetBSD.
    102       1.1        pk  */
    103      1.12     lukem 
    104      1.12     lukem #include <sys/cdefs.h>
    105  1.23.2.1        ad __KERNEL_RCSID(0, "$NetBSD: ad1848.c,v 1.23.2.1 2006/11/18 21:34:07 ad Exp $");
    106       1.1        pk 
    107       1.1        pk #include <sys/param.h>
    108       1.1        pk #include <sys/systm.h>
    109       1.1        pk #include <sys/errno.h>
    110       1.1        pk #include <sys/ioctl.h>
    111       1.1        pk #include <sys/device.h>
    112       1.7     itohy #include <sys/fcntl.h>
    113       1.1        pk /*#include <sys/syslog.h>*/
    114       1.1        pk /*#include <sys/proc.h>*/
    115       1.1        pk 
    116       1.1        pk #include <machine/cpu.h>
    117       1.1        pk #include <machine/bus.h>
    118       1.1        pk 
    119       1.1        pk #include <sys/audioio.h>
    120       1.1        pk 
    121       1.1        pk #include <dev/audio_if.h>
    122       1.1        pk #include <dev/auconv.h>
    123       1.1        pk 
    124       1.1        pk #include <dev/ic/ad1848reg.h>
    125       1.1        pk #include <dev/ic/cs4231reg.h>
    126       1.6        rh #include <dev/ic/cs4237reg.h>
    127       1.1        pk #include <dev/ic/ad1848var.h>
    128       1.1        pk #if 0
    129       1.1        pk #include <dev/isa/cs4231var.h>
    130       1.1        pk #endif
    131       1.1        pk 
    132      1.11     itohy /*
    133      1.11     itohy  * AD1845 on some machines don't match the AD1845 doc
    134      1.11     itohy  * and defining AD1845_HACK to 1 works around the problems.
    135      1.11     itohy  * options AD1845_HACK=0  should work if you have ``correct'' one.
    136      1.11     itohy  */
    137      1.11     itohy #ifndef AD1845_HACK
    138      1.11     itohy #define AD1845_HACK	1	/* weird mixer, can't play slinear_be */
    139      1.11     itohy #endif
    140      1.11     itohy 
    141       1.1        pk #ifdef AUDIO_DEBUG
    142       1.1        pk #define DPRINTF(x)	if (ad1848debug) printf x
    143       1.2        pk int	ad1848debug = 0;
    144       1.1        pk #else
    145       1.1        pk #define DPRINTF(x)
    146       1.1        pk #endif
    147       1.1        pk 
    148       1.1        pk /*
    149       1.1        pk  * Initial values for the indirect registers of CS4248/AD1848.
    150       1.1        pk  */
    151      1.10  jdolecek static const int ad1848_init_values[] = {
    152       1.1        pk     GAIN_12|INPUT_MIC_GAIN_ENABLE,	/* Left Input Control */
    153       1.1        pk     GAIN_12|INPUT_MIC_GAIN_ENABLE,	/* Right Input Control */
    154       1.1        pk     ATTEN_12,				/* Left Aux #1 Input Control */
    155       1.1        pk     ATTEN_12,				/* Right Aux #1 Input Control */
    156       1.1        pk     ATTEN_12,				/* Left Aux #2 Input Control */
    157       1.1        pk     ATTEN_12,				/* Right Aux #2 Input Control */
    158       1.1        pk     /* bits 5-0 are attenuation select */
    159       1.1        pk     ATTEN_12,				/* Left DAC output Control */
    160       1.1        pk     ATTEN_12,				/* Right DAC output Control */
    161       1.1        pk     CLOCK_XTAL1|FMT_PCM8,		/* Clock and Data Format */
    162       1.1        pk     SINGLE_DMA|AUTO_CAL_ENABLE,		/* Interface Config */
    163       1.1        pk     INTERRUPT_ENABLE,			/* Pin control */
    164       1.1        pk     0x00,				/* Test and Init */
    165       1.1        pk     MODE2,				/* Misc control */
    166       1.1        pk     ATTEN_0<<2,				/* Digital Mix Control */
    167       1.1        pk     0,					/* Upper base Count */
    168       1.1        pk     0,					/* Lower base Count */
    169       1.1        pk 
    170       1.1        pk     /* These are for CS4231 &c. only (additional registers): */
    171       1.1        pk     0,					/* Alt feature 1 */
    172       1.1        pk     0,					/* Alt feature 2 */
    173       1.1        pk     ATTEN_12,				/* Left line in */
    174       1.1        pk     ATTEN_12,				/* Right line in */
    175       1.1        pk     0,					/* Timer low */
    176       1.1        pk     0,					/* Timer high */
    177       1.1        pk     0,					/* unused */
    178       1.1        pk     0,					/* unused */
    179       1.1        pk     0,					/* IRQ status */
    180       1.1        pk     0,					/* unused */
    181       1.1        pk 			/* Mono input (a.k.a speaker) (mic) Control */
    182       1.1        pk     MONO_INPUT_MUTE|ATTEN_6,		/* mute speaker by default */
    183       1.1        pk     0,					/* unused */
    184       1.1        pk     0,					/* record format */
    185       1.1        pk     0,					/* Crystal Clock Select */
    186       1.1        pk     0,					/* upper record count */
    187       1.1        pk     0					/* lower record count */
    188       1.1        pk };
    189       1.1        pk 
    190       1.1        pk 
    191       1.1        pk int
    192      1.18   thorpej ad1848_to_vol(mixer_ctrl_t *cp, struct ad1848_volume *vol)
    193       1.1        pk {
    194      1.20      kent 
    195       1.1        pk 	if (cp->un.value.num_channels == 1) {
    196       1.1        pk 		vol->left =
    197       1.1        pk 		vol->right = cp->un.value.level[AUDIO_MIXER_LEVEL_MONO];
    198      1.20      kent 		return 1;
    199       1.1        pk 	}
    200       1.1        pk 	else if (cp->un.value.num_channels == 2) {
    201       1.1        pk 		vol->left  = cp->un.value.level[AUDIO_MIXER_LEVEL_LEFT];
    202       1.1        pk 		vol->right = cp->un.value.level[AUDIO_MIXER_LEVEL_RIGHT];
    203      1.20      kent 		return 1;
    204       1.1        pk 	}
    205      1.20      kent 	return 0;
    206       1.1        pk }
    207       1.1        pk 
    208       1.1        pk int
    209      1.18   thorpej ad1848_from_vol(mixer_ctrl_t *cp, struct ad1848_volume *vol)
    210       1.1        pk {
    211      1.20      kent 
    212       1.1        pk 	if (cp->un.value.num_channels == 1) {
    213       1.1        pk 		cp->un.value.level[AUDIO_MIXER_LEVEL_MONO] = vol->left;
    214      1.20      kent 		return 1;
    215       1.1        pk 	}
    216       1.1        pk 	else if (cp->un.value.num_channels == 2) {
    217       1.1        pk 		cp->un.value.level[AUDIO_MIXER_LEVEL_LEFT] = vol->left;
    218       1.1        pk 		cp->un.value.level[AUDIO_MIXER_LEVEL_RIGHT] = vol->right;
    219      1.20      kent 		return 1;
    220       1.1        pk 	}
    221      1.20      kent 	return 0;
    222       1.1        pk }
    223       1.1        pk 
    224       1.1        pk 
    225      1.22     perry inline int
    226      1.18   thorpej ad_read(struct ad1848_softc *sc, int reg)
    227       1.1        pk {
    228       1.1        pk 	int x;
    229       1.1        pk 
    230       1.1        pk 	ADWRITE(sc, AD1848_IADDR, (reg & 0xff) | sc->MCE_bit);
    231       1.1        pk 	x = ADREAD(sc, AD1848_IDATA);
    232       1.1        pk 	/*  printf("(%02x<-%02x) ", reg|sc->MCE_bit, x); */
    233       1.1        pk 	return x;
    234       1.1        pk }
    235       1.1        pk 
    236      1.22     perry inline void
    237      1.18   thorpej ad_write(struct ad1848_softc *sc, int reg, int data)
    238       1.1        pk {
    239      1.20      kent 
    240       1.1        pk 	ADWRITE(sc, AD1848_IADDR, (reg & 0xff) | sc->MCE_bit);
    241       1.1        pk 	ADWRITE(sc, AD1848_IDATA, data & 0xff);
    242       1.1        pk 	/* printf("(%02x->%02x) ", reg|sc->MCE_bit, data); */
    243       1.1        pk }
    244       1.1        pk 
    245       1.6        rh /*
    246       1.6        rh  * extended registers (mode 3) require an additional level of
    247       1.6        rh  * indirection through CS_XREG (I23).
    248       1.6        rh  */
    249       1.6        rh 
    250      1.22     perry inline int
    251      1.18   thorpej ad_xread(struct ad1848_softc *sc, int reg)
    252       1.6        rh {
    253       1.6        rh 	int x;
    254       1.6        rh 
    255       1.6        rh 	ADWRITE(sc, AD1848_IADDR, CS_XREG | sc->MCE_bit);
    256       1.6        rh 	ADWRITE(sc, AD1848_IDATA, (reg | ALT_F3_XRAE) & 0xff);
    257       1.6        rh 	x = ADREAD(sc, AD1848_IDATA);
    258       1.6        rh 
    259       1.6        rh 	return x;
    260       1.6        rh }
    261       1.6        rh 
    262      1.22     perry inline void
    263      1.18   thorpej ad_xwrite(struct ad1848_softc *sc, int reg, int val)
    264       1.6        rh {
    265      1.20      kent 
    266       1.6        rh 	ADWRITE(sc, AD1848_IADDR, CS_XREG | sc->MCE_bit);
    267       1.6        rh 	ADWRITE(sc, AD1848_IDATA, (reg | ALT_F3_XRAE) & 0xff);
    268       1.6        rh 	ADWRITE(sc, AD1848_IDATA, val & 0xff);
    269       1.6        rh }
    270       1.6        rh 
    271       1.1        pk static void
    272      1.18   thorpej ad_set_MCE(struct ad1848_softc *sc, int state)
    273       1.1        pk {
    274      1.20      kent 
    275       1.1        pk 	if (state)
    276       1.1        pk 		sc->MCE_bit = MODE_CHANGE_ENABLE;
    277       1.1        pk 	else
    278       1.1        pk 		sc->MCE_bit = 0;
    279       1.1        pk 	ADWRITE(sc, AD1848_IADDR, sc->MCE_bit);
    280       1.1        pk }
    281       1.1        pk 
    282       1.1        pk static void
    283      1.18   thorpej wait_for_calibration(struct ad1848_softc *sc)
    284       1.1        pk {
    285       1.1        pk 	int timeout;
    286       1.1        pk 
    287       1.1        pk 	DPRINTF(("ad1848: Auto calibration started.\n"));
    288       1.1        pk 	/*
    289       1.1        pk 	 * Wait until the auto calibration process has finished.
    290       1.1        pk 	 *
    291       1.1        pk 	 * 1) Wait until the chip becomes ready (reads don't return 0x80).
    292       1.1        pk 	 * 2) Wait until the ACI bit of I11 gets on and then off.
    293       1.1        pk 	 *    Because newer chips are fast we may never see the ACI
    294       1.1        pk 	 *    bit go on.  Just delay a little instead.
    295       1.1        pk 	 */
    296       1.1        pk 	timeout = 10000;
    297       1.1        pk 	while (timeout > 0 && ADREAD(sc, AD1848_IADDR) == SP_IN_INIT) {
    298       1.1        pk 		delay(10);
    299       1.1        pk 		timeout--;
    300       1.1        pk 	}
    301      1.23  christos 	if (timeout <= 0) {
    302       1.1        pk 		DPRINTF(("ad1848: Auto calibration timed out(1).\n"));
    303      1.23  christos 	}
    304       1.1        pk 
    305       1.1        pk 	/* Set register addr */
    306       1.1        pk 	ADWRITE(sc, AD1848_IADDR, SP_TEST_AND_INIT);
    307       1.1        pk 	/* Wait for address to appear when read back. */
    308       1.1        pk 	timeout = 100000;
    309       1.1        pk 	while (timeout > 0 &&
    310       1.1        pk 	       (ADREAD(sc, AD1848_IADDR)&SP_IADDR_MASK) != SP_TEST_AND_INIT) {
    311       1.1        pk 		delay(10);
    312       1.1        pk 		timeout--;
    313       1.1        pk 	}
    314      1.23  christos 	if (timeout <= 0) {
    315       1.1        pk 		DPRINTF(("ad1848: Auto calibration timed out(1.5).\n"));
    316      1.23  christos 	}
    317       1.1        pk 
    318       1.1        pk 	if (!(ad_read(sc, SP_TEST_AND_INIT) & AUTO_CAL_IN_PROG)) {
    319       1.1        pk 		if (sc->mode > 1) {
    320       1.1        pk 			/* A new chip, just delay a little. */
    321      1.20      kent 			delay(100);	/* XXX what should it be? */
    322       1.1        pk 		} else {
    323       1.1        pk 			timeout = 10000;
    324       1.1        pk 			while (timeout > 0 &&
    325       1.1        pk 			       !(ad_read(sc, SP_TEST_AND_INIT) &
    326       1.1        pk 				 AUTO_CAL_IN_PROG)) {
    327       1.1        pk 				delay(10);
    328       1.1        pk 				timeout--;
    329       1.1        pk 			}
    330      1.23  christos 			if (timeout <= 0) {
    331       1.1        pk 				DPRINTF(("ad1848: Auto calibration timed out(2).\n"));
    332      1.23  christos 			}
    333       1.1        pk 		}
    334       1.1        pk 	}
    335       1.1        pk 
    336       1.1        pk 	timeout = 10000;
    337       1.1        pk 	while (timeout > 0 &&
    338       1.1        pk 	       ad_read(sc, SP_TEST_AND_INIT) & AUTO_CAL_IN_PROG) {
    339       1.1        pk 		delay(10);
    340       1.1        pk 		timeout--;
    341       1.1        pk 	}
    342      1.23  christos 	if (timeout <= 0) {
    343       1.1        pk 		DPRINTF(("ad1848: Auto calibration timed out(3).\n"));
    344      1.23  christos 	}
    345       1.1        pk }
    346       1.1        pk 
    347       1.1        pk #ifdef AUDIO_DEBUG
    348       1.1        pk void
    349      1.18   thorpej ad1848_dump_regs(struct ad1848_softc *sc)
    350       1.1        pk {
    351       1.1        pk 	int i;
    352       1.1        pk 	u_char r;
    353       1.1        pk 
    354       1.1        pk 	printf("ad1848 status=%02x", ADREAD(sc, AD1848_STATUS));
    355       1.1        pk 	printf(" regs: ");
    356       1.1        pk 	for (i = 0; i < 16; i++) {
    357       1.1        pk 		r = ad_read(sc, i);
    358       1.1        pk 		printf("%02x ", r);
    359       1.1        pk 	}
    360       1.6        rh 	if (sc->mode >= 2) {
    361       1.1        pk 		for (i = 16; i < 32; i++) {
    362       1.1        pk 			r = ad_read(sc, i);
    363       1.1        pk 			printf("%02x ", r);
    364       1.1        pk 		}
    365       1.1        pk 	}
    366       1.1        pk 	printf("\n");
    367       1.1        pk }
    368      1.18   thorpej #endif /* AUDIO_DEBUG */
    369       1.1        pk 
    370       1.1        pk 
    371       1.1        pk /*
    372       1.1        pk  * Attach hardware to driver, attach hardware driver to audio
    373       1.1        pk  * pseudo-device driver .
    374       1.1        pk  */
    375       1.1        pk void
    376      1.18   thorpej ad1848_attach(struct ad1848_softc *sc)
    377       1.1        pk {
    378       1.1        pk 	static struct ad1848_volume vol_mid = {220, 220};
    379       1.1        pk 	static struct ad1848_volume vol_0   = {0, 0};
    380      1.20      kent 	int i;
    381       1.1        pk 	int timeout;
    382       1.1        pk 
    383       1.1        pk 	/* Initialize the ad1848... */
    384       1.1        pk 	for (i = 0; i < 0x10; i++) {
    385       1.1        pk 		ad_write(sc, i, ad1848_init_values[i]);
    386       1.1        pk 		timeout = 100000;
    387       1.7     itohy 		while (timeout > 0 && ADREAD(sc, AD1848_IADDR) & SP_IN_INIT)
    388       1.1        pk 			timeout--;
    389       1.1        pk 	}
    390       1.1        pk 	/* ...and additional CS4231 stuff too */
    391       1.6        rh 	if (sc->mode >= 2) {
    392       1.1        pk 		ad_write(sc, SP_INTERFACE_CONFIG, 0); /* disable SINGLE_DMA */
    393       1.1        pk 		for (i = 0x10; i < 0x20; i++)
    394       1.1        pk 			if (ad1848_init_values[i] != 0) {
    395       1.1        pk 				ad_write(sc, i, ad1848_init_values[i]);
    396       1.1        pk 				timeout = 100000;
    397       1.1        pk 				while (timeout > 0 &&
    398       1.7     itohy 				       ADREAD(sc, AD1848_IADDR) & SP_IN_INIT)
    399       1.1        pk 					timeout--;
    400       1.1        pk 			}
    401       1.1        pk 	}
    402       1.1        pk 	ad1848_reset(sc);
    403       1.1        pk 
    404       1.1        pk 	/* Set default gains */
    405       1.1        pk 	ad1848_set_rec_gain(sc, &vol_mid);
    406       1.1        pk 	ad1848_set_channel_gain(sc, AD1848_DAC_CHANNEL, &vol_mid);
    407       1.1        pk 	ad1848_set_channel_gain(sc, AD1848_MONITOR_CHANNEL, &vol_0);
    408       1.1        pk 	ad1848_set_channel_gain(sc, AD1848_AUX1_CHANNEL, &vol_mid);	/* CD volume */
    409       1.7     itohy 	sc->mute[AD1848_MONITOR_CHANNEL] = MUTE_ALL;
    410      1.11     itohy 	if (sc->mode >= 2
    411      1.11     itohy #if AD1845_HACK
    412      1.11     itohy 	    && sc->is_ad1845 == 0
    413      1.11     itohy #endif
    414      1.11     itohy 		) {
    415       1.1        pk 		ad1848_set_channel_gain(sc, AD1848_AUX2_CHANNEL, &vol_mid); /* CD volume */
    416       1.1        pk 		ad1848_set_channel_gain(sc, AD1848_LINE_CHANNEL, &vol_mid);
    417       1.1        pk 		ad1848_set_channel_gain(sc, AD1848_MONO_CHANNEL, &vol_0);
    418       1.1        pk 		sc->mute[AD1848_MONO_CHANNEL] = MUTE_ALL;
    419       1.1        pk 	} else
    420       1.1        pk 		ad1848_set_channel_gain(sc, AD1848_AUX2_CHANNEL, &vol_0);
    421       1.1        pk 
    422       1.1        pk 	/* Set default port */
    423       1.1        pk 	ad1848_set_rec_port(sc, MIC_IN_PORT);
    424       1.1        pk 
    425       1.1        pk 	printf(": %s", sc->chip_name);
    426       1.1        pk }
    427       1.1        pk 
    428       1.1        pk /*
    429       1.1        pk  * Various routines to interface to higher level audio driver
    430       1.1        pk  */
    431      1.18   thorpej static const struct ad1848_mixerinfo {
    432       1.1        pk 	int  left_reg;
    433       1.1        pk 	int  right_reg;
    434       1.1        pk 	int  atten_bits;
    435       1.1        pk 	int  atten_mask;
    436       1.1        pk } mixer_channel_info[] =
    437       1.1        pk {
    438       1.1        pk   { SP_LEFT_AUX2_CONTROL, SP_RIGHT_AUX2_CONTROL, AUX_INPUT_ATTEN_BITS,
    439       1.1        pk     AUX_INPUT_ATTEN_MASK },
    440       1.1        pk   { SP_LEFT_AUX1_CONTROL, SP_RIGHT_AUX1_CONTROL, AUX_INPUT_ATTEN_BITS,
    441       1.1        pk     AUX_INPUT_ATTEN_MASK },
    442       1.1        pk   { SP_LEFT_OUTPUT_CONTROL, SP_RIGHT_OUTPUT_CONTROL,
    443       1.1        pk     OUTPUT_ATTEN_BITS, OUTPUT_ATTEN_MASK },
    444       1.1        pk   { CS_LEFT_LINE_CONTROL, CS_RIGHT_LINE_CONTROL, LINE_INPUT_ATTEN_BITS,
    445       1.1        pk     LINE_INPUT_ATTEN_MASK },
    446       1.1        pk   { CS_MONO_IO_CONTROL, 0, MONO_INPUT_ATTEN_BITS, MONO_INPUT_ATTEN_MASK },
    447      1.15    martin   { CS_MONO_IO_CONTROL, 0, 0, 0 },
    448       1.1        pk   { SP_DIGITAL_MIX, 0, OUTPUT_ATTEN_BITS, MIX_ATTEN_MASK }
    449       1.1        pk };
    450       1.1        pk 
    451       1.1        pk /*
    452       1.1        pk  *  This function doesn't set the mute flags but does use them.
    453       1.1        pk  *  The mute flags reflect the mutes that have been applied by the user.
    454       1.1        pk  *  However, the driver occasionally wants to mute devices (e.g. when chaing
    455       1.1        pk  *  sampling rate). These operations should not affect the mute flags.
    456       1.1        pk  */
    457       1.1        pk 
    458       1.1        pk void
    459      1.18   thorpej ad1848_mute_channel(struct ad1848_softc *sc, int device, int mute)
    460       1.1        pk {
    461       1.1        pk 	u_char reg;
    462       1.1        pk 
    463       1.1        pk 	reg = ad_read(sc, mixer_channel_info[device].left_reg);
    464       1.1        pk 
    465       1.1        pk 	if (mute & MUTE_LEFT) {
    466       1.7     itohy 		if (device == AD1848_MONITOR_CHANNEL) {
    467       1.7     itohy 			if (sc->open_mode & FREAD)
    468       1.7     itohy 				ad1848_mute_wave_output(sc, WAVE_UNMUTE1, 0);
    469       1.1        pk 			ad_write(sc, mixer_channel_info[device].left_reg,
    470       1.7     itohy 				 reg & ~DIGITAL_MIX1_ENABLE);
    471      1.15    martin 		} else if (device == AD1848_OUT_CHANNEL)
    472      1.15    martin 			ad_write(sc, mixer_channel_info[device].left_reg,
    473      1.15    martin 				 reg | MONO_OUTPUT_MUTE);
    474      1.15    martin 		else
    475       1.1        pk 			ad_write(sc, mixer_channel_info[device].left_reg,
    476       1.1        pk 				 reg | 0x80);
    477       1.1        pk 	} else if (!(sc->mute[device] & MUTE_LEFT)) {
    478       1.7     itohy 		if (device == AD1848_MONITOR_CHANNEL) {
    479       1.1        pk 			ad_write(sc, mixer_channel_info[device].left_reg,
    480       1.7     itohy 				 reg | DIGITAL_MIX1_ENABLE);
    481       1.7     itohy 			if (sc->open_mode & FREAD)
    482       1.7     itohy 				ad1848_mute_wave_output(sc, WAVE_UNMUTE1, 1);
    483      1.15    martin 		} else if (device == AD1848_OUT_CHANNEL)
    484      1.15    martin 			ad_write(sc, mixer_channel_info[device].left_reg,
    485      1.15    martin 				 reg & ~MONO_OUTPUT_MUTE);
    486      1.15    martin 		else
    487       1.1        pk 			ad_write(sc, mixer_channel_info[device].left_reg,
    488       1.1        pk 				 reg & ~0x80);
    489       1.1        pk 	}
    490       1.1        pk 
    491       1.1        pk 	if (!mixer_channel_info[device].right_reg)
    492       1.1        pk 		return;
    493       1.1        pk 
    494       1.1        pk 	reg = ad_read(sc, mixer_channel_info[device].right_reg);
    495       1.1        pk 
    496       1.1        pk 	if (mute & MUTE_RIGHT) {
    497       1.1        pk 		ad_write(sc, mixer_channel_info[device].right_reg, reg | 0x80);
    498       1.1        pk 	} else if (!(sc->mute[device] & MUTE_RIGHT)) {
    499       1.1        pk 		ad_write(sc, mixer_channel_info[device].right_reg, reg &~0x80);
    500       1.1        pk 	}
    501       1.1        pk }
    502       1.1        pk 
    503       1.1        pk int
    504      1.18   thorpej ad1848_set_channel_gain(struct ad1848_softc *sc, int device,
    505      1.18   thorpej     struct ad1848_volume *gp)
    506       1.1        pk {
    507      1.20      kent 	const struct ad1848_mixerinfo *info;
    508       1.1        pk 	u_char reg;
    509       1.1        pk 	u_int atten;
    510       1.1        pk 
    511      1.20      kent 	info = &mixer_channel_info[device];
    512       1.1        pk 	sc->gains[device] = *gp;
    513       1.1        pk 
    514       1.7     itohy 	atten = (AUDIO_MAX_GAIN - gp->left) * (info->atten_bits + 1) /
    515       1.7     itohy 		(AUDIO_MAX_GAIN + 1);
    516       1.1        pk 
    517       1.1        pk 	reg = ad_read(sc, info->left_reg) & (info->atten_mask);
    518       1.1        pk 	if (device == AD1848_MONITOR_CHANNEL)
    519       1.1        pk 		reg |= ((atten & info->atten_bits) << 2);
    520       1.1        pk 	else
    521       1.1        pk 		reg |= ((atten & info->atten_bits));
    522       1.1        pk 
    523       1.1        pk 	ad_write(sc, info->left_reg, reg);
    524       1.1        pk 
    525       1.1        pk 	if (!info->right_reg)
    526      1.20      kent 		return 0;
    527       1.1        pk 
    528       1.7     itohy 	atten = (AUDIO_MAX_GAIN - gp->right) * (info->atten_bits + 1) /
    529       1.7     itohy 		(AUDIO_MAX_GAIN + 1);
    530       1.1        pk 	reg = ad_read(sc, info->right_reg);
    531       1.1        pk 	reg &= info->atten_mask;
    532       1.1        pk 	ad_write(sc, info->right_reg, (atten & info->atten_bits) | reg);
    533       1.1        pk 
    534      1.20      kent 	return 0;
    535       1.1        pk }
    536       1.1        pk 
    537       1.1        pk int
    538      1.18   thorpej ad1848_get_device_gain(struct ad1848_softc *sc, int device,
    539      1.18   thorpej     struct ad1848_volume *gp)
    540       1.1        pk {
    541      1.20      kent 
    542       1.1        pk 	*gp = sc->gains[device];
    543      1.20      kent 	return 0;
    544       1.1        pk }
    545       1.1        pk 
    546       1.1        pk int
    547      1.18   thorpej ad1848_get_rec_gain(struct ad1848_softc *sc, struct ad1848_volume *gp)
    548       1.1        pk {
    549      1.20      kent 
    550       1.1        pk 	*gp = sc->rec_gain;
    551      1.20      kent 	return 0;
    552       1.1        pk }
    553       1.1        pk 
    554       1.1        pk int
    555      1.18   thorpej ad1848_set_rec_gain(struct ad1848_softc *sc, struct ad1848_volume *gp)
    556       1.1        pk {
    557       1.1        pk 	u_char reg, gain;
    558       1.1        pk 
    559       1.1        pk 	DPRINTF(("ad1848_set_rec_gain: %d:%d\n", gp->left, gp->right));
    560       1.1        pk 
    561       1.1        pk 	sc->rec_gain = *gp;
    562       1.1        pk 
    563       1.7     itohy 	gain = (gp->left * (GAIN_22_5 + 1)) / (AUDIO_MAX_GAIN + 1);
    564       1.1        pk 	reg = ad_read(sc, SP_LEFT_INPUT_CONTROL);
    565       1.1        pk 	reg &= INPUT_GAIN_MASK;
    566       1.1        pk 	ad_write(sc, SP_LEFT_INPUT_CONTROL, (gain & 0x0f) | reg);
    567       1.1        pk 
    568       1.7     itohy 	gain = (gp->right * (GAIN_22_5 + 1)) / (AUDIO_MAX_GAIN + 1);
    569       1.1        pk 	reg = ad_read(sc, SP_RIGHT_INPUT_CONTROL);
    570       1.1        pk 	reg &= INPUT_GAIN_MASK;
    571       1.1        pk 	ad_write(sc, SP_RIGHT_INPUT_CONTROL, (gain & 0x0f) | reg);
    572       1.1        pk 
    573      1.20      kent 	return 0;
    574       1.1        pk }
    575       1.1        pk 
    576       1.1        pk void
    577      1.18   thorpej ad1848_mute_wave_output(struct ad1848_softc *sc, int mute, int set)
    578       1.1        pk {
    579       1.7     itohy 	int m;
    580       1.7     itohy 
    581       1.7     itohy 	DPRINTF(("ad1848_mute_wave_output: %d, %d\n", mute, set));
    582       1.1        pk 
    583       1.7     itohy 	if (mute == WAVE_MUTE2_INIT) {
    584       1.7     itohy 		sc->wave_mute_status = 0;
    585       1.7     itohy 		mute = WAVE_MUTE2;
    586       1.1        pk 	}
    587       1.7     itohy 	if (set)
    588       1.7     itohy 		m = sc->wave_mute_status |= mute;
    589       1.7     itohy 	else
    590       1.7     itohy 		m = sc->wave_mute_status &= ~mute;
    591       1.1        pk 
    592       1.7     itohy 	if (m & WAVE_MUTE0 || ((m & WAVE_UNMUTE1) == 0 && m & WAVE_MUTE2))
    593       1.7     itohy 		ad1848_mute_channel(sc, AD1848_DAC_CHANNEL, MUTE_ALL);
    594       1.7     itohy 	else
    595       1.7     itohy 		ad1848_mute_channel(sc, AD1848_DAC_CHANNEL,
    596       1.7     itohy 					    sc->mute[AD1848_DAC_CHANNEL]);
    597       1.1        pk }
    598       1.1        pk 
    599       1.1        pk int
    600      1.18   thorpej ad1848_set_mic_gain(struct ad1848_softc *sc, struct ad1848_volume *gp)
    601       1.1        pk {
    602       1.1        pk 	u_char reg;
    603       1.1        pk 
    604       1.1        pk 	DPRINTF(("cs4231_set_mic_gain: %d\n", gp->left));
    605       1.1        pk 
    606       1.1        pk 	if (gp->left > AUDIO_MAX_GAIN/2) {
    607       1.1        pk 		sc->mic_gain_on = 1;
    608       1.1        pk 		reg = ad_read(sc, SP_LEFT_INPUT_CONTROL);
    609       1.1        pk 		ad_write(sc, SP_LEFT_INPUT_CONTROL,
    610       1.1        pk 			 reg | INPUT_MIC_GAIN_ENABLE);
    611       1.1        pk 	} else {
    612       1.1        pk 		sc->mic_gain_on = 0;
    613       1.1        pk 		reg = ad_read(sc, SP_LEFT_INPUT_CONTROL);
    614       1.1        pk 		ad_write(sc, SP_LEFT_INPUT_CONTROL,
    615       1.1        pk 			 reg & ~INPUT_MIC_GAIN_ENABLE);
    616       1.1        pk 	}
    617       1.1        pk 
    618      1.20      kent 	return 0;
    619       1.1        pk }
    620       1.1        pk 
    621       1.1        pk int
    622      1.18   thorpej ad1848_get_mic_gain(struct ad1848_softc *sc, struct ad1848_volume *gp)
    623       1.1        pk {
    624       1.1        pk 	if (sc->mic_gain_on)
    625       1.1        pk 		gp->left = gp->right = AUDIO_MAX_GAIN;
    626       1.1        pk 	else
    627       1.1        pk 		gp->left = gp->right = AUDIO_MIN_GAIN;
    628      1.20      kent 	return 0;
    629       1.1        pk }
    630       1.1        pk 
    631       1.1        pk static ad1848_devmap_t *
    632      1.18   thorpej ad1848_mixer_find_dev(ad1848_devmap_t *map, int cnt, mixer_ctrl_t *cp)
    633       1.1        pk {
    634       1.1        pk 	int i;
    635       1.1        pk 
    636       1.1        pk 	for (i = 0; i < cnt; i++) {
    637       1.1        pk 		if (map[i].id == cp->dev) {
    638       1.1        pk 			return (&map[i]);
    639       1.1        pk 		}
    640       1.1        pk 	}
    641      1.20      kent 	return 0;
    642       1.1        pk }
    643       1.1        pk 
    644       1.1        pk int
    645      1.18   thorpej ad1848_mixer_get_port(struct ad1848_softc *ac, struct ad1848_devmap *map,
    646      1.18   thorpej     int cnt, mixer_ctrl_t *cp)
    647       1.1        pk {
    648       1.1        pk 	ad1848_devmap_t *entry;
    649       1.1        pk 	struct ad1848_volume vol;
    650      1.20      kent 	int error;
    651       1.1        pk 	int dev;
    652       1.1        pk 
    653      1.20      kent 	error = EINVAL;
    654       1.1        pk 	if (!(entry = ad1848_mixer_find_dev(map, cnt, cp)))
    655      1.20      kent 		return ENXIO;
    656       1.1        pk 
    657       1.1        pk 	dev = entry->dev;
    658       1.1        pk 
    659       1.1        pk 	switch (entry->kind) {
    660       1.1        pk 	case AD1848_KIND_LVL:
    661       1.1        pk 		if (cp->type != AUDIO_MIXER_VALUE)
    662       1.1        pk 			break;
    663       1.1        pk 
    664       1.1        pk 		if (dev < AD1848_AUX2_CHANNEL ||
    665       1.1        pk 		    dev > AD1848_MONITOR_CHANNEL)
    666       1.1        pk 			break;
    667       1.1        pk 
    668       1.1        pk 		if (cp->un.value.num_channels != 1 &&
    669       1.1        pk 		    mixer_channel_info[dev].right_reg == 0)
    670       1.1        pk 			break;
    671       1.1        pk 
    672       1.1        pk 		error = ad1848_get_device_gain(ac, dev, &vol);
    673       1.1        pk 		if (!error)
    674       1.1        pk 			ad1848_from_vol(cp, &vol);
    675       1.1        pk 
    676       1.1        pk 		break;
    677       1.1        pk 
    678       1.1        pk 	case AD1848_KIND_MUTE:
    679       1.1        pk 		if (cp->type != AUDIO_MIXER_ENUM) break;
    680       1.1        pk 
    681       1.1        pk 		cp->un.ord = ac->mute[dev] ? 1 : 0;
    682       1.1        pk 		error = 0;
    683       1.1        pk 		break;
    684       1.1        pk 
    685       1.1        pk 	case AD1848_KIND_RECORDGAIN:
    686       1.1        pk 		if (cp->type != AUDIO_MIXER_VALUE) break;
    687       1.1        pk 
    688       1.1        pk 		error = ad1848_get_rec_gain(ac, &vol);
    689       1.1        pk 		if (!error)
    690       1.1        pk 			ad1848_from_vol(cp, &vol);
    691       1.1        pk 
    692       1.1        pk 		break;
    693       1.1        pk 
    694       1.1        pk 	case AD1848_KIND_MICGAIN:
    695       1.1        pk 		if (cp->type != AUDIO_MIXER_VALUE) break;
    696       1.1        pk 
    697       1.1        pk 		error = ad1848_get_mic_gain(ac, &vol);
    698       1.1        pk 		if (!error)
    699       1.1        pk 			ad1848_from_vol(cp, &vol);
    700       1.1        pk 
    701       1.1        pk 		break;
    702       1.1        pk 
    703       1.1        pk 	case AD1848_KIND_RECORDSOURCE:
    704       1.1        pk 		if (cp->type != AUDIO_MIXER_ENUM) break;
    705       1.1        pk 		cp->un.ord = ad1848_get_rec_port(ac);
    706       1.1        pk 		error = 0;
    707       1.1        pk 		break;
    708       1.1        pk 
    709       1.1        pk 	default:
    710       1.1        pk 		printf ("Invalid kind\n");
    711       1.1        pk 		break;
    712       1.1        pk 	}
    713       1.1        pk 
    714      1.20      kent 	return error;
    715       1.1        pk }
    716       1.1        pk 
    717       1.1        pk int
    718      1.18   thorpej ad1848_mixer_set_port(struct ad1848_softc *ac, struct ad1848_devmap *map,
    719      1.18   thorpej     int cnt, mixer_ctrl_t *cp)
    720       1.1        pk {
    721       1.1        pk 	ad1848_devmap_t *entry;
    722       1.1        pk 	struct ad1848_volume vol;
    723      1.20      kent 	int error;
    724       1.1        pk 	int dev;
    725       1.1        pk 
    726      1.20      kent 	error = EINVAL;
    727       1.1        pk 	if (!(entry = ad1848_mixer_find_dev(map, cnt, cp)))
    728      1.20      kent 		return ENXIO;
    729       1.1        pk 
    730       1.1        pk 	dev = entry->dev;
    731       1.1        pk 
    732       1.1        pk 	switch (entry->kind) {
    733       1.1        pk 	case AD1848_KIND_LVL:
    734       1.1        pk 		if (cp->type != AUDIO_MIXER_VALUE)
    735       1.1        pk 			break;
    736       1.1        pk 
    737       1.1        pk 		if (dev < AD1848_AUX2_CHANNEL ||
    738       1.1        pk 		    dev > AD1848_MONITOR_CHANNEL)
    739       1.1        pk 			break;
    740       1.1        pk 
    741       1.1        pk 		if (cp->un.value.num_channels != 1 &&
    742       1.1        pk 		    mixer_channel_info[dev].right_reg == 0)
    743       1.1        pk 			break;
    744       1.1        pk 
    745       1.1        pk 		ad1848_to_vol(cp, &vol);
    746       1.1        pk 		error = ad1848_set_channel_gain(ac, dev, &vol);
    747       1.1        pk 		break;
    748       1.1        pk 
    749       1.1        pk 	case AD1848_KIND_MUTE:
    750       1.1        pk 		if (cp->type != AUDIO_MIXER_ENUM) break;
    751       1.1        pk 
    752       1.1        pk 		ac->mute[dev] = (cp->un.ord ? MUTE_ALL : 0);
    753       1.1        pk 		ad1848_mute_channel(ac, dev, ac->mute[dev]);
    754       1.1        pk 		error = 0;
    755       1.1        pk 		break;
    756       1.1        pk 
    757       1.1        pk 	case AD1848_KIND_RECORDGAIN:
    758       1.1        pk 		if (cp->type != AUDIO_MIXER_VALUE) break;
    759       1.1        pk 
    760       1.1        pk 		ad1848_to_vol(cp, &vol);
    761       1.1        pk 		error = ad1848_set_rec_gain(ac, &vol);
    762       1.1        pk 		break;
    763       1.1        pk 
    764       1.1        pk 	case AD1848_KIND_MICGAIN:
    765       1.1        pk 		if (cp->type != AUDIO_MIXER_VALUE) break;
    766       1.1        pk 
    767       1.1        pk 		ad1848_to_vol(cp, &vol);
    768       1.1        pk 		error = ad1848_set_mic_gain(ac, &vol);
    769       1.1        pk 		break;
    770       1.1        pk 
    771       1.1        pk 	case AD1848_KIND_RECORDSOURCE:
    772       1.1        pk 		if (cp->type != AUDIO_MIXER_ENUM) break;
    773       1.1        pk 
    774       1.1        pk 		error = ad1848_set_rec_port(ac,  cp->un.ord);
    775       1.1        pk 		break;
    776       1.1        pk 
    777       1.1        pk 	default:
    778       1.1        pk 		printf ("Invalid kind\n");
    779       1.1        pk 		break;
    780       1.1        pk 	}
    781       1.1        pk 
    782      1.20      kent 	return error;
    783       1.1        pk }
    784       1.1        pk 
    785       1.1        pk int
    786      1.18   thorpej ad1848_query_encoding(void *addr, struct audio_encoding *fp)
    787       1.1        pk {
    788      1.20      kent 	struct ad1848_softc *sc;
    789       1.1        pk 
    790      1.20      kent 	sc = addr;
    791       1.1        pk 	switch (fp->index) {
    792       1.1        pk 	case 0:
    793       1.1        pk 		strcpy(fp->name, AudioEmulaw);
    794       1.1        pk 		fp->encoding = AUDIO_ENCODING_ULAW;
    795       1.1        pk 		fp->precision = 8;
    796       1.1        pk 		fp->flags = 0;
    797       1.1        pk 		break;
    798       1.1        pk 	case 1:
    799       1.1        pk 		strcpy(fp->name, AudioEalaw);
    800       1.1        pk 		fp->encoding = AUDIO_ENCODING_ALAW;
    801       1.1        pk 		fp->precision = 8;
    802       1.1        pk 		fp->flags = 0;
    803       1.1        pk 		break;
    804       1.1        pk 	case 2:
    805       1.1        pk 		strcpy(fp->name, AudioEslinear_le);
    806       1.1        pk 		fp->encoding = AUDIO_ENCODING_SLINEAR_LE;
    807       1.1        pk 		fp->precision = 16;
    808       1.1        pk 		fp->flags = 0;
    809       1.1        pk 		break;
    810       1.1        pk 	case 3:
    811       1.1        pk 		strcpy(fp->name, AudioEulinear);
    812       1.1        pk 		fp->encoding = AUDIO_ENCODING_ULINEAR;
    813       1.1        pk 		fp->precision = 8;
    814       1.1        pk 		fp->flags = 0;
    815       1.1        pk 		break;
    816       1.1        pk 
    817       1.1        pk 	case 4: /* only on CS4231 */
    818       1.1        pk 		strcpy(fp->name, AudioEslinear_be);
    819       1.1        pk 		fp->encoding = AUDIO_ENCODING_SLINEAR_BE;
    820       1.1        pk 		fp->precision = 16;
    821      1.11     itohy 		fp->flags = sc->mode == 1
    822      1.11     itohy #if AD1845_HACK
    823      1.11     itohy 		    || sc->is_ad1845
    824      1.11     itohy #endif
    825      1.11     itohy 			? AUDIO_ENCODINGFLAG_EMULATED : 0;
    826       1.1        pk 		break;
    827       1.1        pk 
    828       1.1        pk 		/* emulate some modes */
    829       1.1        pk 	case 5:
    830       1.1        pk 		strcpy(fp->name, AudioEslinear);
    831       1.1        pk 		fp->encoding = AUDIO_ENCODING_SLINEAR;
    832       1.1        pk 		fp->precision = 8;
    833       1.1        pk 		fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
    834       1.1        pk 		break;
    835       1.1        pk 	case 6:
    836       1.1        pk 		strcpy(fp->name, AudioEulinear_le);
    837       1.1        pk 		fp->encoding = AUDIO_ENCODING_ULINEAR_LE;
    838       1.1        pk 		fp->precision = 16;
    839       1.1        pk 		fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
    840       1.1        pk 		break;
    841       1.1        pk 	case 7:
    842       1.1        pk 		strcpy(fp->name, AudioEulinear_be);
    843       1.1        pk 		fp->encoding = AUDIO_ENCODING_ULINEAR_BE;
    844       1.1        pk 		fp->precision = 16;
    845       1.1        pk 		fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
    846       1.1        pk 		break;
    847       1.1        pk 
    848       1.1        pk 	case 8: /* only on CS4231 */
    849      1.11     itohy 		if (sc->mode == 1 || sc->is_ad1845)
    850       1.1        pk 			return EINVAL;
    851       1.1        pk 		strcpy(fp->name, AudioEadpcm);
    852       1.1        pk 		fp->encoding = AUDIO_ENCODING_ADPCM;
    853      1.13     itohy 		fp->precision = 4;
    854       1.1        pk 		fp->flags = 0;
    855       1.1        pk 		break;
    856       1.1        pk 	default:
    857       1.1        pk 		return EINVAL;
    858       1.1        pk 		/*NOTREACHED*/
    859       1.1        pk 	}
    860      1.20      kent 	return 0;
    861       1.1        pk }
    862       1.1        pk 
    863       1.1        pk int
    864  1.23.2.1        ad ad1848_set_params(void *addr, int setmode, int usemode,
    865  1.23.2.1        ad     audio_params_t *p, audio_params_t *r, stream_filter_list_t *pfil,
    866  1.23.2.1        ad     stream_filter_list_t *rfil)
    867       1.1        pk {
    868      1.19      kent 	audio_params_t phw, rhw;
    869      1.20      kent 	struct ad1848_softc *sc;
    870       1.1        pk 	int error, bits, enc;
    871      1.19      kent 	stream_filter_factory_t *pswcode;
    872      1.19      kent 	stream_filter_factory_t *rswcode;
    873       1.1        pk 
    874      1.19      kent 	DPRINTF(("ad1848_set_params: %u %u %u %u\n",
    875       1.1        pk 		 p->encoding, p->precision, p->channels, p->sample_rate));
    876       1.1        pk 
    877      1.20      kent 	sc = addr;
    878       1.1        pk 	enc = p->encoding;
    879       1.1        pk 	pswcode = rswcode = 0;
    880      1.19      kent 	phw = *p;
    881      1.19      kent 	rhw = *r;
    882       1.1        pk 	switch (enc) {
    883       1.1        pk 	case AUDIO_ENCODING_SLINEAR_LE:
    884       1.1        pk 		if (p->precision == 8) {
    885       1.1        pk 			enc = AUDIO_ENCODING_ULINEAR_LE;
    886      1.19      kent 			phw.encoding = AUDIO_ENCODING_ULINEAR_LE;
    887      1.19      kent 			rhw.encoding = AUDIO_ENCODING_ULINEAR_LE;
    888       1.1        pk 			pswcode = rswcode = change_sign8;
    889       1.1        pk 		}
    890       1.1        pk 		break;
    891       1.1        pk 	case AUDIO_ENCODING_SLINEAR_BE:
    892      1.11     itohy 		if (p->precision == 16 && (sc->mode == 1
    893      1.11     itohy #if AD1845_HACK
    894      1.11     itohy 		    || sc->is_ad1845
    895      1.11     itohy #endif
    896      1.11     itohy 			)) {
    897       1.1        pk 			enc = AUDIO_ENCODING_SLINEAR_LE;
    898      1.19      kent 			phw.encoding = AUDIO_ENCODING_SLINEAR_LE;
    899      1.19      kent 			rhw.encoding = AUDIO_ENCODING_SLINEAR_LE;
    900       1.1        pk 			pswcode = rswcode = swap_bytes;
    901       1.1        pk 		}
    902       1.1        pk 		break;
    903       1.1        pk 	case AUDIO_ENCODING_ULINEAR_LE:
    904       1.1        pk 		if (p->precision == 16) {
    905       1.1        pk 			enc = AUDIO_ENCODING_SLINEAR_LE;
    906      1.19      kent 			phw.encoding = AUDIO_ENCODING_SLINEAR_LE;
    907      1.19      kent 			rhw.encoding = AUDIO_ENCODING_SLINEAR_LE;
    908      1.19      kent 			pswcode = rswcode = change_sign16;
    909       1.1        pk 		}
    910       1.1        pk 		break;
    911       1.1        pk 	case AUDIO_ENCODING_ULINEAR_BE:
    912       1.1        pk 		if (p->precision == 16) {
    913      1.11     itohy 			if (sc->mode == 1
    914      1.11     itohy #if AD1845_HACK
    915      1.11     itohy 			    || sc->is_ad1845
    916      1.11     itohy #endif
    917      1.11     itohy 				) {
    918       1.1        pk 				enc = AUDIO_ENCODING_SLINEAR_LE;
    919      1.19      kent 				phw.encoding = AUDIO_ENCODING_SLINEAR_LE;
    920      1.19      kent 				rhw.encoding = AUDIO_ENCODING_SLINEAR_LE;
    921      1.19      kent 				pswcode = swap_bytes_change_sign16;
    922      1.19      kent 				rswcode = swap_bytes_change_sign16;
    923       1.1        pk 			} else {
    924       1.1        pk 				enc = AUDIO_ENCODING_SLINEAR_BE;
    925      1.19      kent 				phw.encoding = AUDIO_ENCODING_SLINEAR_BE;
    926      1.19      kent 				rhw.encoding = AUDIO_ENCODING_SLINEAR_BE;
    927      1.19      kent 				pswcode = rswcode = change_sign16;
    928       1.1        pk 			}
    929       1.1        pk 		}
    930       1.1        pk 		break;
    931       1.1        pk 	}
    932       1.1        pk 	switch (enc) {
    933       1.1        pk 	case AUDIO_ENCODING_ULAW:
    934       1.1        pk 		bits = FMT_ULAW >> 5;
    935       1.1        pk 		break;
    936       1.1        pk 	case AUDIO_ENCODING_ALAW:
    937       1.1        pk 		bits = FMT_ALAW >> 5;
    938       1.1        pk 		break;
    939       1.1        pk 	case AUDIO_ENCODING_ADPCM:
    940       1.1        pk 		bits = FMT_ADPCM >> 5;
    941       1.1        pk 		break;
    942       1.1        pk 	case AUDIO_ENCODING_SLINEAR_LE:
    943       1.1        pk 		if (p->precision == 16)
    944       1.1        pk 			bits = FMT_TWOS_COMP >> 5;
    945       1.1        pk 		else
    946       1.1        pk 			return EINVAL;
    947       1.1        pk 		break;
    948       1.1        pk 	case AUDIO_ENCODING_SLINEAR_BE:
    949       1.1        pk 		if (p->precision == 16)
    950       1.1        pk 			bits = FMT_TWOS_COMP_BE >> 5;
    951       1.1        pk 		else
    952       1.1        pk 			return EINVAL;
    953       1.1        pk 		break;
    954       1.1        pk 	case AUDIO_ENCODING_ULINEAR_LE:
    955       1.1        pk 		if (p->precision == 8)
    956       1.1        pk 			bits = FMT_PCM8 >> 5;
    957       1.1        pk 		else
    958       1.1        pk 			return EINVAL;
    959       1.1        pk 		break;
    960       1.1        pk 	default:
    961       1.1        pk 		return EINVAL;
    962       1.1        pk 	}
    963       1.1        pk 
    964       1.1        pk 	if (p->channels < 1 || p->channels > 2)
    965       1.1        pk 		return EINVAL;
    966       1.1        pk 
    967       1.1        pk 	error = ad1848_set_speed(sc, &p->sample_rate);
    968       1.1        pk 	if (error)
    969       1.1        pk 		return error;
    970      1.19      kent 	phw.sample_rate = p->sample_rate;
    971       1.1        pk 
    972      1.19      kent 	if (pswcode != NULL)
    973      1.19      kent 		pfil->append(pfil, pswcode, &phw);
    974      1.19      kent 	if (rswcode != NULL)
    975      1.19      kent 		rfil->append(rfil, rswcode, &rhw);
    976       1.1        pk 
    977       1.1        pk 	sc->format_bits = bits;
    978       1.1        pk 	sc->channels = p->channels;
    979       1.1        pk 	sc->precision = p->precision;
    980       1.1        pk 	sc->need_commit = 1;
    981       1.1        pk 
    982       1.1        pk 	DPRINTF(("ad1848_set_params succeeded, bits=%x\n", bits));
    983      1.20      kent 	return 0;
    984       1.1        pk }
    985       1.1        pk 
    986       1.1        pk int
    987      1.18   thorpej ad1848_set_rec_port(struct ad1848_softc *sc, int port)
    988       1.1        pk {
    989       1.1        pk 	u_char inp, reg;
    990       1.7     itohy 
    991       1.1        pk 	DPRINTF(("ad1848_set_rec_port: 0x%x\n", port));
    992       1.1        pk 
    993       1.1        pk 	if (port == MIC_IN_PORT)
    994       1.1        pk 		inp = MIC_INPUT;
    995       1.1        pk 	else if (port == LINE_IN_PORT)
    996       1.1        pk 		inp = LINE_INPUT;
    997       1.1        pk 	else if (port == DAC_IN_PORT)
    998       1.1        pk 		inp = MIXED_DAC_INPUT;
    999       1.6        rh 	else if (sc->mode >= 2 && port == AUX1_IN_PORT)
   1000       1.1        pk 		inp = AUX_INPUT;
   1001       1.1        pk 	else
   1002      1.20      kent 		return EINVAL;
   1003       1.1        pk 
   1004       1.1        pk 	reg = ad_read(sc, SP_LEFT_INPUT_CONTROL);
   1005       1.1        pk 	reg &= INPUT_SOURCE_MASK;
   1006       1.1        pk 	ad_write(sc, SP_LEFT_INPUT_CONTROL, (inp|reg));
   1007       1.1        pk 
   1008       1.1        pk 	reg = ad_read(sc, SP_RIGHT_INPUT_CONTROL);
   1009       1.1        pk 	reg &= INPUT_SOURCE_MASK;
   1010       1.1        pk 	ad_write(sc, SP_RIGHT_INPUT_CONTROL, (inp|reg));
   1011       1.1        pk 
   1012       1.1        pk 	sc->rec_port = port;
   1013       1.1        pk 
   1014      1.20      kent 	return 0;
   1015       1.1        pk }
   1016       1.1        pk 
   1017       1.1        pk int
   1018      1.18   thorpej ad1848_get_rec_port(struct ad1848_softc *sc)
   1019       1.1        pk {
   1020      1.20      kent 	return sc->rec_port;
   1021       1.1        pk }
   1022       1.1        pk 
   1023       1.1        pk int
   1024      1.19      kent ad1848_round_blocksize(void *addr, int blk,
   1025      1.20      kent     int mode, const audio_params_t *param)
   1026       1.1        pk {
   1027       1.1        pk 
   1028       1.1        pk 	/* Round to a multiple of the biggest sample size. */
   1029      1.20      kent 	return blk &= -4;
   1030       1.1        pk }
   1031       1.1        pk 
   1032       1.1        pk int
   1033      1.18   thorpej ad1848_open(void *addr, int flags)
   1034       1.1        pk {
   1035      1.20      kent 	struct ad1848_softc *sc;
   1036       1.5   mycroft 	u_char reg;
   1037       1.1        pk 
   1038      1.20      kent 	sc = addr;
   1039       1.1        pk 	DPRINTF(("ad1848_open: sc=%p\n", sc));
   1040       1.1        pk 
   1041       1.7     itohy 	sc->open_mode = flags;
   1042       1.7     itohy 
   1043       1.1        pk 	/* Enable interrupts */
   1044       1.1        pk 	DPRINTF(("ad1848_open: enable intrs\n"));
   1045       1.5   mycroft 	reg = ad_read(sc, SP_PIN_CONTROL);
   1046       1.5   mycroft 	ad_write(sc, SP_PIN_CONTROL, reg | INTERRUPT_ENABLE);
   1047       1.1        pk 
   1048       1.7     itohy 	/* If recording && monitoring, the playback part is also used. */
   1049       1.7     itohy 	if (flags & FREAD && sc->mute[AD1848_MONITOR_CHANNEL] == 0)
   1050       1.7     itohy 		ad1848_mute_wave_output(sc, WAVE_UNMUTE1, 1);
   1051       1.7     itohy 
   1052       1.1        pk #ifdef AUDIO_DEBUG
   1053       1.1        pk 	if (ad1848debug)
   1054       1.1        pk 		ad1848_dump_regs(sc);
   1055       1.1        pk #endif
   1056       1.1        pk 
   1057       1.1        pk 	return 0;
   1058       1.1        pk }
   1059       1.1        pk 
   1060       1.1        pk /*
   1061       1.1        pk  * Close function is called at splaudio().
   1062       1.1        pk  */
   1063       1.1        pk void
   1064      1.18   thorpej ad1848_close(void *addr)
   1065       1.1        pk {
   1066      1.20      kent 	struct ad1848_softc *sc;
   1067       1.5   mycroft 	u_char reg;
   1068       1.1        pk 
   1069      1.20      kent 	sc = addr;
   1070       1.7     itohy 	sc->open_mode = 0;
   1071       1.7     itohy 
   1072       1.7     itohy 	ad1848_mute_wave_output(sc, WAVE_UNMUTE1, 0);
   1073       1.7     itohy 
   1074       1.1        pk 	/* Disable interrupts */
   1075       1.1        pk 	DPRINTF(("ad1848_close: disable intrs\n"));
   1076       1.5   mycroft 	reg = ad_read(sc, SP_PIN_CONTROL);
   1077       1.5   mycroft 	ad_write(sc, SP_PIN_CONTROL, reg & ~INTERRUPT_ENABLE);
   1078       1.1        pk 
   1079       1.1        pk #ifdef AUDIO_DEBUG
   1080       1.1        pk 	if (ad1848debug)
   1081       1.1        pk 		ad1848_dump_regs(sc);
   1082       1.1        pk #endif
   1083       1.1        pk }
   1084       1.1        pk 
   1085       1.1        pk /*
   1086       1.1        pk  * Lower-level routines
   1087       1.1        pk  */
   1088       1.1        pk int
   1089      1.18   thorpej ad1848_commit_settings(void *addr)
   1090       1.1        pk {
   1091      1.20      kent 	struct ad1848_softc *sc;
   1092       1.1        pk 	int timeout;
   1093       1.1        pk 	u_char fs;
   1094       1.1        pk 	int s;
   1095       1.1        pk 
   1096      1.20      kent 	sc = addr;
   1097       1.1        pk 	if (!sc->need_commit)
   1098       1.1        pk 		return 0;
   1099       1.1        pk 
   1100       1.1        pk 	s = splaudio();
   1101       1.1        pk 
   1102       1.7     itohy 	ad1848_mute_wave_output(sc, WAVE_MUTE0, 1);
   1103       1.1        pk 
   1104       1.1        pk 	ad_set_MCE(sc, 1);	/* Enables changes to the format select reg */
   1105       1.1        pk 
   1106       1.1        pk 	fs = sc->speed_bits | (sc->format_bits << 5);
   1107       1.1        pk 
   1108       1.1        pk 	if (sc->channels == 2)
   1109       1.1        pk 		fs |= FMT_STEREO;
   1110      1.14     itohy 
   1111      1.14     itohy 	/*
   1112      1.14     itohy 	 * OPL3-SA2 (YMF711) is sometimes busy here.
   1113      1.14     itohy 	 * Wait until it becomes ready.
   1114      1.14     itohy 	 */
   1115      1.14     itohy 	for (timeout = 0;
   1116      1.14     itohy 	    timeout < 1000 && ADREAD(sc, AD1848_IADDR) & SP_IN_INIT; timeout++)
   1117      1.14     itohy 		delay(10);
   1118       1.1        pk 
   1119       1.1        pk 	ad_write(sc, SP_CLOCK_DATA_FORMAT, fs);
   1120       1.1        pk 
   1121       1.1        pk 	/*
   1122       1.6        rh 	 * If mode >= 2 (CS4231), set I28 also.
   1123       1.1        pk 	 * It's the capture format register.
   1124       1.1        pk 	 */
   1125       1.6        rh 	if (sc->mode >= 2) {
   1126       1.1        pk 		/*
   1127       1.1        pk 		 * Gravis Ultrasound MAX SDK sources says something about
   1128       1.1        pk 		 * errata sheets, with the implication that these inb()s
   1129       1.1        pk 		 * are necessary.
   1130       1.1        pk 		 */
   1131       1.1        pk 		(void)ADREAD(sc, AD1848_IDATA);
   1132       1.1        pk 		(void)ADREAD(sc, AD1848_IDATA);
   1133      1.16       wiz 		/* Write to I8 starts resynchronization. Wait for completion. */
   1134       1.1        pk 		timeout = 100000;
   1135       1.1        pk 		while (timeout > 0 && ADREAD(sc, AD1848_IADDR) == SP_IN_INIT)
   1136       1.1        pk 			timeout--;
   1137       1.1        pk 
   1138       1.1        pk 		ad_write(sc, CS_REC_FORMAT, fs);
   1139       1.1        pk 		(void)ADREAD(sc, AD1848_IDATA);
   1140       1.1        pk 		(void)ADREAD(sc, AD1848_IDATA);
   1141       1.1        pk 		/* Now wait for resync for capture side of the house */
   1142       1.1        pk 	}
   1143       1.1        pk 	/*
   1144      1.16       wiz 	 * Write to I8 starts resynchronization. Wait until it completes.
   1145       1.1        pk 	 */
   1146       1.1        pk 	timeout = 100000;
   1147       1.8   thorpej 	while (timeout > 0 && ADREAD(sc, AD1848_IADDR) == SP_IN_INIT) {
   1148       1.8   thorpej 		delay(10);
   1149       1.1        pk 		timeout--;
   1150       1.8   thorpej 	}
   1151       1.1        pk 
   1152       1.1        pk 	if (ADREAD(sc, AD1848_IADDR) == SP_IN_INIT)
   1153       1.1        pk 		printf("ad1848_commit: Auto calibration timed out\n");
   1154       1.1        pk 
   1155       1.1        pk 	/*
   1156       1.1        pk 	 * Starts the calibration process and
   1157       1.1        pk 	 * enters playback mode after it.
   1158       1.1        pk 	 */
   1159       1.1        pk 	ad_set_MCE(sc, 0);
   1160       1.1        pk 	wait_for_calibration(sc);
   1161       1.1        pk 
   1162       1.7     itohy 	ad1848_mute_wave_output(sc, WAVE_MUTE0, 0);
   1163       1.1        pk 
   1164       1.1        pk 	splx(s);
   1165       1.1        pk 
   1166       1.1        pk 	sc->need_commit = 0;
   1167       1.1        pk 	return 0;
   1168       1.1        pk }
   1169       1.1        pk 
   1170       1.1        pk void
   1171      1.18   thorpej ad1848_reset(struct ad1848_softc *sc)
   1172       1.1        pk {
   1173       1.1        pk 	u_char r;
   1174       1.1        pk 
   1175       1.1        pk 	DPRINTF(("ad1848_reset\n"));
   1176       1.1        pk 
   1177       1.1        pk 	/* Clear the PEN and CEN bits */
   1178       1.1        pk 	r = ad_read(sc, SP_INTERFACE_CONFIG);
   1179       1.1        pk 	r &= ~(CAPTURE_ENABLE | PLAYBACK_ENABLE);
   1180       1.1        pk 	ad_write(sc, SP_INTERFACE_CONFIG, r);
   1181       1.1        pk 
   1182       1.6        rh 	if (sc->mode >= 2) {
   1183       1.1        pk 		ADWRITE(sc, AD1848_IADDR, CS_IRQ_STATUS);
   1184       1.1        pk 		ADWRITE(sc, AD1848_IDATA, 0);
   1185       1.1        pk 	}
   1186       1.1        pk 	/* Clear interrupt status */
   1187       1.1        pk 	ADWRITE(sc, AD1848_STATUS, 0);
   1188       1.1        pk #ifdef AUDIO_DEBUG
   1189       1.1        pk 	if (ad1848debug)
   1190       1.1        pk 		ad1848_dump_regs(sc);
   1191       1.1        pk #endif
   1192       1.1        pk }
   1193       1.1        pk 
   1194       1.1        pk int
   1195      1.19      kent ad1848_set_speed(struct ad1848_softc *sc, u_int *argp)
   1196       1.1        pk {
   1197       1.1        pk 	/*
   1198       1.1        pk 	 * The sampling speed is encoded in the least significant nible of I8.
   1199      1.17   tsutsui 	 * The LSB selects the clock source (0=24.576 MHz, 1=16.9344 MHz) and
   1200       1.1        pk 	 * other three bits select the divisor (indirectly):
   1201       1.1        pk 	 *
   1202       1.1        pk 	 * The available speeds are in the following table. Keep the speeds in
   1203       1.1        pk 	 * the increasing order.
   1204       1.1        pk 	 */
   1205       1.1        pk 	typedef struct {
   1206       1.1        pk 		int	speed;
   1207       1.1        pk 		u_char	bits;
   1208       1.1        pk 	} speed_struct;
   1209      1.20      kent 	u_long arg;
   1210       1.1        pk 
   1211      1.10  jdolecek 	static const speed_struct speed_table[] =  {
   1212       1.1        pk 		{5510, (0 << 1) | 1},
   1213       1.1        pk 		{5510, (0 << 1) | 1},
   1214       1.1        pk 		{6620, (7 << 1) | 1},
   1215       1.1        pk 		{8000, (0 << 1) | 0},
   1216       1.1        pk 		{9600, (7 << 1) | 0},
   1217       1.1        pk 		{11025, (1 << 1) | 1},
   1218       1.1        pk 		{16000, (1 << 1) | 0},
   1219       1.1        pk 		{18900, (2 << 1) | 1},
   1220       1.1        pk 		{22050, (3 << 1) | 1},
   1221       1.1        pk 		{27420, (2 << 1) | 0},
   1222       1.1        pk 		{32000, (3 << 1) | 0},
   1223       1.1        pk 		{33075, (6 << 1) | 1},
   1224       1.1        pk 		{37800, (4 << 1) | 1},
   1225       1.1        pk 		{44100, (5 << 1) | 1},
   1226       1.1        pk 		{48000, (6 << 1) | 0}
   1227       1.1        pk 	};
   1228       1.1        pk 
   1229      1.20      kent 	int i, n, selected;
   1230       1.1        pk 
   1231      1.20      kent 	arg = *argp;
   1232      1.20      kent 	selected = -1;
   1233       1.1        pk 	n = sizeof(speed_table) / sizeof(speed_struct);
   1234       1.1        pk 
   1235       1.1        pk 	if (arg < speed_table[0].speed)
   1236       1.1        pk 		selected = 0;
   1237       1.1        pk 	if (arg > speed_table[n - 1].speed)
   1238       1.1        pk 		selected = n - 1;
   1239       1.1        pk 
   1240       1.1        pk 	for (i = 1 /*really*/ ; selected == -1 && i < n; i++)
   1241       1.1        pk 		if (speed_table[i].speed == arg)
   1242       1.1        pk 			selected = i;
   1243       1.1        pk 		else if (speed_table[i].speed > arg) {
   1244       1.1        pk 			int diff1, diff2;
   1245       1.1        pk 
   1246       1.1        pk 			diff1 = arg - speed_table[i - 1].speed;
   1247       1.1        pk 			diff2 = speed_table[i].speed - arg;
   1248       1.1        pk 
   1249       1.1        pk 			if (diff1 < diff2)
   1250       1.1        pk 				selected = i - 1;
   1251       1.1        pk 			else
   1252       1.1        pk 				selected = i;
   1253       1.1        pk 		}
   1254       1.1        pk 
   1255       1.1        pk 	if (selected == -1) {
   1256       1.1        pk 		printf("ad1848: Can't find speed???\n");
   1257       1.1        pk 		selected = 3;
   1258       1.1        pk 	}
   1259       1.1        pk 
   1260       1.1        pk 	sc->speed_bits = speed_table[selected].bits;
   1261       1.1        pk 	sc->need_commit = 1;
   1262       1.1        pk 	*argp = speed_table[selected].speed;
   1263       1.1        pk 
   1264      1.20      kent 	return 0;
   1265       1.1        pk }
   1266       1.1        pk 
   1267       1.1        pk /*
   1268       1.1        pk  * Halt I/O
   1269       1.1        pk  */
   1270       1.1        pk int
   1271      1.18   thorpej ad1848_halt_output(void *addr)
   1272       1.1        pk {
   1273      1.20      kent 	struct ad1848_softc *sc;
   1274       1.1        pk 	u_char reg;
   1275       1.1        pk 
   1276       1.5   mycroft 	DPRINTF(("ad1848: ad1848_halt_output\n"));
   1277      1.20      kent 	sc = addr;
   1278       1.1        pk 	reg = ad_read(sc, SP_INTERFACE_CONFIG);
   1279       1.5   mycroft 	ad_write(sc, SP_INTERFACE_CONFIG, reg & ~PLAYBACK_ENABLE);
   1280       1.1        pk 
   1281      1.20      kent 	return 0;
   1282       1.1        pk }
   1283       1.1        pk 
   1284       1.1        pk int
   1285      1.18   thorpej ad1848_halt_input(void *addr)
   1286       1.1        pk {
   1287      1.20      kent 	struct ad1848_softc *sc;
   1288       1.1        pk 	u_char reg;
   1289       1.1        pk 
   1290       1.5   mycroft 	DPRINTF(("ad1848: ad1848_halt_input\n"));
   1291      1.20      kent 	sc = addr;
   1292       1.1        pk 	reg = ad_read(sc, SP_INTERFACE_CONFIG);
   1293       1.5   mycroft 	ad_write(sc, SP_INTERFACE_CONFIG, reg & ~CAPTURE_ENABLE);
   1294       1.1        pk 
   1295      1.20      kent 	return 0;
   1296       1.1        pk }
   1297