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