Home | History | Annotate | Line # | Download | only in pci
esa.c revision 1.33
      1 /* $NetBSD: esa.c,v 1.33 2006/08/30 00:53:47 christos Exp $ */
      2 
      3 /*
      4  * Copyright (c) 2001, 2002 Jared D. McNeill <jmcneill (at) invisible.ca>
      5  * All rights reserved.
      6  *
      7  * Redistribution and use in source and binary forms, with or without
      8  * modification, are permitted provided that the following conditions
      9  * are met:
     10  * 1. Redistributions of source code must retain the above copyright
     11  *    notice, this list of conditions and the following disclaimer.
     12  * 2. The name of the author may not be used to endorse or promote products
     13  *    derived from this software without specific prior written permission.
     14  *
     15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     16  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     17  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     18  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     19  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
     20  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     21  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
     22  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
     23  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     24  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     25  * SUCH DAMAGE.
     26  */
     27 
     28 /*
     29  * ESS Allegro-1 / Maestro3 Audio Driver
     30  *
     31  * Based on the FreeBSD maestro3 driver and the NetBSD eap driver.
     32  * Original driver by Don Kim.
     33  *
     34  * The list management code could possibly be written better, but what
     35  * we have right now does the job nicely. Thanks to Zach Brown <zab (at) zabbo.net>
     36  * and Andrew MacDonald <amac (at) epsilon.yi.org> for helping me debug the
     37  * problems with the original list management code present in the Linux
     38  * driver.
     39  */
     40 
     41 #include <sys/cdefs.h>
     42 __KERNEL_RCSID(0, "$NetBSD: esa.c,v 1.33 2006/08/30 00:53:47 christos Exp $");
     43 
     44 #include <sys/types.h>
     45 #include <sys/errno.h>
     46 #include <sys/null.h>
     47 #include <sys/param.h>
     48 #include <sys/systm.h>
     49 #include <sys/malloc.h>
     50 #include <sys/device.h>
     51 #include <sys/conf.h>
     52 #include <sys/exec.h>
     53 #include <sys/select.h>
     54 #include <sys/audioio.h>
     55 
     56 #include <machine/bus.h>
     57 #include <machine/intr.h>
     58 
     59 #include <dev/pci/pcidevs.h>
     60 #include <dev/pci/pcivar.h>
     61 
     62 #include <dev/audio_if.h>
     63 #include <dev/mulaw.h>
     64 #include <dev/auconv.h>
     65 #include <dev/ic/ac97var.h>
     66 #include <dev/ic/ac97reg.h>
     67 
     68 #include <dev/pci/esareg.h>
     69 #include <dev/pci/esadsp.h>
     70 #include <dev/pci/esavar.h>
     71 
     72 #define PCI_CBIO	0x10
     73 
     74 #define ESA_DAC_DATA	0x1100
     75 
     76 enum {
     77 	ESS_ALLEGRO1,
     78 	ESS_MAESTRO3
     79 };
     80 
     81 static const struct esa_card_type {
     82 	uint16_t pci_vendor_id;
     83 	uint16_t pci_product_id;
     84 	int type;
     85 	int delay1, delay2;
     86 } esa_card_types[] = {
     87 	{ PCI_VENDOR_ESSTECH, PCI_PRODUCT_ESSTECH_ALLEGRO1,
     88 	  ESS_ALLEGRO1, 50, 800 },
     89 	{ PCI_VENDOR_ESSTECH, PCI_PRODUCT_ESSTECH_MAESTRO3,
     90 	  ESS_MAESTRO3, 20, 500 },
     91 	{ PCI_VENDOR_ESSTECH, PCI_PRODUCT_ESSTECH_MAESTRO3_2,
     92 	  ESS_MAESTRO3, 20, 500 },
     93 	{ 0, 0, 0, 0, 0 }
     94 };
     95 
     96 static struct audio_device esa_device = {
     97 	"ESS Allegro",
     98 	"",
     99 	"esa"
    100 };
    101 
    102 static int		esa_match(struct device *, struct cfdata *, void *);
    103 static void		esa_attach(struct device *, struct device *, void *);
    104 static int		esa_detach(struct device *, int);
    105 
    106 /* audio(9) functions */
    107 static int		esa_query_encoding(void *, struct audio_encoding *);
    108 static int		esa_set_params(void *, int, int, audio_params_t *,
    109 				       audio_params_t *, stream_filter_list_t *,
    110 				       stream_filter_list_t *);
    111 static int		esa_round_blocksize(void *, int, int,
    112 					    const audio_params_t *);
    113 static int		esa_commit_settings(void *);
    114 static int		esa_halt_output(void *);
    115 static int		esa_halt_input(void *);
    116 static int		esa_set_port(void *, mixer_ctrl_t *);
    117 static int		esa_get_port(void *, mixer_ctrl_t *);
    118 static int		esa_query_devinfo(void *, mixer_devinfo_t *);
    119 static void *		esa_malloc(void *, int, size_t, struct malloc_type *,
    120 				   int);
    121 static void		esa_free(void *, void *, struct malloc_type *);
    122 static int		esa_getdev(void *, struct audio_device *);
    123 static size_t		esa_round_buffersize(void *, int, size_t);
    124 static int		esa_get_props(void *);
    125 static int		esa_trigger_output(void *, void *, void *, int,
    126 					   void (*)(void *), void *,
    127 					   const audio_params_t *);
    128 static int		esa_trigger_input(void *, void *, void *, int,
    129 					  void (*)(void *), void *,
    130 					  const audio_params_t *);
    131 
    132 static int		esa_intr(void *);
    133 static int		esa_allocmem(struct esa_softc *, size_t, size_t,
    134 				     struct esa_dma *);
    135 static int		esa_freemem(struct esa_softc *, struct esa_dma *);
    136 static paddr_t		esa_mappage(void *, void *, off_t, int);
    137 
    138 /* Supporting subroutines */
    139 static uint16_t	esa_read_assp(struct esa_softc *, uint16_t, uint16_t);
    140 static void		esa_write_assp(struct esa_softc *, uint16_t, uint16_t,
    141 				       uint16_t);
    142 static int		esa_init_codec(struct esa_softc *);
    143 static int		esa_attach_codec(void *, struct ac97_codec_if *);
    144 static int		esa_read_codec(void *, uint8_t, uint16_t *);
    145 static int		esa_write_codec(void *, uint8_t, uint16_t);
    146 static int		esa_reset_codec(void *);
    147 static enum ac97_host_flags	esa_flags_codec(void *);
    148 static int		esa_wait(struct esa_softc *);
    149 static int		esa_init(struct esa_softc *);
    150 static void		esa_config(struct esa_softc *);
    151 static uint8_t		esa_assp_halt(struct esa_softc *);
    152 static void		esa_codec_reset(struct esa_softc *);
    153 static int		esa_amp_enable(struct esa_softc *);
    154 static void		esa_enable_interrupts(struct esa_softc *);
    155 static uint32_t	esa_get_pointer(struct esa_softc *, struct esa_channel *);
    156 
    157 /* list management */
    158 static int		esa_add_list(struct esa_voice *, struct esa_list *,
    159 				     uint16_t, int);
    160 static void		esa_remove_list(struct esa_voice *, struct esa_list *,
    161 					int);
    162 
    163 /* power management */
    164 static void		esa_powerhook(int, void *);
    165 static int		esa_suspend(struct esa_softc *);
    166 static int		esa_resume(struct esa_softc *);
    167 
    168 
    169 #define ESA_NENCODINGS 8
    170 static audio_encoding_t esa_encoding[ESA_NENCODINGS] = {
    171 	{ 0, AudioEulinear, AUDIO_ENCODING_ULINEAR, 8, 0 },
    172 	{ 1, AudioEmulaw, AUDIO_ENCODING_ULAW, 8,
    173 		AUDIO_ENCODINGFLAG_EMULATED },
    174 	{ 2, AudioEalaw, AUDIO_ENCODING_ALAW, 8, AUDIO_ENCODINGFLAG_EMULATED },
    175 	{ 3, AudioEslinear, AUDIO_ENCODING_SLINEAR, 8,
    176 		AUDIO_ENCODINGFLAG_EMULATED }, /* XXX: Are you sure? */
    177 	{ 4, AudioEslinear_le, AUDIO_ENCODING_SLINEAR_LE, 16, 0 },
    178 	{ 5, AudioEulinear_le, AUDIO_ENCODING_ULINEAR_LE, 16,
    179 		AUDIO_ENCODINGFLAG_EMULATED },
    180 	{ 6, AudioEslinear_be, AUDIO_ENCODING_SLINEAR_BE, 16,
    181 		AUDIO_ENCODINGFLAG_EMULATED },
    182 	{ 7, AudioEulinear_be, AUDIO_ENCODING_ULINEAR_BE, 16,
    183 		AUDIO_ENCODINGFLAG_EMULATED }
    184 };
    185 
    186 #define ESA_NFORMATS	4
    187 static const struct audio_format esa_formats[ESA_NFORMATS] = {
    188 	{NULL, AUMODE_PLAY | AUMODE_RECORD, AUDIO_ENCODING_SLINEAR_LE, 16, 16,
    189 	 2, AUFMT_STEREO, 0, {ESA_MINRATE, ESA_MAXRATE}},
    190 	{NULL, AUMODE_PLAY | AUMODE_RECORD, AUDIO_ENCODING_SLINEAR_LE, 16, 16,
    191 	 1, AUFMT_MONAURAL, 0, {ESA_MINRATE, ESA_MAXRATE}},
    192 	{NULL, AUMODE_PLAY | AUMODE_RECORD, AUDIO_ENCODING_ULINEAR_LE, 8, 8,
    193 	 2, AUFMT_STEREO, 0, {ESA_MINRATE, ESA_MAXRATE}},
    194 	{NULL, AUMODE_PLAY | AUMODE_RECORD, AUDIO_ENCODING_ULINEAR_LE, 8, 8,
    195 	 1, AUFMT_MONAURAL, 0, {ESA_MINRATE, ESA_MAXRATE}},
    196 };
    197 
    198 static const struct audio_hw_if esa_hw_if = {
    199 	NULL,			/* open */
    200 	NULL,			/* close */
    201 	NULL,			/* drain */
    202 	esa_query_encoding,
    203 	esa_set_params,
    204 	esa_round_blocksize,
    205 	esa_commit_settings,
    206 	NULL,			/* init_output */
    207 	NULL,			/* init_input */
    208 	NULL,			/* start_output */
    209 	NULL,			/* start_input */
    210 	esa_halt_output,
    211 	esa_halt_input,
    212 	NULL,			/* speaker_ctl */
    213 	esa_getdev,
    214 	NULL,			/* getfd */
    215 	esa_set_port,
    216 	esa_get_port,
    217 	esa_query_devinfo,
    218 	esa_malloc,
    219 	esa_free,
    220 	esa_round_buffersize,
    221 	esa_mappage,
    222 	esa_get_props,
    223 	esa_trigger_output,
    224 	esa_trigger_input
    225 	NULL,	/* dev_ioctl */
    226 	NULL,	/* powerstate */
    227 };
    228 
    229 CFATTACH_DECL(esa, sizeof(struct esa_softc), esa_match, esa_attach,
    230     esa_detach, NULL);
    231 
    232 /*
    233  * audio(9) functions
    234  */
    235 
    236 static int
    237 esa_query_encoding(void *hdl, struct audio_encoding *ae)
    238 {
    239 
    240 	if (ae->index < 0 || ae->index >= ESA_NENCODINGS)
    241 		return EINVAL;
    242 	*ae = esa_encoding[ae->index];
    243 
    244 	return 0;
    245 }
    246 
    247 static int
    248 esa_set_params(void *hdl, int setmode, int usemode,
    249 	       audio_params_t *play, audio_params_t *rec,
    250 	       stream_filter_list_t *pfil, stream_filter_list_t *rfil)
    251 {
    252 	struct esa_voice *vc;
    253 	//struct esa_softc *sc = (struct esa_softc *)vc->parent;
    254 	struct esa_channel *ch;
    255 	struct audio_params *p;
    256 	stream_filter_list_t *fil;
    257 	int mode, i;
    258 
    259 	vc = hdl;
    260 	for (mode = AUMODE_RECORD; mode != -1;
    261 	     mode = (mode == AUMODE_RECORD) ? AUMODE_PLAY : -1) {
    262 		if ((setmode & mode) == 0)
    263 			continue;
    264 
    265 		switch (mode) {
    266 		case AUMODE_PLAY:
    267 			p = play;
    268 			ch = &vc->play;
    269 			fil = pfil;
    270 			break;
    271 		case AUMODE_RECORD:
    272 			p = rec;
    273 			ch = &vc->rec;
    274 			fil = rfil;
    275 			break;
    276 		default:
    277 			return EINVAL;
    278 		}
    279 
    280 		if (p->sample_rate < ESA_MINRATE ||
    281 		    p->sample_rate > ESA_MAXRATE ||
    282 		    (p->precision != 8 && p->precision != 16) ||
    283 		    (p->channels < 1 || p->channels > 2))
    284 			return EINVAL;
    285 
    286 		i = auconv_set_converter(esa_formats, ESA_NFORMATS,
    287 					 mode, p, FALSE, fil);
    288 		if (i < 0)
    289 			return EINVAL;
    290 		if (fil->req_size > 0)
    291 			p = &fil->filters[0].param;
    292 		ch->mode = *p;
    293 	}
    294 
    295 	return 0;
    296 }
    297 
    298 static int
    299 esa_commit_settings(void *hdl)
    300 {
    301 	struct esa_voice *vc;
    302 	struct esa_softc *sc;
    303 	const audio_params_t *p;
    304 	const audio_params_t *r;
    305 	uint32_t data;
    306 	uint32_t freq;
    307 	int data_bytes;
    308 
    309 	vc = hdl;
    310 	sc = (struct esa_softc *)vc->parent;
    311 	p = &vc->play.mode;
    312 	r = &vc->rec.mode;
    313 	data_bytes = (((ESA_MINISRC_TMP_BUFFER_SIZE & ~1) +
    314 	    (ESA_MINISRC_IN_BUFFER_SIZE & ~1) +
    315 	    (ESA_MINISRC_OUT_BUFFER_SIZE & ~1) + 4) + 255)
    316 	    &~ 255;
    317 	/* playback */
    318 	vc->play.data_offset = ESA_DAC_DATA + (data_bytes * vc->index);
    319 	if (p->channels == 1)
    320 		data = 1;
    321 	else
    322 		data = 0;
    323 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
    324 		       vc->play.data_offset + ESA_SRC3_MODE_OFFSET,
    325 		       data);
    326 	if (p->precision  == 8)
    327 		data = 1;
    328 	else
    329 		data = 0;
    330 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
    331 		       vc->play.data_offset + ESA_SRC3_WORD_LENGTH_OFFSET,
    332 		       data);
    333 	if ((freq = ((p->sample_rate << 15) + 24000) / 48000) != 0) {
    334 		freq--;
    335 	}
    336 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
    337 		       vc->play.data_offset + ESA_CDATA_FREQUENCY, freq);
    338 
    339 	/* recording */
    340 	vc->rec.data_offset = ESA_DAC_DATA + (data_bytes * vc->index) +
    341 			      (data_bytes / 2);
    342 	if (r->channels == 1)
    343 		data = 1;
    344 	else
    345 		data = 0;
    346 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
    347 		       vc->rec.data_offset + ESA_SRC3_MODE_OFFSET,
    348 		       data);
    349 	if (r->precision == 8)
    350 		data = 1;
    351 	else
    352 		data = 0;
    353 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
    354 		       vc->rec.data_offset + ESA_SRC3_WORD_LENGTH_OFFSET,
    355 		       data);
    356 	if ((freq = ((r->sample_rate << 15) + 24000) / 48000) != 0) {
    357 		freq--;
    358 	}
    359 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
    360 		       vc->rec.data_offset + ESA_CDATA_FREQUENCY, freq);
    361 
    362 	return 0;
    363 };
    364 
    365 static int
    366 esa_round_blocksize(void *hdl, int bs, int mode, const audio_params_t *param)
    367 {
    368 
    369 	return bs & ~0x20;	/* Be conservative; align to 32 bytes */
    370 }
    371 
    372 static int
    373 esa_halt_output(void *hdl)
    374 {
    375 	struct esa_voice *vc;
    376 	struct esa_softc *sc;
    377 	bus_space_tag_t iot;
    378 	bus_space_handle_t ioh;
    379 	uint16_t data;
    380 
    381 	vc = hdl;
    382 	sc = (struct esa_softc *)vc->parent;
    383 	iot = sc->sc_iot;
    384 	ioh = sc->sc_ioh;
    385 	if (vc->play.active == 0)
    386 		return 0;
    387 
    388 	vc->play.active = 0;
    389 
    390 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
    391 		       ESA_CDATA_INSTANCE_READY + vc->play.data_offset, 0);
    392 
    393 	sc->sc_ntimers--;
    394 	if (sc->sc_ntimers == 0) {
    395 		esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
    396 			       ESA_KDATA_TIMER_COUNT_RELOAD, 0);
    397 		esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
    398 			       ESA_KDATA_TIMER_COUNT_CURRENT, 0);
    399 		data = bus_space_read_2(iot, ioh, ESA_HOST_INT_CTRL);
    400 		bus_space_write_2(iot, ioh, ESA_HOST_INT_CTRL,
    401 		    data & ~ESA_CLKRUN_GEN_ENABLE);
    402 	}
    403 
    404 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
    405 		       ESA_KDATA_MIXER_TASK_NUMBER,
    406 		       sc->mixer_list.indexmap[vc->index]);
    407 	/* remove ourselves from the packed lists */
    408 	esa_remove_list(vc, &sc->mixer_list, vc->index);
    409 	esa_remove_list(vc, &sc->dma_list, vc->index);
    410 	esa_remove_list(vc, &sc->msrc_list, vc->index);
    411 
    412 	return 0;
    413 }
    414 
    415 static int
    416 esa_halt_input(void *hdl)
    417 {
    418 	struct esa_voice *vc;
    419 	struct esa_softc *sc;
    420 	bus_space_tag_t iot;
    421 	bus_space_handle_t ioh;
    422 	uint32_t data;
    423 
    424 	vc = hdl;
    425 	sc = (struct esa_softc *)vc->parent;
    426 	iot = sc->sc_iot;
    427 	ioh = sc->sc_ioh;
    428 	if (vc->rec.active == 0)
    429 		return 0;
    430 
    431 	vc->rec.active = 0;
    432 
    433 	sc->sc_ntimers--;
    434 	if (sc->sc_ntimers == 0) {
    435 		esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
    436 			       ESA_KDATA_TIMER_COUNT_RELOAD, 0);
    437 		esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
    438 			       ESA_KDATA_TIMER_COUNT_CURRENT, 0);
    439 		data = bus_space_read_2(iot, ioh, ESA_HOST_INT_CTRL);
    440 		bus_space_write_2(iot, ioh, ESA_HOST_INT_CTRL,
    441 				  data & ~ESA_CLKRUN_GEN_ENABLE);
    442 	}
    443 
    444 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, vc->rec.data_offset +
    445 		       ESA_CDATA_INSTANCE_READY, 0);
    446 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, ESA_KDATA_ADC1_REQUEST,
    447 		       0);
    448 
    449 	/* remove ourselves from the packed lists */
    450 	esa_remove_list(vc, &sc->adc1_list, vc->index + ESA_NUM_VOICES);
    451 	esa_remove_list(vc, &sc->dma_list, vc->index + ESA_NUM_VOICES);
    452 	esa_remove_list(vc, &sc->msrc_list, vc->index + ESA_NUM_VOICES);
    453 
    454 	return 0;
    455 }
    456 
    457 static void *
    458 esa_malloc(void *hdl, int direction, size_t size, struct malloc_type *type,
    459     int flags)
    460 {
    461 	struct esa_voice *vc;
    462 	struct esa_softc *sc;
    463 	struct esa_dma *p;
    464 	int error;
    465 
    466 	p = malloc(sizeof(*p), type, flags);
    467 	if (p == NULL)
    468 		return NULL;
    469 	vc = hdl;
    470 	sc = (struct esa_softc *)vc->parent;
    471 	error = esa_allocmem(sc, size, 16, p);
    472 	if (error) {
    473 		free(p, type);
    474 		printf("%s: esa_malloc: not enough memory\n",
    475 		    sc->sc_dev.dv_xname);
    476 		return 0;
    477 	}
    478 	p->next = vc->dma;
    479 	vc->dma = p;
    480 
    481 	return KERNADDR(p);
    482 }
    483 
    484 static void
    485 esa_free(void *hdl, void *addr, struct malloc_type *type)
    486 {
    487 	struct esa_voice *vc;
    488 	struct esa_softc *sc;
    489 	struct esa_dma *p;
    490 	struct esa_dma **pp;
    491 
    492 	vc = hdl;
    493 	sc = (struct esa_softc *)vc->parent;
    494 	for (pp = &vc->dma; (p = *pp) != NULL; pp = &p->next)
    495 		if (KERNADDR(p) == addr) {
    496 			esa_freemem(sc, p);
    497 			*pp = p->next;
    498 			free(p, type);
    499 			return;
    500 		}
    501 }
    502 
    503 static int
    504 esa_getdev(void *hdl, struct audio_device *ret)
    505 {
    506 
    507 	*ret = esa_device;
    508 	return 0;
    509 }
    510 
    511 static int
    512 esa_set_port(void *hdl, mixer_ctrl_t *mc)
    513 {
    514 	struct esa_voice *vc;
    515 	struct esa_softc *sc;
    516 
    517 	vc = hdl;
    518 	sc = (struct esa_softc *)vc->parent;
    519 	return sc->codec_if->vtbl->mixer_set_port(sc->codec_if, mc);
    520 }
    521 
    522 static int
    523 esa_get_port(void *hdl, mixer_ctrl_t *mc)
    524 {
    525 	struct esa_voice *vc;
    526 	struct esa_softc *sc;
    527 
    528 	vc = hdl;
    529 	sc = (struct esa_softc *)vc->parent;
    530 	return sc->codec_if->vtbl->mixer_get_port(sc->codec_if, mc);
    531 }
    532 
    533 static int
    534 esa_query_devinfo(void *hdl, mixer_devinfo_t *di)
    535 {
    536 	struct esa_voice *vc;
    537 	struct esa_softc *sc;
    538 
    539 	vc = hdl;
    540 	sc = (struct esa_softc *)vc->parent;
    541 	return sc->codec_if->vtbl->query_devinfo(sc->codec_if, di);
    542 }
    543 
    544 static size_t
    545 esa_round_buffersize(void *hdl, int direction, size_t bufsize)
    546 {
    547 
    548 	return bufsize;
    549 }
    550 
    551 static int
    552 esa_get_props(void *hdl)
    553 {
    554 
    555 	return AUDIO_PROP_MMAP | AUDIO_PROP_INDEPENDENT | AUDIO_PROP_FULLDUPLEX;
    556 }
    557 
    558 static int
    559 esa_trigger_output(void *hdl, void *start, void *end, int blksize,
    560 		   void (*intr)(void *), void *intrarg,
    561 		   const audio_params_t *param)
    562 {
    563 	struct esa_voice *vc;
    564 	struct esa_softc *sc;
    565 	struct esa_dma *p;
    566 	bus_space_tag_t iot;
    567 	bus_space_handle_t ioh;
    568 	size_t size;
    569 	uint32_t data, bufaddr, i;
    570 	int data_bytes, dac_data, dsp_in_size;
    571 	int dsp_out_size, dsp_in_buf, dsp_out_buf;
    572 
    573 	vc = hdl;
    574 	sc = (struct esa_softc *)vc->parent;
    575 	iot = sc->sc_iot;
    576 	ioh = sc->sc_ioh;
    577 	data_bytes = (((ESA_MINISRC_TMP_BUFFER_SIZE & ~1) +
    578 	    (ESA_MINISRC_IN_BUFFER_SIZE & ~1) +
    579 	    (ESA_MINISRC_OUT_BUFFER_SIZE & ~1) + 4) + 255) & ~255;
    580 	dac_data = ESA_DAC_DATA + (data_bytes * vc->index);
    581 	dsp_in_size = ESA_MINISRC_IN_BUFFER_SIZE - (0x20 * 2);
    582 	dsp_out_size = ESA_MINISRC_OUT_BUFFER_SIZE - (0x20 * 2);
    583 	dsp_in_buf = dac_data + (ESA_MINISRC_TMP_BUFFER_SIZE / 2);
    584 	dsp_out_buf = dsp_in_buf + (dsp_in_size / 2) + 1;
    585 
    586 	if (vc->play.active)
    587 		return EINVAL;
    588 
    589 	for (p = vc->dma; p && KERNADDR(p) != start; p = p->next)
    590 		continue;
    591 	if (p == NULL) {
    592 		printf("%s: esa_trigger_output: bad addr %p\n",
    593 		    sc->sc_dev.dv_xname, start);
    594 		return EINVAL;
    595 	}
    596 
    597 	vc->play.active = 1;
    598 	vc->play.intr = intr;
    599 	vc->play.arg = intrarg;
    600 	vc->play.pos = 0;
    601 	vc->play.count = 0;
    602 	vc->play.buf = start;
    603 	vc->play.bufsize = size = (size_t)(((caddr_t)end - (caddr_t)start));
    604 	vc->play.blksize = blksize;
    605 	bufaddr = DMAADDR(p);
    606 	vc->play.start = bufaddr;
    607 
    608 #define LO(x) ((x) & 0x0000ffff)
    609 #define HI(x) ((x) >> 16)
    610 
    611 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data +
    612 	    ESA_CDATA_HOST_SRC_ADDRL, LO(bufaddr));
    613 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data +
    614 	    ESA_CDATA_HOST_SRC_ADDRH, HI(bufaddr));
    615 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data +
    616 	    ESA_CDATA_HOST_SRC_END_PLUS_1L, LO(bufaddr + size));
    617 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data +
    618 	    ESA_CDATA_HOST_SRC_END_PLUS_1H, HI(bufaddr + size));
    619 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data +
    620 	    ESA_CDATA_HOST_SRC_CURRENTL, LO(bufaddr));
    621 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data +
    622 	    ESA_CDATA_HOST_SRC_CURRENTH, HI(bufaddr));
    623 
    624 	/* DSP buffers */
    625 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data +
    626 	    ESA_CDATA_IN_BUF_BEGIN, dsp_in_buf);
    627 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data +
    628 	    ESA_CDATA_IN_BUF_END_PLUS_1, dsp_in_buf + (dsp_in_size / 2));
    629 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data +
    630 	    ESA_CDATA_IN_BUF_HEAD, dsp_in_buf);
    631 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data +
    632 	    ESA_CDATA_IN_BUF_TAIL, dsp_in_buf);
    633 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data +
    634 	    ESA_CDATA_OUT_BUF_BEGIN, dsp_out_buf);
    635 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data +
    636 	    ESA_CDATA_OUT_BUF_END_PLUS_1, dsp_out_buf + (dsp_out_size / 2));
    637 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data +
    638 	    ESA_CDATA_OUT_BUF_HEAD, dsp_out_buf);
    639 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data +
    640 	    ESA_CDATA_OUT_BUF_TAIL, dsp_out_buf);
    641 
    642 	/* Some per-client initializers */
    643 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data +
    644 	    ESA_SRC3_DIRECTION_OFFSET + 12, dac_data + 40 + 8);
    645 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data +
    646 	    ESA_SRC3_DIRECTION_OFFSET + 19, 0x400 + ESA_MINISRC_COEF_LOC);
    647 	/* Enable or disable low-pass filter? (0xff if rate > 45000) */
    648 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data +
    649 	    ESA_SRC3_DIRECTION_OFFSET + 22,
    650 	    vc->play.mode.sample_rate > 45000 ? 0xff : 0);
    651 	/* Tell it which way DMA is going */
    652 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data +
    653 	    ESA_CDATA_DMA_CONTROL,
    654 	    ESA_DMACONTROL_AUTOREPEAT + ESA_DMAC_PAGE3_SELECTOR +
    655 	    ESA_DMAC_BLOCKF_SELECTOR);
    656 
    657 	/* Set an armload of static initializers */
    658 	for (i = 0; i < (sizeof(esa_playvals) / sizeof(esa_playvals[0])); i++)
    659 		esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data +
    660 		    esa_playvals[i].addr, esa_playvals[i].val);
    661 
    662 	/* Put us in the packed task lists */
    663 	esa_add_list(vc, &sc->msrc_list, dac_data >> ESA_DP_SHIFT_COUNT,
    664 		     vc->index);
    665 	esa_add_list(vc, &sc->dma_list, dac_data >> ESA_DP_SHIFT_COUNT,
    666 		     vc->index);
    667 	esa_add_list(vc, &sc->mixer_list, dac_data >> ESA_DP_SHIFT_COUNT,
    668 		     vc->index);
    669 #undef LO
    670 #undef HI
    671 
    672 	/* XXX */
    673 	//esa_commit_settings(vc);
    674 
    675 	sc->sc_ntimers++;
    676 
    677 	if (sc->sc_ntimers == 1) {
    678 		esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
    679 		    ESA_KDATA_TIMER_COUNT_RELOAD, 240);
    680 		esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
    681 		    ESA_KDATA_TIMER_COUNT_CURRENT, 240);
    682 		data = bus_space_read_2(iot, ioh, ESA_HOST_INT_CTRL);
    683 		bus_space_write_2(iot, ioh, ESA_HOST_INT_CTRL,
    684 		    data | ESA_CLKRUN_GEN_ENABLE);
    685 	}
    686 
    687 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data +
    688 	    ESA_CDATA_INSTANCE_READY, 1);
    689 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
    690 	    ESA_KDATA_MIXER_TASK_NUMBER,
    691 	    sc->mixer_list.indexmap[vc->index]);
    692 
    693 	return 0;
    694 }
    695 
    696 static int
    697 esa_trigger_input(void *hdl, void *start, void *end, int blksize,
    698 		  void (*intr)(void *), void *intrarg,
    699 		  const audio_params_t *param)
    700 {
    701 	struct esa_voice *vc;
    702 	struct esa_softc *sc;
    703 	struct esa_dma *p;
    704 	bus_space_tag_t iot;
    705 	bus_space_handle_t ioh;
    706 	uint32_t data, bufaddr, i;
    707 	size_t size;
    708 	int data_bytes, adc_data, dsp_in_size;
    709 	int dsp_out_size, dsp_in_buf, dsp_out_buf;
    710 
    711 	vc = hdl;
    712 	sc = (struct esa_softc *)vc->parent;
    713 	iot = sc->sc_iot;
    714 	ioh = sc->sc_ioh;
    715 	data_bytes = (((ESA_MINISRC_TMP_BUFFER_SIZE & ~1) +
    716 	    (ESA_MINISRC_IN_BUFFER_SIZE & ~1) +
    717 	    (ESA_MINISRC_OUT_BUFFER_SIZE & ~1) + 4) + 255) & ~255;
    718 	adc_data = ESA_DAC_DATA + (data_bytes * vc->index) + (data_bytes / 2);
    719 	dsp_in_size = ESA_MINISRC_IN_BUFFER_SIZE - (0x10 * 2);
    720 	dsp_out_size = ESA_MINISRC_OUT_BUFFER_SIZE - (0x10 * 2);
    721 	dsp_in_buf = adc_data + (ESA_MINISRC_TMP_BUFFER_SIZE / 2);
    722 	dsp_out_buf = dsp_in_buf + (dsp_in_size / 2) + 1;
    723 
    724 	vc->rec.data_offset = adc_data;
    725 
    726 	/* We only support 1 recording channel */
    727 	if (vc->index > 0)
    728 		return ENODEV;
    729 
    730 	if (vc->rec.active)
    731 		return EINVAL;
    732 
    733 	for (p = vc->dma; p && KERNADDR(p) != start; p = p->next)
    734 		continue;
    735 	if (p == NULL) {
    736 		printf("%s: esa_trigger_input: bad addr %p\n",
    737 		    sc->sc_dev.dv_xname, start);
    738 		return EINVAL;
    739 	}
    740 
    741 	vc->rec.active = 1;
    742 	vc->rec.intr = intr;
    743 	vc->rec.arg = intrarg;
    744 	vc->rec.pos = 0;
    745 	vc->rec.count = 0;
    746 	vc->rec.buf = start;
    747 	vc->rec.bufsize = size = (size_t)(((caddr_t)end - (caddr_t)start));
    748 	vc->rec.blksize = blksize;
    749 	bufaddr = DMAADDR(p);
    750 	vc->rec.start = bufaddr;
    751 
    752 #define LO(x) ((x) & 0x0000ffff)
    753 #define HI(x) ((x) >> 16)
    754 
    755 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
    756 	    ESA_CDATA_HOST_SRC_ADDRL, LO(bufaddr));
    757 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
    758 	    ESA_CDATA_HOST_SRC_ADDRH, HI(bufaddr));
    759 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
    760 	    ESA_CDATA_HOST_SRC_END_PLUS_1L, LO(bufaddr + size));
    761 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
    762 	    ESA_CDATA_HOST_SRC_END_PLUS_1H, HI(bufaddr + size));
    763 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
    764 	    ESA_CDATA_HOST_SRC_CURRENTL, LO(bufaddr));
    765 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
    766 	    ESA_CDATA_HOST_SRC_CURRENTH, HI(bufaddr));
    767 
    768 	/* DSP buffers */
    769 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
    770 	    ESA_CDATA_IN_BUF_BEGIN, dsp_in_buf);
    771 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
    772 	    ESA_CDATA_IN_BUF_END_PLUS_1, dsp_in_buf + (dsp_in_size / 2));
    773 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
    774 	    ESA_CDATA_IN_BUF_HEAD, dsp_in_buf);
    775 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
    776 	    ESA_CDATA_IN_BUF_TAIL, dsp_in_buf);
    777 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
    778 	    ESA_CDATA_OUT_BUF_BEGIN, dsp_out_buf);
    779 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
    780 	    ESA_CDATA_OUT_BUF_END_PLUS_1, dsp_out_buf + (dsp_out_size / 2));
    781 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
    782 	    ESA_CDATA_OUT_BUF_HEAD, dsp_out_buf);
    783 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
    784 	    ESA_CDATA_OUT_BUF_TAIL, dsp_out_buf);
    785 
    786 	/* Some per-client initializers */
    787 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
    788 	    ESA_SRC3_DIRECTION_OFFSET + 12, adc_data + 40 + 8);
    789 	/* Tell it which way DMA is going */
    790 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
    791 	    ESA_CDATA_DMA_CONTROL,
    792 	    ESA_DMACONTROL_DIRECTION + ESA_DMACONTROL_AUTOREPEAT +
    793 	    ESA_DMAC_PAGE3_SELECTOR + ESA_DMAC_BLOCKF_SELECTOR);
    794 
    795 	/* Set an armload of static initializers */
    796 	for (i = 0; i < (sizeof(esa_recvals) / sizeof(esa_recvals[0])); i++)
    797 		esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
    798 		    esa_recvals[i].addr, esa_recvals[i].val);
    799 
    800 	/* Put us in the packed task lists */
    801 	esa_add_list(vc, &sc->adc1_list, adc_data >> ESA_DP_SHIFT_COUNT,
    802 		     vc->index + ESA_NUM_VOICES);
    803 	esa_add_list(vc, &sc->msrc_list, adc_data >> ESA_DP_SHIFT_COUNT,
    804 		     vc->index + ESA_NUM_VOICES);
    805 	esa_add_list(vc, &sc->dma_list, adc_data >> ESA_DP_SHIFT_COUNT,
    806 		     vc->index + ESA_NUM_VOICES);
    807 #undef LO
    808 #undef HI
    809 
    810 	/* XXX */
    811 	//esa_commit_settings(vc);
    812 
    813 	sc->sc_ntimers++;
    814 	if (sc->sc_ntimers == 1) {
    815 		esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
    816 		    ESA_KDATA_TIMER_COUNT_RELOAD, 240);
    817 		esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
    818 		    ESA_KDATA_TIMER_COUNT_CURRENT, 240);
    819 		data = bus_space_read_2(iot, ioh, ESA_HOST_INT_CTRL);
    820 		bus_space_write_2(iot, ioh, ESA_HOST_INT_CTRL,
    821 		    data | ESA_CLKRUN_GEN_ENABLE);
    822 	}
    823 
    824 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
    825 	    ESA_CDATA_INSTANCE_READY, 1);
    826 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, ESA_KDATA_ADC1_REQUEST,
    827 	    1);
    828 
    829 	return 0;
    830 }
    831 
    832 /* Interrupt handler */
    833 static int
    834 esa_intr(void *hdl)
    835 {
    836 	struct esa_softc *sc;
    837 	struct esa_voice *vc;
    838 	bus_space_tag_t iot;
    839 	bus_space_handle_t ioh;
    840 	uint8_t status;
    841 	uint32_t pos;
    842 	uint32_t diff;
    843 	uint32_t blksize;
    844 	int i;
    845 
    846 	sc = hdl;
    847 	iot = sc->sc_iot;
    848 	ioh = sc->sc_ioh;
    849 
    850 	status = bus_space_read_1(iot, ioh, ESA_HOST_INT_STATUS);
    851 	if (status == 0xff)
    852 		return 0;
    853 
    854 	/* ack the interrupt */
    855 	bus_space_write_1(iot, ioh, ESA_HOST_INT_STATUS, status);
    856 
    857 	if (status & ESA_HV_INT_PENDING) {
    858 		uint8_t event;
    859 
    860 		printf("%s: hardware volume interrupt\n", sc->sc_dev.dv_xname);
    861 		event = bus_space_read_1(iot, ioh, ESA_HW_VOL_COUNTER_MASTER);
    862 		switch(event) {
    863 		case 0x99:
    864 		case 0xaa:
    865 		case 0x66:
    866 		case 0x88:
    867 			printf("%s: esa_intr: FIXME\n", sc->sc_dev.dv_xname);
    868 			break;
    869 		default:
    870 			printf("%s: unknown hwvol event 0x%02x\n",
    871 			    sc->sc_dev.dv_xname, event);
    872 			break;
    873 		}
    874 		bus_space_write_1(iot, ioh, ESA_HW_VOL_COUNTER_MASTER, 0x88);
    875 	}
    876 
    877 	if ((status & ESA_ASSP_INT_PENDING) == 0 ||
    878 	    (bus_space_read_1(iot, ioh,
    879 	     ESA_ASSP_CONTROL_B) & ESA_STOP_ASSP_CLOCK) != 0 ||
    880 	    (bus_space_read_1(iot, ioh,
    881 	     ESA_ASSP_HOST_INT_STATUS) & ESA_DSP2HOST_REQ_TIMER) == 0)
    882 		return 1;
    883 
    884 	bus_space_write_1(iot, ioh, ESA_ASSP_HOST_INT_STATUS,
    885 	    ESA_DSP2HOST_REQ_TIMER);
    886 
    887 	for (i = 0; i < ESA_NUM_VOICES; i++) {
    888 		vc = &sc->voice[i];
    889 
    890 		if (vc->play.active) {
    891 			pos = esa_get_pointer(sc, &vc->play) % vc->play.bufsize;
    892 			diff = (vc->play.bufsize + pos - vc->play.pos) %
    893 			    vc->play.bufsize;
    894 
    895 			vc->play.pos = pos;
    896 			vc->play.count += diff;
    897 			blksize = vc->play.blksize;
    898 
    899 			while (vc->play.count >= blksize) {
    900 				vc->play.count -= blksize;
    901 				(*vc->play.intr)(vc->play.arg);
    902 			}
    903 		}
    904 
    905 		if (vc->rec.active) {
    906 			pos = esa_get_pointer(sc, &vc->rec) % vc->rec.bufsize;
    907 			diff = (vc->rec.bufsize + pos - vc->rec.pos) %
    908 			    vc->rec.bufsize;
    909 
    910 			vc->rec.pos = pos;
    911 			vc->rec.count += diff;
    912 			blksize = vc->rec.blksize;
    913 
    914 			while (vc->rec.count >= blksize) {
    915 				vc->rec.count -= blksize;
    916 				(*vc->rec.intr)(vc->rec.arg);
    917 			}
    918 		}
    919 	}
    920 
    921 	return 1;
    922 }
    923 
    924 static int
    925 esa_allocmem(struct esa_softc *sc, size_t size, size_t align,
    926 	     struct esa_dma *p)
    927 {
    928 	int error;
    929 
    930 	p->size = size;
    931 	error = bus_dmamem_alloc(sc->sc_dmat, p->size, align, 0,
    932 				 p->segs, sizeof(p->segs) / sizeof(p->segs[0]),
    933 				 &p->nsegs, BUS_DMA_NOWAIT);
    934 	if (error)
    935 		return error;
    936 
    937 	error = bus_dmamem_map(sc->sc_dmat, p->segs, p->nsegs, p->size,
    938 				&p->addr, BUS_DMA_NOWAIT | BUS_DMA_COHERENT);
    939 	if (error)
    940 		goto free;
    941 
    942 	error = bus_dmamap_create(sc->sc_dmat, p->size, 1, p->size, 0,
    943 				  BUS_DMA_NOWAIT, &p->map);
    944 	if (error)
    945 		goto unmap;
    946 
    947 	error = bus_dmamap_load(sc->sc_dmat, p->map, p->addr, p->size, NULL,
    948 				BUS_DMA_NOWAIT);
    949 	if (error)
    950 		goto destroy;
    951 
    952 	return 0;
    953 
    954 destroy:
    955 	bus_dmamap_destroy(sc->sc_dmat, p->map);
    956 unmap:
    957 	bus_dmamem_unmap(sc->sc_dmat, p->addr, p->size);
    958 free:
    959 	bus_dmamem_free(sc->sc_dmat, p->segs, p->nsegs);
    960 
    961 	return error;
    962 }
    963 
    964 static int
    965 esa_freemem(struct esa_softc *sc, struct esa_dma *p)
    966 {
    967 
    968 	bus_dmamap_unload(sc->sc_dmat, p->map);
    969 	bus_dmamap_destroy(sc->sc_dmat, p->map);
    970 	bus_dmamem_unmap(sc->sc_dmat, p->addr, p->size);
    971 	bus_dmamem_free(sc->sc_dmat, p->segs, p->nsegs);
    972 
    973 	return 0;
    974 }
    975 
    976 /*
    977  * Supporting Subroutines
    978  */
    979 
    980 static int
    981 esa_match(struct device *dev, struct cfdata *match, void *aux)
    982 {
    983 	struct pci_attach_args *pa;
    984 
    985 	pa = (struct pci_attach_args *)aux;
    986 	switch (PCI_VENDOR(pa->pa_id)) {
    987 	case PCI_VENDOR_ESSTECH:
    988 		switch(PCI_PRODUCT(pa->pa_id)) {
    989 		case PCI_PRODUCT_ESSTECH_ALLEGRO1:
    990 		case PCI_PRODUCT_ESSTECH_MAESTRO3:
    991 		case PCI_PRODUCT_ESSTECH_MAESTRO3_2:
    992 			return 1;
    993 		}
    994 	}
    995 
    996 	return 0;
    997 }
    998 
    999 static void
   1000 esa_attach(struct device *parent, struct device *self, void *aux)
   1001 {
   1002 	struct esa_softc *sc;
   1003 	struct pci_attach_args *pa;
   1004 	pcitag_t tag;
   1005 	pci_chipset_tag_t pc;
   1006 	pci_intr_handle_t ih;
   1007 	const struct esa_card_type *card;
   1008 	const char *intrstr;
   1009 	uint32_t data;
   1010 	char devinfo[256];
   1011 	int revision, len;
   1012 	int i;
   1013 	int error;
   1014 
   1015 	sc = (struct esa_softc *)self;
   1016 	pa = (struct pci_attach_args *)aux;
   1017 	tag = pa->pa_tag;
   1018 	pc = pa->pa_pc;
   1019 	aprint_naive(": Audio controller\n");
   1020 
   1021 	pci_devinfo(pa->pa_id, pa->pa_class, 0, devinfo, sizeof(devinfo));
   1022 	revision = PCI_REVISION(pa->pa_class);
   1023 	aprint_normal(": %s (rev. 0x%02x)\n", devinfo, revision);
   1024 
   1025 	for (card = esa_card_types; card->pci_vendor_id; card++)
   1026 		if (PCI_VENDOR(pa->pa_id) == card->pci_vendor_id &&
   1027 		    PCI_PRODUCT(pa->pa_id) == card->pci_product_id) {
   1028 			sc->type = card->type;
   1029 			sc->delay1 = card->delay1;
   1030 			sc->delay2 = card->delay2;
   1031 			break;
   1032 		}
   1033 
   1034 	data = pci_conf_read(pc, tag, PCI_COMMAND_STATUS_REG);
   1035 	data |= (PCI_COMMAND_IO_ENABLE | PCI_COMMAND_MEM_ENABLE
   1036 	    | PCI_COMMAND_MASTER_ENABLE);
   1037 	pci_conf_write(pc, tag, PCI_COMMAND_STATUS_REG, data);
   1038 
   1039 	/* Map I/O register */
   1040 	if (pci_mapreg_map(pa, PCI_CBIO, PCI_MAPREG_TYPE_IO, 0,
   1041 	    &sc->sc_iot, &sc->sc_ioh, &sc->sc_iob, &sc->sc_ios)) {
   1042 		aprint_error("%s: can't map i/o space\n", sc->sc_dev.dv_xname);
   1043 		return;
   1044 	}
   1045 
   1046 	/* Initialize softc */
   1047 	sc->sc_tag = tag;
   1048 	sc->sc_pct = pc;
   1049 	sc->sc_dmat = pa->pa_dmat;
   1050 
   1051 	/* Map and establish an interrupt */
   1052 	if (pci_intr_map(pa, &ih)) {
   1053 		aprint_error("%s: can't map interrupt\n", sc->sc_dev.dv_xname);
   1054 		return;
   1055 	}
   1056 	intrstr = pci_intr_string(pc, ih);
   1057 	sc->sc_ih = pci_intr_establish(pc, ih, IPL_AUDIO, esa_intr, self);
   1058 	if (sc->sc_ih == NULL) {
   1059 		aprint_error("%s: can't establish interrupt",
   1060 		    sc->sc_dev.dv_xname);
   1061 		if (intrstr != NULL)
   1062 			aprint_normal(" at %s", intrstr);
   1063 		aprint_normal("\n");
   1064 		return;
   1065 	}
   1066 	aprint_normal("%s: interrupting at %s\n", sc->sc_dev.dv_xname, intrstr);
   1067 
   1068 	/* power up chip */
   1069 	if ((error = pci_activate(pa->pa_pc, pa->pa_tag, sc,
   1070 	    pci_activate_null)) && error != EOPNOTSUPP) {
   1071 		aprint_error("%s: cannot activate %d\n", sc->sc_dev.dv_xname,
   1072 		    error);
   1073 		return;
   1074 	}
   1075 
   1076 	/* Init chip */
   1077 	if (esa_init(sc) == -1) {
   1078 		aprint_error("%s: esa_attach: unable to initialize the card\n",
   1079 		    sc->sc_dev.dv_xname);
   1080 		return;
   1081 	}
   1082 
   1083 	/* create suspend save area */
   1084 	len = sizeof(uint16_t) * (ESA_REV_B_CODE_MEMORY_LENGTH
   1085 	    + ESA_REV_B_DATA_MEMORY_LENGTH + 1);
   1086 	sc->savemem = (uint16_t *)malloc(len, M_DEVBUF, M_NOWAIT | M_ZERO);
   1087 	if (sc->savemem == NULL) {
   1088 		aprint_error("%s: unable to allocate suspend buffer\n",
   1089 		    sc->sc_dev.dv_xname);
   1090 		return;
   1091 	}
   1092 
   1093 	/*
   1094 	 * Every card I've seen has had their channels swapped with respect
   1095 	 * to the mixer. Ie:
   1096 	 *  $ mixerctl -w outputs.master=0,191
   1097 	 * Would result in the _right_ speaker being turned off.
   1098 	 *
   1099 	 * So, we will swap the left and right mixer channels to compensate
   1100 	 * for this.
   1101 	 */
   1102 	sc->codec_flags = AC97_HOST_SWAPPED_CHANNELS;
   1103 
   1104 	/* Attach AC97 host interface */
   1105 	sc->host_if.arg = self;
   1106 	sc->host_if.attach = esa_attach_codec;
   1107 	sc->host_if.read = esa_read_codec;
   1108 	sc->host_if.write = esa_write_codec;
   1109 	sc->host_if.reset = esa_reset_codec;
   1110 	sc->host_if.flags = esa_flags_codec;
   1111 
   1112 	if (ac97_attach(&sc->host_if, self) != 0)
   1113 		return;
   1114 
   1115 	/* initialize list management structures */
   1116 	sc->mixer_list.mem_addr = ESA_KDATA_MIXER_XFER0;
   1117 	sc->mixer_list.max = ESA_MAX_VIRTUAL_MIXER_CHANNELS;
   1118 	sc->adc1_list.mem_addr = ESA_KDATA_ADC1_XFER0;
   1119 	sc->adc1_list.max = ESA_MAX_VIRTUAL_ADC1_CHANNELS;
   1120 	sc->dma_list.mem_addr = ESA_KDATA_DMA_XFER0;
   1121 	sc->dma_list.max = ESA_MAX_VIRTUAL_DMA_CHANNELS;
   1122 	sc->msrc_list.mem_addr = ESA_KDATA_INSTANCE0_MINISRC;
   1123 	sc->msrc_list.max = ESA_MAX_INSTANCE_MINISRC;
   1124 
   1125 	/* initialize index maps */
   1126 	for (i = 0; i < ESA_NUM_VOICES * 2; i++) {
   1127 		sc->mixer_list.indexmap[i] = -1;
   1128 		sc->msrc_list.indexmap[i] = -1;
   1129 		sc->dma_list.indexmap[i] = -1;
   1130 		sc->adc1_list.indexmap[i] = -1;
   1131 	}
   1132 	for (i = 0; i < ESA_NUM_VOICES; i++) {
   1133 		sc->voice[i].parent = (struct device *)sc;
   1134 		sc->voice[i].index = i;
   1135 		sc->sc_audiodev[i] =
   1136 		    audio_attach_mi(&esa_hw_if, &sc->voice[i], &sc->sc_dev);
   1137 	}
   1138 
   1139 	sc->powerhook = powerhook_establish(esa_powerhook, sc);
   1140 	if (sc->powerhook == NULL)
   1141 		aprint_error("%s: WARNING: unable to establish powerhook\n",
   1142 		    sc->sc_dev.dv_xname);
   1143 
   1144 	return;
   1145 }
   1146 
   1147 static int
   1148 esa_detach(struct device *self, int flags)
   1149 {
   1150 	struct esa_softc *sc;
   1151 	int i;
   1152 
   1153 	sc = (struct esa_softc *)self;
   1154 	for (i = 0; i < ESA_NUM_VOICES; i++) {
   1155 		if (sc->sc_audiodev[i] != NULL)
   1156 			config_detach(sc->sc_audiodev[i], flags);
   1157 	}
   1158 
   1159 	if (sc->sc_ih != NULL)
   1160 		pci_intr_disestablish(sc->sc_pct, sc->sc_ih);
   1161 	if (sc->sc_ios)
   1162 		bus_space_unmap(sc->sc_iot, sc->sc_ioh, sc->sc_ios);
   1163 
   1164 	free(sc->savemem, M_DEVBUF);
   1165 
   1166 	return 0;
   1167 }
   1168 
   1169 static uint16_t
   1170 esa_read_assp(struct esa_softc *sc, uint16_t region, uint16_t index)
   1171 {
   1172 	uint16_t data;
   1173 	bus_space_tag_t iot;
   1174 	bus_space_handle_t ioh;
   1175 
   1176 	iot = sc->sc_iot;
   1177 	ioh = sc->sc_ioh;
   1178 	bus_space_write_2(iot, ioh, ESA_DSP_PORT_MEMORY_TYPE,
   1179 	    region & ESA_MEMTYPE_MASK);
   1180 	bus_space_write_2(iot, ioh, ESA_DSP_PORT_MEMORY_INDEX, index);
   1181 	data = bus_space_read_2(iot, ioh, ESA_DSP_PORT_MEMORY_DATA);
   1182 
   1183 	return data;
   1184 }
   1185 
   1186 static void
   1187 esa_write_assp(struct esa_softc *sc, uint16_t region, uint16_t index,
   1188 	       uint16_t data)
   1189 {
   1190 	bus_space_tag_t iot;
   1191 	bus_space_handle_t ioh;
   1192 
   1193 	iot = sc->sc_iot;
   1194 	ioh = sc->sc_ioh;
   1195 	bus_space_write_2(iot, ioh, ESA_DSP_PORT_MEMORY_TYPE,
   1196 	    region & ESA_MEMTYPE_MASK);
   1197 	bus_space_write_2(iot, ioh, ESA_DSP_PORT_MEMORY_INDEX, index);
   1198 	bus_space_write_2(iot, ioh, ESA_DSP_PORT_MEMORY_DATA, data);
   1199 
   1200 	return;
   1201 }
   1202 
   1203 static int
   1204 esa_init_codec(struct esa_softc *sc)
   1205 {
   1206 	bus_space_tag_t iot;
   1207 	bus_space_handle_t ioh;
   1208 	uint32_t data;
   1209 
   1210 	iot = sc->sc_iot;
   1211 	ioh = sc->sc_ioh;
   1212 	data = bus_space_read_1(iot, ioh, ESA_CODEC_COMMAND);
   1213 
   1214 	return (data & 0x1) ? 0 : 1;
   1215 }
   1216 
   1217 static int
   1218 esa_attach_codec(void *aux, struct ac97_codec_if *codec_if)
   1219 {
   1220 	struct esa_softc *sc;
   1221 
   1222 	sc = aux;
   1223 	sc->codec_if = codec_if;
   1224 
   1225 	return 0;
   1226 }
   1227 
   1228 static int
   1229 esa_read_codec(void *aux, uint8_t reg, uint16_t *result)
   1230 {
   1231 	struct esa_softc *sc;
   1232 	bus_space_tag_t iot;
   1233 	bus_space_handle_t ioh;
   1234 
   1235 	sc = aux;
   1236 	iot = sc->sc_iot;
   1237 	ioh = sc->sc_ioh;
   1238 	if (esa_wait(sc))
   1239 		printf("%s: esa_read_codec: timed out\n", sc->sc_dev.dv_xname);
   1240 	bus_space_write_1(iot, ioh, ESA_CODEC_COMMAND, (reg & 0x7f) | 0x80);
   1241 	delay(50);
   1242 	if (esa_wait(sc))
   1243 		printf("%s: esa_read_codec: timed out\n", sc->sc_dev.dv_xname);
   1244 	*result = bus_space_read_2(iot, ioh, ESA_CODEC_DATA);
   1245 
   1246 	return 0;
   1247 }
   1248 
   1249 static int
   1250 esa_write_codec(void *aux, uint8_t reg, uint16_t data)
   1251 {
   1252 	struct esa_softc *sc;
   1253 	bus_space_tag_t iot;
   1254 	bus_space_handle_t ioh;
   1255 
   1256 	sc = aux;
   1257 	iot = sc->sc_iot;
   1258 	ioh = sc->sc_ioh;
   1259 	if (esa_wait(sc)) {
   1260 		printf("%s: esa_write_codec: timed out\n", sc->sc_dev.dv_xname);
   1261 		return -1;
   1262 	}
   1263 	bus_space_write_2(iot, ioh, ESA_CODEC_DATA, data);
   1264 	bus_space_write_1(iot, ioh, ESA_CODEC_COMMAND, reg & 0x7f);
   1265 	delay(50);
   1266 
   1267 	return 0;
   1268 }
   1269 
   1270 static int
   1271 esa_reset_codec(void *aux)
   1272 {
   1273 
   1274 	return 0;
   1275 }
   1276 
   1277 static enum ac97_host_flags
   1278 esa_flags_codec(void *aux)
   1279 {
   1280 	struct esa_softc *sc;
   1281 
   1282 	sc = aux;
   1283 	return sc->codec_flags;
   1284 }
   1285 
   1286 static int
   1287 esa_wait(struct esa_softc *sc)
   1288 {
   1289 	int i, val;
   1290 	bus_space_tag_t iot;
   1291 	bus_space_handle_t ioh;
   1292 
   1293 	iot = sc->sc_iot;
   1294 	ioh = sc->sc_ioh;
   1295 	for (i = 0; i < 20; i++) {
   1296 		val = bus_space_read_1(iot, ioh, ESA_CODEC_STATUS);
   1297 		if ((val & 1) == 0)
   1298 			return 0;
   1299 		delay(2);
   1300 	}
   1301 
   1302 	return -1;
   1303 }
   1304 
   1305 static int
   1306 esa_init(struct esa_softc *sc)
   1307 {
   1308 	struct esa_voice *vc;
   1309 	bus_space_tag_t iot;
   1310 	bus_space_handle_t ioh;
   1311 	pcitag_t tag;
   1312 	pci_chipset_tag_t pc;
   1313 	uint32_t data, i, size;
   1314 	uint8_t reset_state;
   1315 	int data_bytes;
   1316 
   1317 	iot = sc->sc_iot;
   1318 	ioh = sc->sc_ioh;
   1319 	tag = sc->sc_tag;
   1320 	pc = sc->sc_pct;
   1321 	data_bytes = (((ESA_MINISRC_TMP_BUFFER_SIZE & ~1) +
   1322 	    (ESA_MINISRC_IN_BUFFER_SIZE & ~1) +
   1323 	    (ESA_MINISRC_OUT_BUFFER_SIZE & ~1) + 4) + 255) & ~255;
   1324 
   1325 	/* Disable legacy emulation */
   1326 	data = pci_conf_read(pc, tag, PCI_LEGACY_AUDIO_CTRL);
   1327 	data |= DISABLE_LEGACY;
   1328 	pci_conf_write(pc, tag, PCI_LEGACY_AUDIO_CTRL, data);
   1329 
   1330 	esa_config(sc);
   1331 
   1332 	reset_state = esa_assp_halt(sc);
   1333 
   1334 	esa_init_codec(sc);
   1335 	esa_codec_reset(sc);
   1336 
   1337 	/* Zero kernel and mixer data */
   1338 	size = ESA_REV_B_DATA_MEMORY_UNIT_LENGTH * ESA_NUM_UNITS_KERNEL_DATA;
   1339 	for (i = 0; i < size / 2; i++) {
   1340 		esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
   1341 		    ESA_KDATA_BASE_ADDR + i, 0);
   1342 		esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
   1343 		    ESA_KDATA_BASE_ADDR2 + i, 0);
   1344 	}
   1345 
   1346 	/* Init DMA pointer */
   1347 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, ESA_KDATA_CURRENT_DMA,
   1348 	    ESA_KDATA_DMA_XFER0);
   1349 
   1350 	/* Write kernel code into memory */
   1351 	size = sizeof(esa_assp_kernel_image);
   1352 	for (i = 0; i < size / 2; i++)
   1353 		esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_CODE,
   1354 		    ESA_REV_B_CODE_MEMORY_BEGIN + i, esa_assp_kernel_image[i]);
   1355 
   1356 	size = sizeof(esa_assp_minisrc_image);
   1357 	for (i = 0; i < size / 2; i++)
   1358 		esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_CODE, 0x400 + i,
   1359 		    esa_assp_minisrc_image[i]);
   1360 
   1361 	/* Write the coefficients for the low pass filter */
   1362 	size = sizeof(esa_minisrc_lpf_image);
   1363 	for (i = 0; i < size / 2; i++)
   1364 		esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_CODE,
   1365 		    0x400 + ESA_MINISRC_COEF_LOC + i, esa_minisrc_lpf_image[i]);
   1366 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_CODE,
   1367 	    0x400 + ESA_MINISRC_COEF_LOC + size, 0x8000);
   1368 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, ESA_KDATA_TASK0, 0x400);
   1369 	/* Init the mixer number */
   1370 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
   1371 	     ESA_KDATA_MIXER_TASK_NUMBER, 0);
   1372 	/* Extreme kernel master volume */
   1373 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
   1374 	    ESA_KDATA_DAC_LEFT_VOLUME, ESA_ARB_VOLUME);
   1375 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
   1376 	    ESA_KDATA_DAC_RIGHT_VOLUME, ESA_ARB_VOLUME);
   1377 
   1378 	if (esa_amp_enable(sc))
   1379 		return -1;
   1380 
   1381 	/* Zero entire DAC/ADC area */
   1382 	for (i = 0x1100; i < 0x1c00; i++)
   1383 		esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, i, 0);
   1384 
   1385 	/* set some sane defaults */
   1386 	for (i = 0; i < ESA_NUM_VOICES; i++) {
   1387 		vc = &sc->voice[i];
   1388 		vc->play.data_offset = ESA_DAC_DATA + (data_bytes * i);
   1389 		vc->rec.data_offset = ESA_DAC_DATA + (data_bytes * i * 2);
   1390 	}
   1391 
   1392 	esa_enable_interrupts(sc);
   1393 
   1394 	bus_space_write_1(iot, ioh, ESA_DSP_PORT_CONTROL_REG_B,
   1395 	    reset_state | ESA_REGB_ENABLE_RESET);
   1396 
   1397 	return 0;
   1398 }
   1399 
   1400 static void
   1401 esa_config(struct esa_softc *sc)
   1402 {
   1403 	bus_space_tag_t iot;
   1404 	bus_space_handle_t ioh;
   1405 	pcitag_t tag;
   1406 	pci_chipset_tag_t pc;
   1407 	uint32_t data;
   1408 
   1409 	iot = sc->sc_iot;
   1410 	ioh = sc->sc_ioh;
   1411 	tag = sc->sc_tag;
   1412 	pc = sc->sc_pct;
   1413 
   1414 	data = pci_conf_read(pc, tag, ESA_PCI_ALLEGRO_CONFIG);
   1415 	data &= ESA_REDUCED_DEBOUNCE;
   1416 	data |= ESA_PM_CTRL_ENABLE | ESA_CLK_DIV_BY_49 | ESA_USE_PCI_TIMING;
   1417 	pci_conf_write(pc, tag, ESA_PCI_ALLEGRO_CONFIG, data);
   1418 
   1419 	bus_space_write_1(iot, ioh, ESA_ASSP_CONTROL_B, ESA_RESET_ASSP);
   1420 	data = pci_conf_read(pc, tag, ESA_PCI_ALLEGRO_CONFIG);
   1421 	data &= ~ESA_INT_CLK_SELECT;
   1422 	if (sc->type == ESS_MAESTRO3) {
   1423 		data &= ~ESA_INT_CLK_MULT_ENABLE;
   1424 		data |= ESA_INT_CLK_SRC_NOT_PCI;
   1425 	}
   1426 	data &= ~(ESA_CLK_MULT_MODE_SELECT | ESA_CLK_MULT_MODE_SELECT_2);
   1427 	pci_conf_write(pc, tag, ESA_PCI_ALLEGRO_CONFIG, data);
   1428 
   1429 	if (sc->type == ESS_ALLEGRO1) {
   1430 		data = pci_conf_read(pc, tag, ESA_PCI_USER_CONFIG);
   1431 		data |= ESA_IN_CLK_12MHZ_SELECT;
   1432 		pci_conf_write(pc, tag, ESA_PCI_USER_CONFIG, data);
   1433 	}
   1434 
   1435 	data = bus_space_read_1(iot, ioh, ESA_ASSP_CONTROL_A);
   1436 	data &= ~(ESA_DSP_CLK_36MHZ_SELECT | ESA_ASSP_CLK_49MHZ_SELECT);
   1437 	data |= ESA_ASSP_CLK_49MHZ_SELECT;	/* XXX: Assumes 49MHz DSP */
   1438 	data |= ESA_ASSP_0_WS_ENABLE;
   1439 	bus_space_write_1(iot, ioh, ESA_ASSP_CONTROL_A, data);
   1440 
   1441 	bus_space_write_1(iot, ioh, ESA_ASSP_CONTROL_B, ESA_RUN_ASSP);
   1442 
   1443 	return;
   1444 }
   1445 
   1446 static uint8_t
   1447 esa_assp_halt(struct esa_softc *sc)
   1448 {
   1449 	bus_space_tag_t iot;
   1450 	bus_space_handle_t ioh;
   1451 	uint8_t data, reset_state;
   1452 
   1453 	iot = sc->sc_iot;
   1454 	ioh = sc->sc_ioh;
   1455 	data = bus_space_read_1(iot, ioh, ESA_DSP_PORT_CONTROL_REG_B);
   1456 	reset_state = data & ~ESA_REGB_STOP_CLOCK;
   1457 	delay(10000);		/* XXX use tsleep */
   1458 	bus_space_write_1(iot, ioh, ESA_DSP_PORT_CONTROL_REG_B,
   1459 			reset_state & ~ESA_REGB_ENABLE_RESET);
   1460 	delay(10000);		/* XXX use tsleep */
   1461 
   1462 	return reset_state;
   1463 }
   1464 
   1465 static void
   1466 esa_codec_reset(struct esa_softc *sc)
   1467 {
   1468 	bus_space_tag_t iot;
   1469 	bus_space_handle_t ioh;
   1470 	uint16_t data, dir;
   1471 	int retry;
   1472 
   1473 	iot = sc->sc_iot;
   1474 	ioh = sc->sc_ioh;
   1475 	retry = 0;
   1476 	do {
   1477 		data = bus_space_read_2(iot, ioh, ESA_GPIO_DIRECTION);
   1478 		dir = data | 0x10; /* assuming pci bus master? */
   1479 
   1480 		/* remote codec config */
   1481 		data = bus_space_read_2(iot, ioh, ESA_RING_BUS_CTRL_B);
   1482 		bus_space_write_2(iot, ioh, ESA_RING_BUS_CTRL_B,
   1483 		    data & ~ESA_SECOND_CODEC_ID_MASK);
   1484 		data = bus_space_read_2(iot, ioh, ESA_SDO_OUT_DEST_CTRL);
   1485 		bus_space_write_2(iot, ioh, ESA_SDO_OUT_DEST_CTRL,
   1486 		    data & ~ESA_COMMAND_ADDR_OUT);
   1487 		data = bus_space_read_2(iot, ioh, ESA_SDO_IN_DEST_CTRL);
   1488 		bus_space_write_2(iot, ioh, ESA_SDO_IN_DEST_CTRL,
   1489 		    data & ~ESA_STATUS_ADDR_IN);
   1490 
   1491 		bus_space_write_2(iot, ioh, ESA_RING_BUS_CTRL_A,
   1492 				  ESA_IO_SRAM_ENABLE);
   1493 		delay(20);
   1494 
   1495 		bus_space_write_2(iot, ioh, ESA_GPIO_DIRECTION,
   1496 		    dir & ~ESA_GPO_PRIMARY_AC97);
   1497 		bus_space_write_2(iot, ioh, ESA_GPIO_MASK,
   1498 				  ~ESA_GPO_PRIMARY_AC97);
   1499 		bus_space_write_2(iot, ioh, ESA_GPIO_DATA, 0);
   1500 		bus_space_write_2(iot, ioh, ESA_GPIO_DIRECTION,
   1501 		    dir | ESA_GPO_PRIMARY_AC97);
   1502 		delay(sc->delay1 * 1000);
   1503 		bus_space_write_2(iot, ioh, ESA_GPIO_DATA,
   1504 				  ESA_GPO_PRIMARY_AC97);
   1505 		delay(5);
   1506 		bus_space_write_2(iot, ioh, ESA_RING_BUS_CTRL_A,
   1507 		    ESA_IO_SRAM_ENABLE | ESA_SERIAL_AC_LINK_ENABLE);
   1508 		bus_space_write_2(iot, ioh, ESA_GPIO_MASK, ~0);
   1509 		delay(sc->delay2 * 1000);
   1510 
   1511 		esa_read_codec(sc, 0x7c, &data);
   1512 		if ((data == 0) || (data == 0xffff)) {
   1513 			retry++;
   1514 			if (retry > 3) {
   1515 				printf("%s: esa_codec_reset: failed\n",
   1516 				    sc->sc_dev.dv_xname);
   1517 				break;
   1518 			}
   1519 			printf("%s: esa_codec_reset: retrying\n",
   1520 			    sc->sc_dev.dv_xname);
   1521 		} else
   1522 			retry = 0;
   1523 	} while (retry);
   1524 
   1525 	return;
   1526 }
   1527 
   1528 static int
   1529 esa_amp_enable(struct esa_softc *sc)
   1530 {
   1531 	bus_space_tag_t iot;
   1532 	bus_space_handle_t ioh;
   1533 	uint32_t gpo, polarity_port, polarity;
   1534 	uint16_t data;
   1535 
   1536 	iot = sc->sc_iot;
   1537 	ioh = sc->sc_ioh;
   1538 	switch (sc->type) {
   1539 	case ESS_ALLEGRO1:
   1540 		polarity_port = 0x1800;
   1541 		break;
   1542 	case ESS_MAESTRO3:
   1543 		polarity_port = 0x1100;
   1544 		break;
   1545 	default:
   1546 		printf("%s: esa_amp_enable: Unknown chip type!!!\n",
   1547 		    sc->sc_dev.dv_xname);
   1548 		return 1;
   1549 	}
   1550 
   1551 	gpo = (polarity_port >> 8) & 0x0f;
   1552 	polarity = polarity_port >> 12;
   1553 	polarity = !polarity;	/* Enable */
   1554 	polarity = polarity << gpo;
   1555 	gpo = 1 << gpo;
   1556 	bus_space_write_2(iot, ioh, ESA_GPIO_MASK, ~gpo);
   1557 	data = bus_space_read_2(iot, ioh, ESA_GPIO_DIRECTION);
   1558 	bus_space_write_2(iot, ioh, ESA_GPIO_DIRECTION, data | gpo);
   1559 	data = ESA_GPO_SECONDARY_AC97 | ESA_GPO_PRIMARY_AC97 | polarity;
   1560 	bus_space_write_2(iot, ioh, ESA_GPIO_DATA, data);
   1561 	bus_space_write_2(iot, ioh, ESA_GPIO_MASK, ~0);
   1562 
   1563 	return 0;
   1564 }
   1565 
   1566 static void
   1567 esa_enable_interrupts(struct esa_softc *sc)
   1568 {
   1569 	bus_space_tag_t iot;
   1570 	bus_space_handle_t ioh;
   1571 	uint8_t data;
   1572 
   1573 	iot = sc->sc_iot;
   1574 	ioh = sc->sc_ioh;
   1575 	bus_space_write_2(iot, ioh, ESA_HOST_INT_CTRL,
   1576 	    ESA_ASSP_INT_ENABLE | ESA_HV_INT_ENABLE);
   1577 	data = bus_space_read_1(iot, ioh, ESA_ASSP_CONTROL_C);
   1578 	bus_space_write_1(iot, ioh, ESA_ASSP_CONTROL_C,
   1579 	    data | ESA_ASSP_HOST_INT_ENABLE);
   1580 }
   1581 
   1582 /*
   1583  * List management
   1584  */
   1585 static int
   1586 esa_add_list(struct esa_voice *vc, struct esa_list *el,
   1587 	     uint16_t val, int index)
   1588 {
   1589 	struct esa_softc *sc;
   1590 
   1591 	sc = (struct esa_softc *)vc->parent;
   1592 	el->indexmap[index] = el->currlen;
   1593 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
   1594 		       el->mem_addr + el->currlen,
   1595 		       val);
   1596 
   1597 	return el->currlen++;
   1598 }
   1599 
   1600 static void
   1601 esa_remove_list(struct esa_voice *vc, struct esa_list *el, int index)
   1602 {
   1603 	struct esa_softc *sc;
   1604 	uint16_t val;
   1605 	int lastindex;
   1606 	int vindex;
   1607 	int i;
   1608 
   1609 	sc = (struct esa_softc *)vc->parent;
   1610 	lastindex = el->currlen - 1;
   1611 	vindex = el->indexmap[index];
   1612 
   1613 	/* reset our virtual index */
   1614 	el->indexmap[index] = -1;
   1615 
   1616 	if (vindex != lastindex) {
   1617 		val = esa_read_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
   1618 				    el->mem_addr + lastindex);
   1619 		esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
   1620 			       el->mem_addr + vindex,
   1621 			       val);
   1622 		for (i = 0; i < ESA_NUM_VOICES * 2; i++)
   1623 			if (el->indexmap[i] == lastindex)
   1624 				break;
   1625 		if (i >= ESA_NUM_VOICES * 2)
   1626 			printf("%s: esa_remove_list: invalid task index\n",
   1627 			       sc->sc_dev.dv_xname);
   1628 		else
   1629 			el->indexmap[i] = vindex;
   1630 	}
   1631 
   1632 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
   1633 		       el->mem_addr + lastindex, 0);
   1634 	el->currlen--;
   1635 
   1636 	return;
   1637 }
   1638 
   1639 static void
   1640 esa_powerhook(int why, void *hdl)
   1641 {
   1642 	struct esa_softc *sc;
   1643 
   1644 	sc = (struct esa_softc *)hdl;
   1645 	switch (why) {
   1646 	case PWR_SUSPEND:
   1647 	case PWR_STANDBY:
   1648 		esa_suspend(sc);
   1649 		break;
   1650 	case PWR_RESUME:
   1651 		esa_resume(sc);
   1652 		sc->codec_if->vtbl->restore_ports(sc->codec_if);
   1653 		break;
   1654 	}
   1655 }
   1656 
   1657 static int
   1658 esa_suspend(struct esa_softc *sc)
   1659 {
   1660 	bus_space_tag_t iot;
   1661 	bus_space_handle_t ioh;
   1662 	int i, index;
   1663 	int error;
   1664 
   1665 	iot = sc->sc_iot;
   1666 	ioh = sc->sc_ioh;
   1667 	index = 0;
   1668 
   1669 	bus_space_write_2(iot, ioh, ESA_HOST_INT_CTRL, 0);
   1670 	bus_space_write_1(iot, ioh, ESA_ASSP_CONTROL_C, 0);
   1671 
   1672 	esa_assp_halt(sc);
   1673 
   1674 	/* Save ASSP state */
   1675 	for (i = ESA_REV_B_CODE_MEMORY_BEGIN; i <= ESA_REV_B_CODE_MEMORY_END;
   1676 	    i++)
   1677 		sc->savemem[index++] = esa_read_assp(sc,
   1678 		    ESA_MEMTYPE_INTERNAL_CODE, i);
   1679 	for (i = ESA_REV_B_DATA_MEMORY_BEGIN; i <= ESA_REV_B_DATA_MEMORY_END;
   1680 	    i++)
   1681 		sc->savemem[index++] = esa_read_assp(sc,
   1682 		    ESA_MEMTYPE_INTERNAL_DATA, i);
   1683 
   1684 	if ((error = pci_set_powerstate(sc->sc_pct, sc->sc_tag,
   1685 	    PCI_PMCSR_STATE_D3)))
   1686 		return error;
   1687 
   1688 	return 0;
   1689 }
   1690 
   1691 static int
   1692 esa_resume(struct esa_softc *sc)
   1693 {
   1694 	bus_space_tag_t iot;
   1695 	bus_space_handle_t ioh;
   1696 	int i, index;
   1697 	uint8_t reset_state;
   1698 	int error;
   1699 
   1700 	iot = sc->sc_iot;
   1701 	ioh = sc->sc_ioh;
   1702 	index = 0;
   1703 
   1704 	if ((error = pci_set_powerstate(sc->sc_pct, sc->sc_tag,
   1705 	    PCI_PMCSR_STATE_D0)))
   1706 		return error;
   1707 	delay(10000);
   1708 
   1709 	esa_config(sc);
   1710 
   1711 	reset_state = esa_assp_halt(sc);
   1712 
   1713 	esa_codec_reset(sc);
   1714 
   1715 	/* restore ASSP */
   1716 	for (i = ESA_REV_B_CODE_MEMORY_BEGIN; i <= ESA_REV_B_CODE_MEMORY_END;
   1717 	    i++)
   1718 		esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_CODE, i,
   1719 		    sc->savemem[index++]);
   1720 	for (i = ESA_REV_B_DATA_MEMORY_BEGIN; i <= ESA_REV_B_DATA_MEMORY_END;
   1721 	    i++)
   1722 		esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, i,
   1723 		    sc->savemem[index++]);
   1724 
   1725 	esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, ESA_KDATA_DMA_ACTIVE, 0);
   1726 	bus_space_write_1(iot, ioh, ESA_DSP_PORT_CONTROL_REG_B,
   1727 	    reset_state | ESA_REGB_ENABLE_RESET);
   1728 
   1729 	esa_enable_interrupts(sc);
   1730 	esa_amp_enable(sc);
   1731 
   1732 	return 0;
   1733 }
   1734 
   1735 static uint32_t
   1736 esa_get_pointer(struct esa_softc *sc, struct esa_channel *ch)
   1737 {
   1738 	uint16_t hi, lo;
   1739 	uint32_t addr;
   1740 	int data_offset;
   1741 
   1742 	data_offset = ch->data_offset;
   1743 	hi = esa_read_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, data_offset +
   1744 	    ESA_CDATA_HOST_SRC_CURRENTH);
   1745 	lo = esa_read_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, data_offset +
   1746 	    ESA_CDATA_HOST_SRC_CURRENTL);
   1747 
   1748 	addr = lo | ((uint32_t)hi << 16);
   1749 	return (addr - ch->start);
   1750 }
   1751 
   1752 static paddr_t
   1753 esa_mappage(void *addr, void *mem, off_t off, int prot)
   1754 {
   1755 	struct esa_voice *vc;
   1756 	struct esa_softc *sc;
   1757 	struct esa_dma *p;
   1758 
   1759 	vc = addr;
   1760 	sc = (struct esa_softc *)vc->parent;
   1761 	if (off < 0)
   1762 		return -1;
   1763 	for (p = vc->dma; p && KERNADDR(p) != mem; p = p->next)
   1764 		continue;
   1765 	if (p == NULL)
   1766 		return -1;
   1767 	return bus_dmamem_mmap(sc->sc_dmat, p->segs, p->nsegs,
   1768 			       off, prot, BUS_DMA_WAITOK);
   1769 }
   1770