Home | History | Annotate | Line # | Download | only in ic
ad1848.c revision 1.25.28.1
      1  1.25.28.1    bouyer /*	$NetBSD: ad1848.c,v 1.25.28.1 2007/10/25 22:37:26 bouyer 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.25.28.1    bouyer __KERNEL_RCSID(0, "$NetBSD: ad1848.c,v 1.25.28.1 2007/10/25 22:37:26 bouyer 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.25.28.1    bouyer #include <sys/cpu.h>
    117  1.25.28.1    bouyer #include <sys/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.25  christos ad1848_set_params(void *addr, int setmode, int usemode,
    865       1.24  christos     audio_params_t *p, audio_params_t *r, stream_filter_list_t *pfil,
    866       1.24  christos     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.25  christos ad1848_round_blocksize(void *addr, int blk,
   1025       1.25  christos     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