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