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