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