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