esa.c revision 1.59 1 /* $NetBSD: esa.c,v 1.59 2013/10/16 17:39:09 christos Exp $ */
2
3 /*
4 * Copyright (c) 2001-2008 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.59 2013/10/16 17:39:09 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/kmem.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 #include <sys/bus.h>
56 #include <sys/intr.h>
57
58 #include <dev/audio_if.h>
59 #include <dev/mulaw.h>
60 #include <dev/auconv.h>
61
62 #include <dev/ic/ac97var.h>
63 #include <dev/ic/ac97reg.h>
64
65 #include <dev/pci/pcidevs.h>
66 #include <dev/pci/pcivar.h>
67 #include <dev/pci/esareg.h>
68 #include <dev/pci/esadsp.h>
69 #include <dev/pci/esavar.h>
70
71 #define PCI_CBIO 0x10
72
73 #define ESA_DAC_DATA 0x1100
74
75 enum {
76 ESS_ALLEGRO1,
77 ESS_MAESTRO3
78 };
79
80 static const struct esa_card_type {
81 uint16_t pci_vendor_id;
82 uint16_t pci_product_id;
83 int type;
84 int delay1, delay2;
85 } esa_card_types[] = {
86 { PCI_VENDOR_ESSTECH, PCI_PRODUCT_ESSTECH_ALLEGRO1,
87 ESS_ALLEGRO1, 50, 800 },
88 { PCI_VENDOR_ESSTECH, PCI_PRODUCT_ESSTECH_MAESTRO3,
89 ESS_MAESTRO3, 20, 500 },
90 { PCI_VENDOR_ESSTECH, PCI_PRODUCT_ESSTECH_MAESTRO3_2,
91 ESS_MAESTRO3, 20, 500 },
92 { 0, 0, 0, 0, 0 }
93 };
94
95 static struct audio_device esa_device = {
96 "ESS Allegro",
97 "",
98 "esa"
99 };
100
101 static int esa_match(device_t, cfdata_t, void *);
102 static void esa_attach(device_t, device_t, void *);
103 static int esa_detach(device_t, int);
104 static void esa_childdet(device_t, device_t);
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);
120 static void esa_free(void *, void *, size_t);
121 static int esa_getdev(void *, struct audio_device *);
122 static size_t esa_round_buffersize(void *, int, size_t);
123 static int esa_get_props(void *);
124 static int esa_trigger_output(void *, void *, void *, int,
125 void (*)(void *), void *,
126 const audio_params_t *);
127 static int esa_trigger_input(void *, void *, void *, int,
128 void (*)(void *), void *,
129 const audio_params_t *);
130 static void esa_get_locks(void *, kmutex_t **, kmutex_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, const pmf_qual_t *);
166 static bool esa_resume(device_t, const pmf_qual_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 esa_get_locks,
227 };
228
229 CFATTACH_DECL2_NEW(esa, sizeof(struct esa_softc), esa_match, esa_attach,
230 esa_detach, NULL, NULL, esa_childdet);
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 = device_private(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 = device_private(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 = device_private(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 {
460 struct esa_voice *vc;
461 struct esa_softc *sc;
462 struct esa_dma *p;
463 int error;
464
465 p = kmem_alloc(sizeof(*p), KM_SLEEP);
466 if (p == NULL)
467 return NULL;
468 vc = hdl;
469 sc = device_private(vc->parent);
470 error = esa_allocmem(sc, size, 16, p);
471 if (error) {
472 kmem_free(p, sizeof(*p));
473 aprint_error_dev(sc->sc_dev,
474 "%s: not enough memory\n", __func__);
475 return 0;
476 }
477 p->next = vc->dma;
478 vc->dma = p;
479
480 return KERNADDR(p);
481 }
482
483 static void
484 esa_free(void *hdl, void *addr, size_t size)
485 {
486 struct esa_voice *vc;
487 struct esa_softc *sc;
488 struct esa_dma *p;
489 struct esa_dma **pp;
490
491 vc = hdl;
492 sc = device_private(vc->parent);
493 for (pp = &vc->dma; (p = *pp) != NULL; pp = &p->next)
494 if (KERNADDR(p) == addr) {
495 esa_freemem(sc, p);
496 *pp = p->next;
497 kmem_free(p, sizeof(*p));
498 return;
499 }
500 }
501
502 static int
503 esa_getdev(void *hdl, struct audio_device *ret)
504 {
505
506 *ret = esa_device;
507 return 0;
508 }
509
510 static int
511 esa_set_port(void *hdl, mixer_ctrl_t *mc)
512 {
513 struct esa_voice *vc;
514 struct esa_softc *sc;
515
516 vc = hdl;
517 sc = device_private(vc->parent);
518 return sc->codec_if->vtbl->mixer_set_port(sc->codec_if, mc);
519 }
520
521 static int
522 esa_get_port(void *hdl, mixer_ctrl_t *mc)
523 {
524 struct esa_voice *vc;
525 struct esa_softc *sc;
526
527 vc = hdl;
528 sc = device_private(vc->parent);
529 return sc->codec_if->vtbl->mixer_get_port(sc->codec_if, mc);
530 }
531
532 static int
533 esa_query_devinfo(void *hdl, mixer_devinfo_t *di)
534 {
535 struct esa_voice *vc;
536 struct esa_softc *sc;
537
538 vc = hdl;
539 sc = device_private(vc->parent);
540 return sc->codec_if->vtbl->query_devinfo(sc->codec_if, di);
541 }
542
543 static size_t
544 esa_round_buffersize(void *hdl, int direction, size_t bufsize)
545 {
546
547 return bufsize;
548 }
549
550 static int
551 esa_get_props(void *hdl)
552 {
553
554 return AUDIO_PROP_MMAP | AUDIO_PROP_INDEPENDENT | AUDIO_PROP_FULLDUPLEX;
555 }
556
557 static int
558 esa_trigger_output(void *hdl, void *start, void *end, int blksize,
559 void (*intr)(void *), void *intrarg, 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 = device_private(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 aprint_error_dev(sc->sc_dev, "%s: bad addr %p\n", __func__,
591 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)(((char *)end - (char *)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 < __arraycount(esa_playvals); 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 sc->sc_ntimers++;
671
672 if (sc->sc_ntimers == 1) {
673 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
674 ESA_KDATA_TIMER_COUNT_RELOAD, 240);
675 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
676 ESA_KDATA_TIMER_COUNT_CURRENT, 240);
677 data = bus_space_read_2(iot, ioh, ESA_HOST_INT_CTRL);
678 bus_space_write_2(iot, ioh, ESA_HOST_INT_CTRL,
679 data | ESA_CLKRUN_GEN_ENABLE);
680 }
681
682 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data +
683 ESA_CDATA_INSTANCE_READY, 1);
684 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
685 ESA_KDATA_MIXER_TASK_NUMBER,
686 sc->mixer_list.indexmap[vc->index]);
687
688 return 0;
689 }
690
691 static int
692 esa_trigger_input(void *hdl, void *start, void *end, int blksize,
693 void (*intr)(void *), void *intrarg, const audio_params_t *param)
694 {
695 struct esa_voice *vc;
696 struct esa_softc *sc;
697 struct esa_dma *p;
698 bus_space_tag_t iot;
699 bus_space_handle_t ioh;
700 uint32_t data, bufaddr, i;
701 size_t size;
702 int data_bytes, adc_data, dsp_in_size;
703 int dsp_out_size, dsp_in_buf, dsp_out_buf;
704
705 vc = hdl;
706 sc = device_private(vc->parent);
707 iot = sc->sc_iot;
708 ioh = sc->sc_ioh;
709 data_bytes = (((ESA_MINISRC_TMP_BUFFER_SIZE & ~1) +
710 (ESA_MINISRC_IN_BUFFER_SIZE & ~1) +
711 (ESA_MINISRC_OUT_BUFFER_SIZE & ~1) + 4) + 255) & ~255;
712 adc_data = ESA_DAC_DATA + (data_bytes * vc->index) + (data_bytes / 2);
713 dsp_in_size = ESA_MINISRC_IN_BUFFER_SIZE - (0x10 * 2);
714 dsp_out_size = ESA_MINISRC_OUT_BUFFER_SIZE - (0x10 * 2);
715 dsp_in_buf = adc_data + (ESA_MINISRC_TMP_BUFFER_SIZE / 2);
716 dsp_out_buf = dsp_in_buf + (dsp_in_size / 2) + 1;
717
718 vc->rec.data_offset = adc_data;
719
720 /* We only support 1 recording channel */
721 if (vc->index > 0)
722 return ENODEV;
723
724 if (vc->rec.active)
725 return EINVAL;
726
727 for (p = vc->dma; p && KERNADDR(p) != start; p = p->next)
728 continue;
729 if (p == NULL) {
730 aprint_error_dev(sc->sc_dev, "%s: bad addr %p\n",
731 __func__, start);
732 return EINVAL;
733 }
734
735 vc->rec.active = 1;
736 vc->rec.intr = intr;
737 vc->rec.arg = intrarg;
738 vc->rec.pos = 0;
739 vc->rec.count = 0;
740 vc->rec.buf = start;
741 vc->rec.bufsize = size = (size_t)(((char *)end - (char *)start));
742 vc->rec.blksize = blksize;
743 bufaddr = DMAADDR(p);
744 vc->rec.start = bufaddr;
745
746 #define LO(x) ((x) & 0x0000ffff)
747 #define HI(x) ((x) >> 16)
748
749 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
750 ESA_CDATA_HOST_SRC_ADDRL, LO(bufaddr));
751 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
752 ESA_CDATA_HOST_SRC_ADDRH, HI(bufaddr));
753 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
754 ESA_CDATA_HOST_SRC_END_PLUS_1L, LO(bufaddr + size));
755 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
756 ESA_CDATA_HOST_SRC_END_PLUS_1H, HI(bufaddr + size));
757 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
758 ESA_CDATA_HOST_SRC_CURRENTL, LO(bufaddr));
759 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
760 ESA_CDATA_HOST_SRC_CURRENTH, HI(bufaddr));
761
762 /* DSP buffers */
763 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
764 ESA_CDATA_IN_BUF_BEGIN, dsp_in_buf);
765 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
766 ESA_CDATA_IN_BUF_END_PLUS_1, dsp_in_buf + (dsp_in_size / 2));
767 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
768 ESA_CDATA_IN_BUF_HEAD, dsp_in_buf);
769 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
770 ESA_CDATA_IN_BUF_TAIL, dsp_in_buf);
771 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
772 ESA_CDATA_OUT_BUF_BEGIN, dsp_out_buf);
773 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
774 ESA_CDATA_OUT_BUF_END_PLUS_1, dsp_out_buf + (dsp_out_size / 2));
775 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
776 ESA_CDATA_OUT_BUF_HEAD, dsp_out_buf);
777 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
778 ESA_CDATA_OUT_BUF_TAIL, dsp_out_buf);
779
780 /* Some per-client initializers */
781 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
782 ESA_SRC3_DIRECTION_OFFSET + 12, adc_data + 40 + 8);
783 /* Tell it which way DMA is going */
784 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
785 ESA_CDATA_DMA_CONTROL,
786 ESA_DMACONTROL_DIRECTION + ESA_DMACONTROL_AUTOREPEAT +
787 ESA_DMAC_PAGE3_SELECTOR + ESA_DMAC_BLOCKF_SELECTOR);
788
789 /* Set an armload of static initializers */
790 for (i = 0; i < __arraycount(esa_recvals); i++)
791 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
792 esa_recvals[i].addr, esa_recvals[i].val);
793
794 /* Put us in the packed task lists */
795 esa_add_list(vc, &sc->adc1_list, adc_data >> ESA_DP_SHIFT_COUNT,
796 vc->index + ESA_NUM_VOICES);
797 esa_add_list(vc, &sc->msrc_list, adc_data >> ESA_DP_SHIFT_COUNT,
798 vc->index + ESA_NUM_VOICES);
799 esa_add_list(vc, &sc->dma_list, adc_data >> ESA_DP_SHIFT_COUNT,
800 vc->index + ESA_NUM_VOICES);
801 #undef LO
802 #undef HI
803
804 sc->sc_ntimers++;
805 if (sc->sc_ntimers == 1) {
806 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
807 ESA_KDATA_TIMER_COUNT_RELOAD, 240);
808 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
809 ESA_KDATA_TIMER_COUNT_CURRENT, 240);
810 data = bus_space_read_2(iot, ioh, ESA_HOST_INT_CTRL);
811 bus_space_write_2(iot, ioh, ESA_HOST_INT_CTRL,
812 data | ESA_CLKRUN_GEN_ENABLE);
813 }
814
815 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data +
816 ESA_CDATA_INSTANCE_READY, 1);
817 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, ESA_KDATA_ADC1_REQUEST,
818 1);
819
820 return 0;
821 }
822
823 /* Interrupt handler */
824 static int
825 esa_intr(void *hdl)
826 {
827 struct esa_softc *sc;
828 struct esa_voice *vc;
829 bus_space_tag_t iot;
830 bus_space_handle_t ioh;
831 uint8_t status;
832 uint32_t pos;
833 uint32_t diff;
834 uint32_t blksize;
835 int i;
836
837 sc = hdl;
838 mutex_spin_enter(&sc->sc_intr_lock);
839
840 iot = sc->sc_iot;
841 ioh = sc->sc_ioh;
842
843 status = bus_space_read_1(iot, ioh, ESA_HOST_INT_STATUS);
844 if (status == 0xff) {
845 mutex_spin_exit(&sc->sc_intr_lock);
846 return 0;
847 }
848
849 /* ack the interrupt */
850 bus_space_write_1(iot, ioh, ESA_HOST_INT_STATUS, status);
851
852 if (status & ESA_HV_INT_PENDING) {
853 uint8_t event;
854
855 aprint_normal_dev(sc->sc_dev, "hardware volume interrupt\n");
856 event = bus_space_read_1(iot, ioh, ESA_HW_VOL_COUNTER_MASTER);
857 switch(event) {
858 case 0xaa: /* volume up */
859 pmf_event_inject(NULL, PMFE_AUDIO_VOLUME_UP);
860 break;
861 case 0x66: /* volume down */
862 pmf_event_inject(NULL, PMFE_AUDIO_VOLUME_DOWN);
863 break;
864 case 0x88: /* mute */
865 pmf_event_inject(NULL, PMFE_AUDIO_VOLUME_TOGGLE);
866 break;
867 default:
868 aprint_normal_dev(sc->sc_dev,
869 "unknown hwvol event 0x%02x\n", 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 mutex_spin_exit(&sc->sc_intr_lock);
881 return 1;
882 }
883
884 bus_space_write_1(iot, ioh, ESA_ASSP_HOST_INT_STATUS,
885 ESA_DSP2HOST_REQ_TIMER);
886
887 for (i = 0; i < ESA_NUM_VOICES; i++) {
888 vc = &sc->voice[i];
889
890 if (vc->play.active) {
891 pos = esa_get_pointer(sc, &vc->play) % vc->play.bufsize;
892 diff = (vc->play.bufsize + pos - vc->play.pos) %
893 vc->play.bufsize;
894
895 vc->play.pos = pos;
896 vc->play.count += diff;
897 blksize = vc->play.blksize;
898
899 while (vc->play.count >= blksize) {
900 vc->play.count -= blksize;
901 (*vc->play.intr)(vc->play.arg);
902 }
903 }
904
905 if (vc->rec.active) {
906 pos = esa_get_pointer(sc, &vc->rec) % vc->rec.bufsize;
907 diff = (vc->rec.bufsize + pos - vc->rec.pos) %
908 vc->rec.bufsize;
909
910 vc->rec.pos = pos;
911 vc->rec.count += diff;
912 blksize = vc->rec.blksize;
913
914 while (vc->rec.count >= blksize) {
915 vc->rec.count -= blksize;
916 (*vc->rec.intr)(vc->rec.arg);
917 }
918 }
919 }
920
921 mutex_spin_exit(&sc->sc_intr_lock);
922 return 1;
923 }
924
925 static int
926 esa_allocmem(struct esa_softc *sc, size_t size, size_t align,
927 struct esa_dma *p)
928 {
929 int error;
930
931 p->size = size;
932 error = bus_dmamem_alloc(sc->sc_dmat, p->size, align, 0,
933 p->segs, __arraycount(p->segs),
934 &p->nsegs, BUS_DMA_WAITOK);
935 if (error)
936 return error;
937
938 error = bus_dmamem_map(sc->sc_dmat, p->segs, p->nsegs, p->size,
939 &p->addr, BUS_DMA_WAITOK | BUS_DMA_COHERENT);
940 if (error)
941 goto free;
942
943 error = bus_dmamap_create(sc->sc_dmat, p->size, 1, p->size, 0,
944 BUS_DMA_WAITOK, &p->map);
945 if (error)
946 goto unmap;
947
948 error = bus_dmamap_load(sc->sc_dmat, p->map, p->addr, p->size, NULL,
949 BUS_DMA_WAITOK);
950 if (error)
951 goto destroy;
952
953 return 0;
954
955 destroy:
956 bus_dmamap_destroy(sc->sc_dmat, p->map);
957 unmap:
958 bus_dmamem_unmap(sc->sc_dmat, p->addr, p->size);
959 free:
960 bus_dmamem_free(sc->sc_dmat, p->segs, p->nsegs);
961
962 return error;
963 }
964
965 static int
966 esa_freemem(struct esa_softc *sc, struct esa_dma *p)
967 {
968
969 bus_dmamap_unload(sc->sc_dmat, p->map);
970 bus_dmamap_destroy(sc->sc_dmat, p->map);
971 bus_dmamem_unmap(sc->sc_dmat, p->addr, p->size);
972 bus_dmamem_free(sc->sc_dmat, p->segs, p->nsegs);
973
974 return 0;
975 }
976
977 /*
978 * Supporting Subroutines
979 */
980
981 static int
982 esa_match(device_t dev, cfdata_t match, void *aux)
983 {
984 struct pci_attach_args *pa;
985
986 pa = (struct pci_attach_args *)aux;
987 switch (PCI_VENDOR(pa->pa_id)) {
988 case PCI_VENDOR_ESSTECH:
989 switch(PCI_PRODUCT(pa->pa_id)) {
990 case PCI_PRODUCT_ESSTECH_ALLEGRO1:
991 case PCI_PRODUCT_ESSTECH_MAESTRO3:
992 case PCI_PRODUCT_ESSTECH_MAESTRO3_2:
993 return 1;
994 }
995 }
996
997 return 0;
998 }
999
1000 static void
1001 esa_attach(device_t parent, device_t self, void *aux)
1002 {
1003 struct esa_softc *sc;
1004 struct pci_attach_args *pa;
1005 pcitag_t tag;
1006 pci_chipset_tag_t pc;
1007 pci_intr_handle_t ih;
1008 const struct esa_card_type *card;
1009 const char *intrstr;
1010 uint32_t data;
1011 int revision, i, error;
1012
1013 sc = device_private(self);
1014 pa = (struct pci_attach_args *)aux;
1015 tag = pa->pa_tag;
1016 pc = pa->pa_pc;
1017
1018 pci_aprint_devinfo(pa, "Audio controller");
1019
1020 revision = PCI_REVISION(pa->pa_class);
1021
1022 for (card = esa_card_types; card->pci_vendor_id; card++)
1023 if (PCI_VENDOR(pa->pa_id) == card->pci_vendor_id &&
1024 PCI_PRODUCT(pa->pa_id) == card->pci_product_id) {
1025 sc->type = card->type;
1026 sc->delay1 = card->delay1;
1027 sc->delay2 = card->delay2;
1028 break;
1029 }
1030
1031 data = pci_conf_read(pc, tag, PCI_COMMAND_STATUS_REG);
1032 data |= (PCI_COMMAND_IO_ENABLE | PCI_COMMAND_MEM_ENABLE
1033 | PCI_COMMAND_MASTER_ENABLE);
1034 pci_conf_write(pc, tag, PCI_COMMAND_STATUS_REG, data);
1035
1036 /* Map I/O register */
1037 if (pci_mapreg_map(pa, PCI_CBIO, PCI_MAPREG_TYPE_IO, 0,
1038 &sc->sc_iot, &sc->sc_ioh, &sc->sc_iob, &sc->sc_ios)) {
1039 aprint_error_dev(sc->sc_dev, "can't map i/o space\n");
1040 return;
1041 }
1042
1043 /* Initialize softc */
1044 sc->sc_dev = self;
1045 sc->sc_tag = tag;
1046 sc->sc_pct = pc;
1047 sc->sc_dmat = pa->pa_dmat;
1048
1049 mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_NONE);
1050 mutex_init(&sc->sc_intr_lock, MUTEX_DEFAULT, IPL_AUDIO);
1051
1052 /* Map and establish an interrupt */
1053 if (pci_intr_map(pa, &ih)) {
1054 aprint_error_dev(sc->sc_dev, "can't map interrupt\n");
1055 mutex_destroy(&sc->sc_lock);
1056 mutex_destroy(&sc->sc_intr_lock);
1057 return;
1058 }
1059 intrstr = pci_intr_string(pc, ih);
1060 sc->sc_ih = pci_intr_establish(pc, ih, IPL_AUDIO, esa_intr, sc);
1061 if (sc->sc_ih == NULL) {
1062 aprint_error_dev(sc->sc_dev, "can't establish interrupt");
1063 if (intrstr != NULL)
1064 aprint_error(" at %s", intrstr);
1065 aprint_error("\n");
1066 mutex_destroy(&sc->sc_lock);
1067 mutex_destroy(&sc->sc_intr_lock);
1068 return;
1069 }
1070 aprint_normal_dev(sc->sc_dev, "interrupting at %s\n", intrstr);
1071
1072 /* power up chip */
1073 if ((error = pci_activate(pa->pa_pc, pa->pa_tag, self,
1074 pci_activate_null)) && error != EOPNOTSUPP) {
1075 aprint_error_dev(sc->sc_dev, "cannot activate %d\n", error);
1076 mutex_destroy(&sc->sc_lock);
1077 mutex_destroy(&sc->sc_intr_lock);
1078 return;
1079 }
1080
1081 /* Init chip */
1082 if (esa_init(sc) == -1) {
1083 aprint_error_dev(sc->sc_dev,
1084 "esa_attach: unable to initialize the card\n");
1085 mutex_destroy(&sc->sc_lock);
1086 mutex_destroy(&sc->sc_intr_lock);
1087 return;
1088 }
1089
1090 /* create suspend save area */
1091 sc->savememsz = sizeof(uint16_t) * (ESA_REV_B_CODE_MEMORY_LENGTH
1092 + ESA_REV_B_DATA_MEMORY_LENGTH + 1);
1093 sc->savemem = kmem_zalloc(sc->savememsz, KM_SLEEP);
1094 if (sc->savemem == NULL) {
1095 aprint_error_dev(sc->sc_dev,
1096 "unable to allocate suspend buffer\n");
1097 mutex_destroy(&sc->sc_lock);
1098 mutex_destroy(&sc->sc_intr_lock);
1099 return;
1100 }
1101
1102 /*
1103 * Every card I've seen has had their channels swapped with respect
1104 * to the mixer. Ie:
1105 * $ mixerctl -w outputs.master=0,191
1106 * Would result in the _right_ speaker being turned off.
1107 *
1108 * So, we will swap the left and right mixer channels to compensate
1109 * for this.
1110 *
1111 * XXX PR# 23620: The Dell C810 channels are not swapped. Match
1112 * on revision ID for now; this is probably wrong.
1113 */
1114 if (revision == 0x10 && sc->type == ESS_MAESTRO3)
1115 sc->codec_flags = 0;
1116 else
1117 sc->codec_flags = AC97_HOST_SWAPPED_CHANNELS;
1118
1119 /* initialize list management structures */
1120 sc->mixer_list.mem_addr = ESA_KDATA_MIXER_XFER0;
1121 sc->mixer_list.max = ESA_MAX_VIRTUAL_MIXER_CHANNELS;
1122 sc->adc1_list.mem_addr = ESA_KDATA_ADC1_XFER0;
1123 sc->adc1_list.max = ESA_MAX_VIRTUAL_ADC1_CHANNELS;
1124 sc->dma_list.mem_addr = ESA_KDATA_DMA_XFER0;
1125 sc->dma_list.max = ESA_MAX_VIRTUAL_DMA_CHANNELS;
1126 sc->msrc_list.mem_addr = ESA_KDATA_INSTANCE0_MINISRC;
1127 sc->msrc_list.max = ESA_MAX_INSTANCE_MINISRC;
1128
1129 /* initialize index maps */
1130 for (i = 0; i < ESA_NUM_VOICES * 2; i++) {
1131 sc->mixer_list.indexmap[i] = -1;
1132 sc->msrc_list.indexmap[i] = -1;
1133 sc->dma_list.indexmap[i] = -1;
1134 sc->adc1_list.indexmap[i] = -1;
1135 }
1136
1137 /* Attach AC97 host interface */
1138 sc->host_if.arg = sc;
1139 sc->host_if.attach = esa_attach_codec;
1140 sc->host_if.read = esa_read_codec;
1141 sc->host_if.write = esa_write_codec;
1142 sc->host_if.reset = esa_reset_codec;
1143 sc->host_if.flags = esa_flags_codec;
1144
1145 if (ac97_attach(&sc->host_if, self, &sc->sc_lock) != 0) {
1146 mutex_destroy(&sc->sc_lock);
1147 mutex_destroy(&sc->sc_intr_lock);
1148 return;
1149 }
1150
1151 /* Attach audio interface. */
1152 for (i = 0; i < ESA_NUM_VOICES; i++) {
1153 sc->voice[i].parent = sc->sc_dev;
1154 sc->voice[i].index = i;
1155 sc->sc_audiodev[i] =
1156 audio_attach_mi(&esa_hw_if, &sc->voice[i], sc->sc_dev);
1157 }
1158
1159 if (!pmf_device_register(self, esa_suspend, esa_resume))
1160 aprint_error_dev(self, "couldn't establish power handler\n");
1161
1162 return;
1163 }
1164
1165 void
1166 esa_childdet(device_t self, device_t child)
1167 {
1168 struct esa_softc *sc = device_private(self);
1169 int i;
1170
1171 for (i = 0; i < ESA_NUM_VOICES; i++) {
1172 if (sc->sc_audiodev[i] == child) {
1173 sc->sc_audiodev[i] = NULL;
1174 break;
1175 }
1176 }
1177 KASSERT(i < ESA_NUM_VOICES);
1178 }
1179
1180 static int
1181 esa_detach(device_t self, int flags)
1182 {
1183 struct esa_softc *sc;
1184 int i;
1185
1186 sc = device_private(self);
1187 for (i = 0; i < ESA_NUM_VOICES; i++) {
1188 if (sc->sc_audiodev[i] != NULL)
1189 config_detach(sc->sc_audiodev[i], flags);
1190 }
1191
1192 if (sc->sc_ih != NULL)
1193 pci_intr_disestablish(sc->sc_pct, sc->sc_ih);
1194 if (sc->sc_ios)
1195 bus_space_unmap(sc->sc_iot, sc->sc_ioh, sc->sc_ios);
1196
1197 kmem_free(sc->savemem, sc->savememsz);
1198 mutex_destroy(&sc->sc_lock);
1199 mutex_destroy(&sc->sc_intr_lock);
1200
1201 return 0;
1202 }
1203
1204 static uint16_t
1205 esa_read_assp(struct esa_softc *sc, uint16_t region, uint16_t index)
1206 {
1207 uint16_t data;
1208 bus_space_tag_t iot;
1209 bus_space_handle_t ioh;
1210
1211 iot = sc->sc_iot;
1212 ioh = sc->sc_ioh;
1213 bus_space_write_2(iot, ioh, ESA_DSP_PORT_MEMORY_TYPE,
1214 region & ESA_MEMTYPE_MASK);
1215 bus_space_write_2(iot, ioh, ESA_DSP_PORT_MEMORY_INDEX, index);
1216 data = bus_space_read_2(iot, ioh, ESA_DSP_PORT_MEMORY_DATA);
1217
1218 return data;
1219 }
1220
1221 static void
1222 esa_write_assp(struct esa_softc *sc, uint16_t region, uint16_t index,
1223 uint16_t data)
1224 {
1225 bus_space_tag_t iot;
1226 bus_space_handle_t ioh;
1227
1228 iot = sc->sc_iot;
1229 ioh = sc->sc_ioh;
1230 bus_space_write_2(iot, ioh, ESA_DSP_PORT_MEMORY_TYPE,
1231 region & ESA_MEMTYPE_MASK);
1232 bus_space_write_2(iot, ioh, ESA_DSP_PORT_MEMORY_INDEX, index);
1233 bus_space_write_2(iot, ioh, ESA_DSP_PORT_MEMORY_DATA, data);
1234
1235 return;
1236 }
1237
1238 static int
1239 esa_init_codec(struct esa_softc *sc)
1240 {
1241 bus_space_tag_t iot;
1242 bus_space_handle_t ioh;
1243 uint32_t data;
1244
1245 iot = sc->sc_iot;
1246 ioh = sc->sc_ioh;
1247 data = bus_space_read_1(iot, ioh, ESA_CODEC_COMMAND);
1248
1249 return (data & 0x1) ? 0 : 1;
1250 }
1251
1252 static int
1253 esa_attach_codec(void *aux, struct ac97_codec_if *codec_if)
1254 {
1255 struct esa_softc *sc;
1256
1257 sc = aux;
1258 sc->codec_if = codec_if;
1259
1260 return 0;
1261 }
1262
1263 static int
1264 esa_read_codec(void *aux, uint8_t reg, uint16_t *result)
1265 {
1266 struct esa_softc *sc;
1267 bus_space_tag_t iot;
1268 bus_space_handle_t ioh;
1269
1270 sc = aux;
1271 iot = sc->sc_iot;
1272 ioh = sc->sc_ioh;
1273 if (esa_wait(sc))
1274 aprint_error_dev(sc->sc_dev, "esa_read_codec: timed out\n");
1275 bus_space_write_1(iot, ioh, ESA_CODEC_COMMAND, (reg & 0x7f) | 0x80);
1276 delay(50);
1277 if (esa_wait(sc))
1278 aprint_error_dev(sc->sc_dev, "esa_read_codec: timed out\n");
1279 *result = bus_space_read_2(iot, ioh, ESA_CODEC_DATA);
1280
1281 return 0;
1282 }
1283
1284 static int
1285 esa_write_codec(void *aux, uint8_t reg, uint16_t data)
1286 {
1287 struct esa_softc *sc;
1288 bus_space_tag_t iot;
1289 bus_space_handle_t ioh;
1290
1291 sc = aux;
1292 iot = sc->sc_iot;
1293 ioh = sc->sc_ioh;
1294 if (esa_wait(sc)) {
1295 aprint_error_dev(sc->sc_dev, "esa_write_codec: timed out\n");
1296 return -1;
1297 }
1298 bus_space_write_2(iot, ioh, ESA_CODEC_DATA, data);
1299 bus_space_write_1(iot, ioh, ESA_CODEC_COMMAND, reg & 0x7f);
1300 delay(50);
1301
1302 return 0;
1303 }
1304
1305 static int
1306 esa_reset_codec(void *aux)
1307 {
1308
1309 return 0;
1310 }
1311
1312 static enum ac97_host_flags
1313 esa_flags_codec(void *aux)
1314 {
1315 struct esa_softc *sc;
1316
1317 sc = aux;
1318 return sc->codec_flags;
1319 }
1320
1321 static int
1322 esa_wait(struct esa_softc *sc)
1323 {
1324 int i, val;
1325 bus_space_tag_t iot;
1326 bus_space_handle_t ioh;
1327
1328 iot = sc->sc_iot;
1329 ioh = sc->sc_ioh;
1330 for (i = 0; i < 20; i++) {
1331 val = bus_space_read_1(iot, ioh, ESA_CODEC_STATUS);
1332 if ((val & 1) == 0)
1333 return 0;
1334 delay(2);
1335 }
1336
1337 return -1;
1338 }
1339
1340 static int
1341 esa_init(struct esa_softc *sc)
1342 {
1343 struct esa_voice *vc;
1344 bus_space_tag_t iot;
1345 bus_space_handle_t ioh;
1346 pcitag_t tag;
1347 pci_chipset_tag_t pc;
1348 uint32_t data, i, size;
1349 uint8_t reset_state;
1350 int data_bytes;
1351
1352 iot = sc->sc_iot;
1353 ioh = sc->sc_ioh;
1354 tag = sc->sc_tag;
1355 pc = sc->sc_pct;
1356 data_bytes = (((ESA_MINISRC_TMP_BUFFER_SIZE & ~1) +
1357 (ESA_MINISRC_IN_BUFFER_SIZE & ~1) +
1358 (ESA_MINISRC_OUT_BUFFER_SIZE & ~1) + 4) + 255) & ~255;
1359
1360 mutex_spin_enter(&sc->sc_intr_lock);
1361
1362 /* Disable legacy emulation */
1363 data = pci_conf_read(pc, tag, PCI_LEGACY_AUDIO_CTRL);
1364 data |= DISABLE_LEGACY;
1365 pci_conf_write(pc, tag, PCI_LEGACY_AUDIO_CTRL, data);
1366
1367 esa_config(sc);
1368
1369 reset_state = esa_assp_halt(sc);
1370
1371 esa_init_codec(sc);
1372 esa_codec_reset(sc);
1373
1374 /* Zero kernel and mixer data */
1375 size = ESA_REV_B_DATA_MEMORY_UNIT_LENGTH * ESA_NUM_UNITS_KERNEL_DATA;
1376 for (i = 0; i < size / 2; i++) {
1377 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
1378 ESA_KDATA_BASE_ADDR + i, 0);
1379 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
1380 ESA_KDATA_BASE_ADDR2 + i, 0);
1381 }
1382
1383 /* Init DMA pointer */
1384 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, ESA_KDATA_CURRENT_DMA,
1385 ESA_KDATA_DMA_XFER0);
1386
1387 /* Write kernel code into memory */
1388 for (i = 0; i < __arraycount(esa_assp_kernel_image); i++)
1389 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_CODE,
1390 ESA_REV_B_CODE_MEMORY_BEGIN + i, esa_assp_kernel_image[i]);
1391
1392 for (i = 0; i < __arraycount(esa_assp_minisrc_image); i++)
1393 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_CODE, 0x400 + i,
1394 esa_assp_minisrc_image[i]);
1395
1396 /* Write the coefficients for the low pass filter */
1397 for (i = 0; i < __arraycount(esa_minisrc_lpf_image); i++)
1398 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_CODE,
1399 0x400 + ESA_MINISRC_COEF_LOC + i,
1400 esa_minisrc_lpf_image[i]);
1401 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_CODE,
1402 0x400 + ESA_MINISRC_COEF_LOC + size, 0x8000);
1403 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, ESA_KDATA_TASK0, 0x400);
1404 /* Init the mixer number */
1405 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
1406 ESA_KDATA_MIXER_TASK_NUMBER, 0);
1407 /* Extreme kernel master volume */
1408 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
1409 ESA_KDATA_DAC_LEFT_VOLUME, ESA_ARB_VOLUME);
1410 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
1411 ESA_KDATA_DAC_RIGHT_VOLUME, ESA_ARB_VOLUME);
1412
1413 if (esa_amp_enable(sc))
1414 return -1;
1415
1416 /* Zero entire DAC/ADC area */
1417 for (i = 0x1100; i < 0x1c00; i++)
1418 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, i, 0);
1419
1420 /* set some sane defaults */
1421 for (i = 0; i < ESA_NUM_VOICES; i++) {
1422 vc = &sc->voice[i];
1423 vc->play.data_offset = ESA_DAC_DATA + (data_bytes * i);
1424 vc->rec.data_offset = ESA_DAC_DATA + (data_bytes * i * 2);
1425 }
1426
1427 esa_enable_interrupts(sc);
1428
1429 bus_space_write_1(iot, ioh, ESA_DSP_PORT_CONTROL_REG_B,
1430 reset_state | ESA_REGB_ENABLE_RESET);
1431
1432 mutex_spin_exit(&sc->sc_intr_lock);
1433
1434 return 0;
1435 }
1436
1437 static void
1438 esa_config(struct esa_softc *sc)
1439 {
1440 bus_space_tag_t iot;
1441 bus_space_handle_t ioh;
1442 pcitag_t tag;
1443 pci_chipset_tag_t pc;
1444 uint32_t data;
1445
1446 iot = sc->sc_iot;
1447 ioh = sc->sc_ioh;
1448 tag = sc->sc_tag;
1449 pc = sc->sc_pct;
1450
1451 data = pci_conf_read(pc, tag, ESA_PCI_ALLEGRO_CONFIG);
1452 data &= ESA_REDUCED_DEBOUNCE;
1453 data |= ESA_PM_CTRL_ENABLE | ESA_CLK_DIV_BY_49 | ESA_USE_PCI_TIMING;
1454 pci_conf_write(pc, tag, ESA_PCI_ALLEGRO_CONFIG, data);
1455
1456 bus_space_write_1(iot, ioh, ESA_ASSP_CONTROL_B, ESA_RESET_ASSP);
1457 data = pci_conf_read(pc, tag, ESA_PCI_ALLEGRO_CONFIG);
1458 data &= ~ESA_INT_CLK_SELECT;
1459 if (sc->type == ESS_MAESTRO3) {
1460 data &= ~ESA_INT_CLK_MULT_ENABLE;
1461 data |= ESA_INT_CLK_SRC_NOT_PCI;
1462 }
1463 data &= ~(ESA_CLK_MULT_MODE_SELECT | ESA_CLK_MULT_MODE_SELECT_2);
1464 pci_conf_write(pc, tag, ESA_PCI_ALLEGRO_CONFIG, data);
1465
1466 if (sc->type == ESS_ALLEGRO1) {
1467 data = pci_conf_read(pc, tag, ESA_PCI_USER_CONFIG);
1468 data |= ESA_IN_CLK_12MHZ_SELECT;
1469 pci_conf_write(pc, tag, ESA_PCI_USER_CONFIG, data);
1470 }
1471
1472 data = bus_space_read_1(iot, ioh, ESA_ASSP_CONTROL_A);
1473 data &= ~(ESA_DSP_CLK_36MHZ_SELECT | ESA_ASSP_CLK_49MHZ_SELECT);
1474 data |= ESA_ASSP_CLK_49MHZ_SELECT; /* XXX: Assumes 49MHz DSP */
1475 data |= ESA_ASSP_0_WS_ENABLE;
1476 bus_space_write_1(iot, ioh, ESA_ASSP_CONTROL_A, data);
1477
1478 bus_space_write_1(iot, ioh, ESA_ASSP_CONTROL_B, ESA_RUN_ASSP);
1479
1480 return;
1481 }
1482
1483 static uint8_t
1484 esa_assp_halt(struct esa_softc *sc)
1485 {
1486 bus_space_tag_t iot;
1487 bus_space_handle_t ioh;
1488 uint8_t data, reset_state;
1489
1490 iot = sc->sc_iot;
1491 ioh = sc->sc_ioh;
1492 data = bus_space_read_1(iot, ioh, ESA_DSP_PORT_CONTROL_REG_B);
1493 reset_state = data & ~ESA_REGB_STOP_CLOCK;
1494 delay(10000);
1495 bus_space_write_1(iot, ioh, ESA_DSP_PORT_CONTROL_REG_B,
1496 reset_state & ~ESA_REGB_ENABLE_RESET);
1497 delay(10000);
1498
1499 return reset_state;
1500 }
1501
1502 static void
1503 esa_codec_reset(struct esa_softc *sc)
1504 {
1505 bus_space_tag_t iot;
1506 bus_space_handle_t ioh;
1507 uint16_t data, dir;
1508 int retry;
1509
1510 iot = sc->sc_iot;
1511 ioh = sc->sc_ioh;
1512 retry = 0;
1513 do {
1514 data = bus_space_read_2(iot, ioh, ESA_GPIO_DIRECTION);
1515 dir = data | 0x10; /* assuming pci bus master? */
1516
1517 /* remote codec config */
1518 data = bus_space_read_2(iot, ioh, ESA_RING_BUS_CTRL_B);
1519 bus_space_write_2(iot, ioh, ESA_RING_BUS_CTRL_B,
1520 data & ~ESA_SECOND_CODEC_ID_MASK);
1521 data = bus_space_read_2(iot, ioh, ESA_SDO_OUT_DEST_CTRL);
1522 bus_space_write_2(iot, ioh, ESA_SDO_OUT_DEST_CTRL,
1523 data & ~ESA_COMMAND_ADDR_OUT);
1524 data = bus_space_read_2(iot, ioh, ESA_SDO_IN_DEST_CTRL);
1525 bus_space_write_2(iot, ioh, ESA_SDO_IN_DEST_CTRL,
1526 data & ~ESA_STATUS_ADDR_IN);
1527
1528 bus_space_write_2(iot, ioh, ESA_RING_BUS_CTRL_A,
1529 ESA_IO_SRAM_ENABLE);
1530 delay(20);
1531
1532 bus_space_write_2(iot, ioh, ESA_GPIO_DIRECTION,
1533 dir & ~ESA_GPO_PRIMARY_AC97);
1534 bus_space_write_2(iot, ioh, ESA_GPIO_MASK,
1535 ~ESA_GPO_PRIMARY_AC97);
1536 bus_space_write_2(iot, ioh, ESA_GPIO_DATA, 0);
1537 bus_space_write_2(iot, ioh, ESA_GPIO_DIRECTION,
1538 dir | ESA_GPO_PRIMARY_AC97);
1539 delay(sc->delay1 * 1000);
1540 bus_space_write_2(iot, ioh, ESA_GPIO_DATA,
1541 ESA_GPO_PRIMARY_AC97);
1542 delay(5);
1543 bus_space_write_2(iot, ioh, ESA_RING_BUS_CTRL_A,
1544 ESA_IO_SRAM_ENABLE | ESA_SERIAL_AC_LINK_ENABLE);
1545 bus_space_write_2(iot, ioh, ESA_GPIO_MASK, ~0);
1546 delay(sc->delay2 * 1000);
1547
1548 esa_read_codec(sc, 0x7c, &data);
1549 if ((data == 0) || (data == 0xffff)) {
1550 retry++;
1551 if (retry > 3) {
1552 aprint_error_dev(sc->sc_dev,
1553 "esa_codec_reset: failed\n");
1554 break;
1555 }
1556 aprint_normal_dev(sc->sc_dev,
1557 "esa_codec_reset: retrying\n");
1558 } else
1559 retry = 0;
1560 } while (retry);
1561
1562 return;
1563 }
1564
1565 static int
1566 esa_amp_enable(struct esa_softc *sc)
1567 {
1568 bus_space_tag_t iot;
1569 bus_space_handle_t ioh;
1570 uint32_t gpo, polarity_port, polarity;
1571 uint16_t data;
1572
1573 iot = sc->sc_iot;
1574 ioh = sc->sc_ioh;
1575 switch (sc->type) {
1576 case ESS_ALLEGRO1:
1577 polarity_port = 0x1800;
1578 break;
1579 case ESS_MAESTRO3:
1580 polarity_port = 0x1100;
1581 break;
1582 default:
1583 aprint_error_dev(sc->sc_dev,
1584 "esa_amp_enable: Unknown chip type!!!\n");
1585 return 1;
1586 }
1587
1588 gpo = (polarity_port >> 8) & 0x0f;
1589 polarity = polarity_port >> 12;
1590 polarity = !polarity; /* Enable */
1591 polarity = polarity << gpo;
1592 gpo = 1 << gpo;
1593 bus_space_write_2(iot, ioh, ESA_GPIO_MASK, ~gpo);
1594 data = bus_space_read_2(iot, ioh, ESA_GPIO_DIRECTION);
1595 bus_space_write_2(iot, ioh, ESA_GPIO_DIRECTION, data | gpo);
1596 data = ESA_GPO_SECONDARY_AC97 | ESA_GPO_PRIMARY_AC97 | polarity;
1597 bus_space_write_2(iot, ioh, ESA_GPIO_DATA, data);
1598 bus_space_write_2(iot, ioh, ESA_GPIO_MASK, ~0);
1599
1600 return 0;
1601 }
1602
1603 static void
1604 esa_enable_interrupts(struct esa_softc *sc)
1605 {
1606 bus_space_tag_t iot;
1607 bus_space_handle_t ioh;
1608 uint8_t data;
1609
1610 iot = sc->sc_iot;
1611 ioh = sc->sc_ioh;
1612 bus_space_write_2(iot, ioh, ESA_HOST_INT_CTRL,
1613 ESA_ASSP_INT_ENABLE | ESA_HV_INT_ENABLE);
1614 data = bus_space_read_1(iot, ioh, ESA_ASSP_CONTROL_C);
1615 bus_space_write_1(iot, ioh, ESA_ASSP_CONTROL_C,
1616 data | ESA_ASSP_HOST_INT_ENABLE);
1617 }
1618
1619 /*
1620 * List management
1621 */
1622 static int
1623 esa_add_list(struct esa_voice *vc, struct esa_list *el,
1624 uint16_t val, int index)
1625 {
1626 struct esa_softc *sc;
1627
1628 sc = device_private(vc->parent);
1629 el->indexmap[index] = el->currlen;
1630 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
1631 el->mem_addr + el->currlen,
1632 val);
1633
1634 return el->currlen++;
1635 }
1636
1637 static void
1638 esa_remove_list(struct esa_voice *vc, struct esa_list *el, int index)
1639 {
1640 struct esa_softc *sc;
1641 uint16_t val;
1642 int lastindex;
1643 int vindex;
1644 int i;
1645
1646 sc = device_private(vc->parent);
1647 lastindex = el->currlen - 1;
1648 vindex = el->indexmap[index];
1649
1650 /* reset our virtual index */
1651 el->indexmap[index] = -1;
1652
1653 if (vindex != lastindex) {
1654 val = esa_read_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
1655 el->mem_addr + lastindex);
1656 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
1657 el->mem_addr + vindex,
1658 val);
1659 for (i = 0; i < ESA_NUM_VOICES * 2; i++)
1660 if (el->indexmap[i] == lastindex)
1661 break;
1662 if (i >= ESA_NUM_VOICES * 2)
1663 aprint_error_dev(sc->sc_dev,
1664 "esa_remove_list: invalid task index\n");
1665 else
1666 el->indexmap[i] = vindex;
1667 }
1668
1669 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA,
1670 el->mem_addr + lastindex, 0);
1671 el->currlen--;
1672
1673 return;
1674 }
1675
1676 static bool
1677 esa_suspend(device_t dv, const pmf_qual_t *qual)
1678 {
1679 struct esa_softc *sc = device_private(dv);
1680 bus_space_tag_t iot = sc->sc_iot;
1681 bus_space_handle_t ioh = sc->sc_ioh;
1682 int i, index;
1683
1684 index = 0;
1685
1686 mutex_enter(&sc->sc_lock);
1687 mutex_spin_enter(&sc->sc_intr_lock);
1688
1689 bus_space_write_2(iot, ioh, ESA_HOST_INT_CTRL, 0);
1690 bus_space_write_1(iot, ioh, ESA_ASSP_CONTROL_C, 0);
1691
1692 esa_assp_halt(sc);
1693
1694 /* Save ASSP state */
1695 for (i = ESA_REV_B_CODE_MEMORY_BEGIN; i <= ESA_REV_B_CODE_MEMORY_END;
1696 i++)
1697 sc->savemem[index++] = esa_read_assp(sc,
1698 ESA_MEMTYPE_INTERNAL_CODE, i);
1699 for (i = ESA_REV_B_DATA_MEMORY_BEGIN; i <= ESA_REV_B_DATA_MEMORY_END;
1700 i++)
1701 sc->savemem[index++] = esa_read_assp(sc,
1702 ESA_MEMTYPE_INTERNAL_DATA, i);
1703
1704 mutex_spin_exit(&sc->sc_intr_lock);
1705 mutex_exit(&sc->sc_lock);
1706
1707 return true;
1708 }
1709
1710 static bool
1711 esa_resume(device_t dv, const pmf_qual_t *qual)
1712 {
1713 struct esa_softc *sc = device_private(dv);
1714 bus_space_tag_t iot = sc->sc_iot;
1715 bus_space_handle_t ioh = sc->sc_ioh;
1716 int i, index;
1717 uint8_t reset_state;
1718 pcireg_t data;
1719
1720 index = 0;
1721
1722 delay(10000);
1723
1724 mutex_enter(&sc->sc_lock);
1725 mutex_spin_enter(&sc->sc_intr_lock);
1726
1727 data = pci_conf_read(sc->sc_pct, sc->sc_tag, PCI_LEGACY_AUDIO_CTRL);
1728 pci_conf_write(sc->sc_pct, sc->sc_tag, PCI_LEGACY_AUDIO_CTRL,
1729 data | DISABLE_LEGACY);
1730
1731 bus_space_write_4(iot, ioh, ESA_PCI_ACPI_CONTROL, ESA_PCI_ACPI_D0);
1732
1733 esa_config(sc);
1734
1735 reset_state = esa_assp_halt(sc);
1736
1737 esa_init_codec(sc);
1738 esa_codec_reset(sc);
1739
1740 /* restore ASSP */
1741 for (i = ESA_REV_B_CODE_MEMORY_BEGIN; i <= ESA_REV_B_CODE_MEMORY_END;
1742 i++)
1743 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_CODE, i,
1744 sc->savemem[index++]);
1745 for (i = ESA_REV_B_DATA_MEMORY_BEGIN; i <= ESA_REV_B_DATA_MEMORY_END;
1746 i++)
1747 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, i,
1748 sc->savemem[index++]);
1749
1750 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, ESA_KDATA_DMA_ACTIVE, 0);
1751 bus_space_write_1(iot, ioh, ESA_DSP_PORT_CONTROL_REG_B,
1752 reset_state | ESA_REGB_ENABLE_RESET);
1753
1754 esa_enable_interrupts(sc);
1755 esa_amp_enable(sc);
1756
1757 mutex_spin_exit(&sc->sc_intr_lock);
1758
1759 /* Finally, power up AC97 codec */
1760 delay(1000);
1761
1762 sc->codec_if->vtbl->restore_ports(sc->codec_if);
1763
1764 mutex_exit(&sc->sc_lock);
1765
1766 return true;
1767 }
1768
1769 static uint32_t
1770 esa_get_pointer(struct esa_softc *sc, struct esa_channel *ch)
1771 {
1772 uint16_t hi, lo;
1773 uint32_t addr;
1774 int data_offset;
1775
1776 data_offset = ch->data_offset;
1777 hi = esa_read_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, data_offset +
1778 ESA_CDATA_HOST_SRC_CURRENTH);
1779 lo = esa_read_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, data_offset +
1780 ESA_CDATA_HOST_SRC_CURRENTL);
1781
1782 addr = lo | ((uint32_t)hi << 16);
1783 return (addr - ch->start);
1784 }
1785
1786 static paddr_t
1787 esa_mappage(void *addr, void *mem, off_t off, int prot)
1788 {
1789 struct esa_voice *vc;
1790 struct esa_softc *sc;
1791 struct esa_dma *p;
1792
1793 vc = addr;
1794 sc = device_private(vc->parent);
1795 if (off < 0)
1796 return -1;
1797 for (p = vc->dma; p && KERNADDR(p) != mem; p = p->next)
1798 continue;
1799 if (p == NULL)
1800 return -1;
1801 return bus_dmamem_mmap(sc->sc_dmat, p->segs, p->nsegs,
1802 off, prot, BUS_DMA_WAITOK);
1803 }
1804
1805 static void
1806 esa_get_locks(void *addr, kmutex_t **intr, kmutex_t **proc)
1807 {
1808 struct esa_voice *vc;
1809 struct esa_softc *sc;
1810
1811 vc = addr;
1812 sc = device_private(vc->parent);
1813
1814 *intr = &sc->sc_intr_lock;
1815 *proc = &sc->sc_lock;
1816 }
1817