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