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