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