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