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