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