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