esa.c revision 1.62
1 /* $NetBSD: esa.c,v 1.62 2018/12/09 11:14:02 jdolecek Exp $ */ 2 3 /* 4 * Copyright (c) 2001-2008 Jared D. McNeill <jmcneill (at) 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 (at) zabbo.net> 36 * and Andrew MacDonald <amac (at) 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.62 2018/12/09 11:14:02 jdolecek Exp $"); 43 44 #include <sys/types.h> 45 #include <sys/errno.h> 46 #include <sys/null.h> 47 #include <sys/param.h> 48 #include <sys/systm.h> 49 #include <sys/kmem.h> 50 #include <sys/device.h> 51 #include <sys/conf.h> 52 #include <sys/exec.h> 53 #include <sys/select.h> 54 #include <sys/audioio.h> 55 #include <sys/bus.h> 56 #include <sys/intr.h> 57 58 #include <dev/audio_if.h> 59 #include <dev/mulaw.h> 60 #include <dev/auconv.h> 61 62 #include <dev/ic/ac97var.h> 63 #include <dev/ic/ac97reg.h> 64 65 #include <dev/pci/pcidevs.h> 66 #include <dev/pci/pcivar.h> 67 #include <dev/pci/esareg.h> 68 #include <dev/pci/esadsp.h> 69 #include <dev/pci/esavar.h> 70 71 #define PCI_CBIO 0x10 72 73 #define ESA_DAC_DATA 0x1100 74 75 enum { 76 ESS_ALLEGRO1, 77 ESS_MAESTRO3 78 }; 79 80 static const struct esa_card_type { 81 uint16_t pci_vendor_id; 82 uint16_t pci_product_id; 83 int type; 84 int delay1, delay2; 85 } esa_card_types[] = { 86 { PCI_VENDOR_ESSTECH, PCI_PRODUCT_ESSTECH_ALLEGRO1, 87 ESS_ALLEGRO1, 50, 800 }, 88 { PCI_VENDOR_ESSTECH, PCI_PRODUCT_ESSTECH_MAESTRO3, 89 ESS_MAESTRO3, 20, 500 }, 90 { PCI_VENDOR_ESSTECH, PCI_PRODUCT_ESSTECH_MAESTRO3_2, 91 ESS_MAESTRO3, 20, 500 }, 92 { 0, 0, 0, 0, 0 } 93 }; 94 95 static struct audio_device esa_device = { 96 "ESS Allegro", 97 "", 98 "esa" 99 }; 100 101 static int esa_match(device_t, cfdata_t, void *); 102 static void esa_attach(device_t, device_t, void *); 103 static int esa_detach(device_t, int); 104 static void esa_childdet(device_t, device_t); 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); 120 static void esa_free(void *, void *, size_t); 121 static int esa_getdev(void *, struct audio_device *); 122 static size_t esa_round_buffersize(void *, int, size_t); 123 static int esa_get_props(void *); 124 static int esa_trigger_output(void *, void *, void *, int, 125 void (*)(void *), void *, 126 const audio_params_t *); 127 static int esa_trigger_input(void *, void *, void *, int, 128 void (*)(void *), void *, 129 const audio_params_t *); 130 static void esa_get_locks(void *, kmutex_t **, kmutex_t **); 131 132 static int esa_intr(void *); 133 static int esa_allocmem(struct esa_softc *, size_t, size_t, 134 struct esa_dma *); 135 static int esa_freemem(struct esa_softc *, struct esa_dma *); 136 static paddr_t esa_mappage(void *, void *, off_t, int); 137 138 /* Supporting subroutines */ 139 static uint16_t esa_read_assp(struct esa_softc *, uint16_t, uint16_t); 140 static void esa_write_assp(struct esa_softc *, uint16_t, uint16_t, 141 uint16_t); 142 static int esa_init_codec(struct esa_softc *); 143 static int esa_attach_codec(void *, struct ac97_codec_if *); 144 static int esa_read_codec(void *, uint8_t, uint16_t *); 145 static int esa_write_codec(void *, uint8_t, uint16_t); 146 static int esa_reset_codec(void *); 147 static enum ac97_host_flags esa_flags_codec(void *); 148 static int esa_wait(struct esa_softc *); 149 static int esa_init(struct esa_softc *); 150 static void esa_config(struct esa_softc *); 151 static uint8_t esa_assp_halt(struct esa_softc *); 152 static void esa_codec_reset(struct esa_softc *); 153 static int esa_amp_enable(struct esa_softc *); 154 static void esa_enable_interrupts(struct esa_softc *); 155 static uint32_t esa_get_pointer(struct esa_softc *, 156 struct esa_channel *); 157 158 /* list management */ 159 static int esa_add_list(struct esa_voice *, struct esa_list *, 160 uint16_t, int); 161 static void esa_remove_list(struct esa_voice *, struct esa_list *, 162 int); 163 164 /* power management */ 165 static bool esa_suspend(device_t, const pmf_qual_t *); 166 static bool esa_resume(device_t, const pmf_qual_t *); 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 NULL, /* dev_ioctl */ 226 esa_get_locks, 227 }; 228 229 CFATTACH_DECL2_NEW(esa, sizeof(struct esa_softc), esa_match, esa_attach, 230 esa_detach, NULL, NULL, esa_childdet); 231 232 /* 233 * audio(9) functions 234 */ 235 236 static int 237 esa_query_encoding(void *hdl, struct audio_encoding *ae) 238 { 239 240 if (ae->index < 0 || ae->index >= ESA_NENCODINGS) 241 return EINVAL; 242 *ae = esa_encoding[ae->index]; 243 244 return 0; 245 } 246 247 static int 248 esa_set_params(void *hdl, int setmode, int usemode, 249 audio_params_t *play, audio_params_t *rec, stream_filter_list_t *pfil, 250 stream_filter_list_t *rfil) 251 { 252 struct esa_voice *vc; 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 = device_private(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, 366 const audio_params_t *param) 367 { 368 369 return bs & ~0x20; /* Be conservative; align to 32 bytes */ 370 } 371 372 static int 373 esa_halt_output(void *hdl) 374 { 375 struct esa_voice *vc; 376 struct esa_softc *sc; 377 bus_space_tag_t iot; 378 bus_space_handle_t ioh; 379 uint16_t data; 380 381 vc = hdl; 382 sc = device_private(vc->parent); 383 iot = sc->sc_iot; 384 ioh = sc->sc_ioh; 385 if (vc->play.active == 0) 386 return 0; 387 388 vc->play.active = 0; 389 390 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, 391 ESA_CDATA_INSTANCE_READY + vc->play.data_offset, 0); 392 393 sc->sc_ntimers--; 394 if (sc->sc_ntimers == 0) { 395 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, 396 ESA_KDATA_TIMER_COUNT_RELOAD, 0); 397 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, 398 ESA_KDATA_TIMER_COUNT_CURRENT, 0); 399 data = bus_space_read_2(iot, ioh, ESA_HOST_INT_CTRL); 400 bus_space_write_2(iot, ioh, ESA_HOST_INT_CTRL, 401 data & ~ESA_CLKRUN_GEN_ENABLE); 402 } 403 404 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, 405 ESA_KDATA_MIXER_TASK_NUMBER, 406 sc->mixer_list.indexmap[vc->index]); 407 /* remove ourselves from the packed lists */ 408 esa_remove_list(vc, &sc->mixer_list, vc->index); 409 esa_remove_list(vc, &sc->dma_list, vc->index); 410 esa_remove_list(vc, &sc->msrc_list, vc->index); 411 412 return 0; 413 } 414 415 static int 416 esa_halt_input(void *hdl) 417 { 418 struct esa_voice *vc; 419 struct esa_softc *sc; 420 bus_space_tag_t iot; 421 bus_space_handle_t ioh; 422 uint32_t data; 423 424 vc = hdl; 425 sc = device_private(vc->parent); 426 iot = sc->sc_iot; 427 ioh = sc->sc_ioh; 428 if (vc->rec.active == 0) 429 return 0; 430 431 vc->rec.active = 0; 432 433 sc->sc_ntimers--; 434 if (sc->sc_ntimers == 0) { 435 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, 436 ESA_KDATA_TIMER_COUNT_RELOAD, 0); 437 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, 438 ESA_KDATA_TIMER_COUNT_CURRENT, 0); 439 data = bus_space_read_2(iot, ioh, ESA_HOST_INT_CTRL); 440 bus_space_write_2(iot, ioh, ESA_HOST_INT_CTRL, 441 data & ~ESA_CLKRUN_GEN_ENABLE); 442 } 443 444 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, vc->rec.data_offset + 445 ESA_CDATA_INSTANCE_READY, 0); 446 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, ESA_KDATA_ADC1_REQUEST, 447 0); 448 449 /* remove ourselves from the packed lists */ 450 esa_remove_list(vc, &sc->adc1_list, vc->index + ESA_NUM_VOICES); 451 esa_remove_list(vc, &sc->dma_list, vc->index + ESA_NUM_VOICES); 452 esa_remove_list(vc, &sc->msrc_list, vc->index + ESA_NUM_VOICES); 453 454 return 0; 455 } 456 457 static void * 458 esa_malloc(void *hdl, int direction, size_t size) 459 { 460 struct esa_voice *vc; 461 struct esa_softc *sc; 462 struct esa_dma *p; 463 int error; 464 465 p = kmem_alloc(sizeof(*p), KM_SLEEP); 466 vc = hdl; 467 sc = device_private(vc->parent); 468 error = esa_allocmem(sc, size, 16, p); 469 if (error) { 470 kmem_free(p, sizeof(*p)); 471 aprint_error_dev(sc->sc_dev, 472 "%s: not enough memory\n", __func__); 473 return 0; 474 } 475 p->next = vc->dma; 476 vc->dma = p; 477 478 return KERNADDR(p); 479 } 480 481 static void 482 esa_free(void *hdl, void *addr, size_t size) 483 { 484 struct esa_voice *vc; 485 struct esa_softc *sc; 486 struct esa_dma *p; 487 struct esa_dma **pp; 488 489 vc = hdl; 490 sc = device_private(vc->parent); 491 for (pp = &vc->dma; (p = *pp) != NULL; pp = &p->next) 492 if (KERNADDR(p) == addr) { 493 esa_freemem(sc, p); 494 *pp = p->next; 495 kmem_free(p, sizeof(*p)); 496 return; 497 } 498 } 499 500 static int 501 esa_getdev(void *hdl, struct audio_device *ret) 502 { 503 504 *ret = esa_device; 505 return 0; 506 } 507 508 static int 509 esa_set_port(void *hdl, mixer_ctrl_t *mc) 510 { 511 struct esa_voice *vc; 512 struct esa_softc *sc; 513 514 vc = hdl; 515 sc = device_private(vc->parent); 516 return sc->codec_if->vtbl->mixer_set_port(sc->codec_if, mc); 517 } 518 519 static int 520 esa_get_port(void *hdl, mixer_ctrl_t *mc) 521 { 522 struct esa_voice *vc; 523 struct esa_softc *sc; 524 525 vc = hdl; 526 sc = device_private(vc->parent); 527 return sc->codec_if->vtbl->mixer_get_port(sc->codec_if, mc); 528 } 529 530 static int 531 esa_query_devinfo(void *hdl, mixer_devinfo_t *di) 532 { 533 struct esa_voice *vc; 534 struct esa_softc *sc; 535 536 vc = hdl; 537 sc = device_private(vc->parent); 538 return sc->codec_if->vtbl->query_devinfo(sc->codec_if, di); 539 } 540 541 static size_t 542 esa_round_buffersize(void *hdl, int direction, size_t bufsize) 543 { 544 545 return bufsize; 546 } 547 548 static int 549 esa_get_props(void *hdl) 550 { 551 552 return AUDIO_PROP_MMAP | AUDIO_PROP_INDEPENDENT | AUDIO_PROP_FULLDUPLEX; 553 } 554 555 static int 556 esa_trigger_output(void *hdl, void *start, void *end, int blksize, 557 void (*intr)(void *), void *intrarg, const audio_params_t *param) 558 { 559 struct esa_voice *vc; 560 struct esa_softc *sc; 561 struct esa_dma *p; 562 bus_space_tag_t iot; 563 bus_space_handle_t ioh; 564 size_t size; 565 uint32_t data, bufaddr, i; 566 int data_bytes, dac_data, dsp_in_size; 567 int dsp_out_size, dsp_in_buf, dsp_out_buf; 568 569 vc = hdl; 570 sc = device_private(vc->parent); 571 iot = sc->sc_iot; 572 ioh = sc->sc_ioh; 573 data_bytes = (((ESA_MINISRC_TMP_BUFFER_SIZE & ~1) + 574 (ESA_MINISRC_IN_BUFFER_SIZE & ~1) + 575 (ESA_MINISRC_OUT_BUFFER_SIZE & ~1) + 4) + 255) & ~255; 576 dac_data = ESA_DAC_DATA + (data_bytes * vc->index); 577 dsp_in_size = ESA_MINISRC_IN_BUFFER_SIZE - (0x20 * 2); 578 dsp_out_size = ESA_MINISRC_OUT_BUFFER_SIZE - (0x20 * 2); 579 dsp_in_buf = dac_data + (ESA_MINISRC_TMP_BUFFER_SIZE / 2); 580 dsp_out_buf = dsp_in_buf + (dsp_in_size / 2) + 1; 581 582 if (vc->play.active) 583 return EINVAL; 584 585 for (p = vc->dma; p && KERNADDR(p) != start; p = p->next) 586 continue; 587 if (p == NULL) { 588 aprint_error_dev(sc->sc_dev, "%s: bad addr %p\n", __func__, 589 start); 590 return EINVAL; 591 } 592 593 vc->play.active = 1; 594 vc->play.intr = intr; 595 vc->play.arg = intrarg; 596 vc->play.pos = 0; 597 vc->play.count = 0; 598 vc->play.buf = start; 599 vc->play.bufsize = size = (size_t)(((char *)end - (char *)start)); 600 vc->play.blksize = blksize; 601 bufaddr = DMAADDR(p); 602 vc->play.start = bufaddr; 603 604 #define LO(x) ((x) & 0x0000ffff) 605 #define HI(x) ((x) >> 16) 606 607 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data + 608 ESA_CDATA_HOST_SRC_ADDRL, LO(bufaddr)); 609 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data + 610 ESA_CDATA_HOST_SRC_ADDRH, HI(bufaddr)); 611 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data + 612 ESA_CDATA_HOST_SRC_END_PLUS_1L, LO(bufaddr + size)); 613 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data + 614 ESA_CDATA_HOST_SRC_END_PLUS_1H, HI(bufaddr + size)); 615 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data + 616 ESA_CDATA_HOST_SRC_CURRENTL, LO(bufaddr)); 617 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data + 618 ESA_CDATA_HOST_SRC_CURRENTH, HI(bufaddr)); 619 620 /* DSP buffers */ 621 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data + 622 ESA_CDATA_IN_BUF_BEGIN, dsp_in_buf); 623 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data + 624 ESA_CDATA_IN_BUF_END_PLUS_1, dsp_in_buf + (dsp_in_size / 2)); 625 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data + 626 ESA_CDATA_IN_BUF_HEAD, dsp_in_buf); 627 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data + 628 ESA_CDATA_IN_BUF_TAIL, dsp_in_buf); 629 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data + 630 ESA_CDATA_OUT_BUF_BEGIN, dsp_out_buf); 631 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data + 632 ESA_CDATA_OUT_BUF_END_PLUS_1, dsp_out_buf + (dsp_out_size / 2)); 633 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data + 634 ESA_CDATA_OUT_BUF_HEAD, dsp_out_buf); 635 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data + 636 ESA_CDATA_OUT_BUF_TAIL, dsp_out_buf); 637 638 /* Some per-client initializers */ 639 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data + 640 ESA_SRC3_DIRECTION_OFFSET + 12, dac_data + 40 + 8); 641 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data + 642 ESA_SRC3_DIRECTION_OFFSET + 19, 0x400 + ESA_MINISRC_COEF_LOC); 643 /* Enable or disable low-pass filter? (0xff if rate > 45000) */ 644 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data + 645 ESA_SRC3_DIRECTION_OFFSET + 22, 646 vc->play.mode.sample_rate > 45000 ? 0xff : 0); 647 /* Tell it which way DMA is going */ 648 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data + 649 ESA_CDATA_DMA_CONTROL, 650 ESA_DMACONTROL_AUTOREPEAT + ESA_DMAC_PAGE3_SELECTOR + 651 ESA_DMAC_BLOCKF_SELECTOR); 652 653 /* Set an armload of static initializers */ 654 for (i = 0; i < __arraycount(esa_playvals); i++) 655 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data + 656 esa_playvals[i].addr, esa_playvals[i].val); 657 658 /* Put us in the packed task lists */ 659 esa_add_list(vc, &sc->msrc_list, dac_data >> ESA_DP_SHIFT_COUNT, 660 vc->index); 661 esa_add_list(vc, &sc->dma_list, dac_data >> ESA_DP_SHIFT_COUNT, 662 vc->index); 663 esa_add_list(vc, &sc->mixer_list, dac_data >> ESA_DP_SHIFT_COUNT, 664 vc->index); 665 #undef LO 666 #undef HI 667 668 sc->sc_ntimers++; 669 670 if (sc->sc_ntimers == 1) { 671 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, 672 ESA_KDATA_TIMER_COUNT_RELOAD, 240); 673 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, 674 ESA_KDATA_TIMER_COUNT_CURRENT, 240); 675 data = bus_space_read_2(iot, ioh, ESA_HOST_INT_CTRL); 676 bus_space_write_2(iot, ioh, ESA_HOST_INT_CTRL, 677 data | ESA_CLKRUN_GEN_ENABLE); 678 } 679 680 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, dac_data + 681 ESA_CDATA_INSTANCE_READY, 1); 682 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, 683 ESA_KDATA_MIXER_TASK_NUMBER, 684 sc->mixer_list.indexmap[vc->index]); 685 686 return 0; 687 } 688 689 static int 690 esa_trigger_input(void *hdl, void *start, void *end, int blksize, 691 void (*intr)(void *), void *intrarg, const audio_params_t *param) 692 { 693 struct esa_voice *vc; 694 struct esa_softc *sc; 695 struct esa_dma *p; 696 bus_space_tag_t iot; 697 bus_space_handle_t ioh; 698 uint32_t data, bufaddr, i; 699 size_t size; 700 int data_bytes, adc_data, dsp_in_size; 701 int dsp_out_size, dsp_in_buf, dsp_out_buf; 702 703 vc = hdl; 704 sc = device_private(vc->parent); 705 iot = sc->sc_iot; 706 ioh = sc->sc_ioh; 707 data_bytes = (((ESA_MINISRC_TMP_BUFFER_SIZE & ~1) + 708 (ESA_MINISRC_IN_BUFFER_SIZE & ~1) + 709 (ESA_MINISRC_OUT_BUFFER_SIZE & ~1) + 4) + 255) & ~255; 710 adc_data = ESA_DAC_DATA + (data_bytes * vc->index) + (data_bytes / 2); 711 dsp_in_size = ESA_MINISRC_IN_BUFFER_SIZE - (0x10 * 2); 712 dsp_out_size = ESA_MINISRC_OUT_BUFFER_SIZE - (0x10 * 2); 713 dsp_in_buf = adc_data + (ESA_MINISRC_TMP_BUFFER_SIZE / 2); 714 dsp_out_buf = dsp_in_buf + (dsp_in_size / 2) + 1; 715 716 vc->rec.data_offset = adc_data; 717 718 /* We only support 1 recording channel */ 719 if (vc->index > 0) 720 return ENODEV; 721 722 if (vc->rec.active) 723 return EINVAL; 724 725 for (p = vc->dma; p && KERNADDR(p) != start; p = p->next) 726 continue; 727 if (p == NULL) { 728 aprint_error_dev(sc->sc_dev, "%s: bad addr %p\n", 729 __func__, start); 730 return EINVAL; 731 } 732 733 vc->rec.active = 1; 734 vc->rec.intr = intr; 735 vc->rec.arg = intrarg; 736 vc->rec.pos = 0; 737 vc->rec.count = 0; 738 vc->rec.buf = start; 739 vc->rec.bufsize = size = (size_t)(((char *)end - (char *)start)); 740 vc->rec.blksize = blksize; 741 bufaddr = DMAADDR(p); 742 vc->rec.start = bufaddr; 743 744 #define LO(x) ((x) & 0x0000ffff) 745 #define HI(x) ((x) >> 16) 746 747 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data + 748 ESA_CDATA_HOST_SRC_ADDRL, LO(bufaddr)); 749 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data + 750 ESA_CDATA_HOST_SRC_ADDRH, HI(bufaddr)); 751 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data + 752 ESA_CDATA_HOST_SRC_END_PLUS_1L, LO(bufaddr + size)); 753 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data + 754 ESA_CDATA_HOST_SRC_END_PLUS_1H, HI(bufaddr + size)); 755 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data + 756 ESA_CDATA_HOST_SRC_CURRENTL, LO(bufaddr)); 757 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data + 758 ESA_CDATA_HOST_SRC_CURRENTH, HI(bufaddr)); 759 760 /* DSP buffers */ 761 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data + 762 ESA_CDATA_IN_BUF_BEGIN, dsp_in_buf); 763 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data + 764 ESA_CDATA_IN_BUF_END_PLUS_1, dsp_in_buf + (dsp_in_size / 2)); 765 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data + 766 ESA_CDATA_IN_BUF_HEAD, dsp_in_buf); 767 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data + 768 ESA_CDATA_IN_BUF_TAIL, dsp_in_buf); 769 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data + 770 ESA_CDATA_OUT_BUF_BEGIN, dsp_out_buf); 771 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data + 772 ESA_CDATA_OUT_BUF_END_PLUS_1, dsp_out_buf + (dsp_out_size / 2)); 773 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data + 774 ESA_CDATA_OUT_BUF_HEAD, dsp_out_buf); 775 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data + 776 ESA_CDATA_OUT_BUF_TAIL, dsp_out_buf); 777 778 /* Some per-client initializers */ 779 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data + 780 ESA_SRC3_DIRECTION_OFFSET + 12, adc_data + 40 + 8); 781 /* Tell it which way DMA is going */ 782 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data + 783 ESA_CDATA_DMA_CONTROL, 784 ESA_DMACONTROL_DIRECTION + ESA_DMACONTROL_AUTOREPEAT + 785 ESA_DMAC_PAGE3_SELECTOR + ESA_DMAC_BLOCKF_SELECTOR); 786 787 /* Set an armload of static initializers */ 788 for (i = 0; i < __arraycount(esa_recvals); i++) 789 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data + 790 esa_recvals[i].addr, esa_recvals[i].val); 791 792 /* Put us in the packed task lists */ 793 esa_add_list(vc, &sc->adc1_list, adc_data >> ESA_DP_SHIFT_COUNT, 794 vc->index + ESA_NUM_VOICES); 795 esa_add_list(vc, &sc->msrc_list, adc_data >> ESA_DP_SHIFT_COUNT, 796 vc->index + ESA_NUM_VOICES); 797 esa_add_list(vc, &sc->dma_list, adc_data >> ESA_DP_SHIFT_COUNT, 798 vc->index + ESA_NUM_VOICES); 799 #undef LO 800 #undef HI 801 802 sc->sc_ntimers++; 803 if (sc->sc_ntimers == 1) { 804 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, 805 ESA_KDATA_TIMER_COUNT_RELOAD, 240); 806 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, 807 ESA_KDATA_TIMER_COUNT_CURRENT, 240); 808 data = bus_space_read_2(iot, ioh, ESA_HOST_INT_CTRL); 809 bus_space_write_2(iot, ioh, ESA_HOST_INT_CTRL, 810 data | ESA_CLKRUN_GEN_ENABLE); 811 } 812 813 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, adc_data + 814 ESA_CDATA_INSTANCE_READY, 1); 815 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, ESA_KDATA_ADC1_REQUEST, 816 1); 817 818 return 0; 819 } 820 821 /* Interrupt handler */ 822 static int 823 esa_intr(void *hdl) 824 { 825 struct esa_softc *sc; 826 struct esa_voice *vc; 827 bus_space_tag_t iot; 828 bus_space_handle_t ioh; 829 uint8_t status; 830 uint32_t pos; 831 uint32_t diff; 832 uint32_t blksize; 833 int i; 834 835 sc = hdl; 836 mutex_spin_enter(&sc->sc_intr_lock); 837 838 iot = sc->sc_iot; 839 ioh = sc->sc_ioh; 840 841 status = bus_space_read_1(iot, ioh, ESA_HOST_INT_STATUS); 842 if (status == 0xff) { 843 mutex_spin_exit(&sc->sc_intr_lock); 844 return 0; 845 } 846 847 /* ack the interrupt */ 848 bus_space_write_1(iot, ioh, ESA_HOST_INT_STATUS, status); 849 850 if (status & ESA_HV_INT_PENDING) { 851 uint8_t event; 852 853 aprint_normal_dev(sc->sc_dev, "hardware volume interrupt\n"); 854 event = bus_space_read_1(iot, ioh, ESA_HW_VOL_COUNTER_MASTER); 855 switch(event) { 856 case 0xaa: /* volume up */ 857 pmf_event_inject(NULL, PMFE_AUDIO_VOLUME_UP); 858 break; 859 case 0x66: /* volume down */ 860 pmf_event_inject(NULL, PMFE_AUDIO_VOLUME_DOWN); 861 break; 862 case 0x88: /* mute */ 863 pmf_event_inject(NULL, PMFE_AUDIO_VOLUME_TOGGLE); 864 break; 865 default: 866 aprint_normal_dev(sc->sc_dev, 867 "unknown hwvol event 0x%02x\n", event); 868 break; 869 } 870 bus_space_write_1(iot, ioh, ESA_HW_VOL_COUNTER_MASTER, 0x88); 871 } 872 873 if ((status & ESA_ASSP_INT_PENDING) == 0 || 874 (bus_space_read_1(iot, ioh, 875 ESA_ASSP_CONTROL_B) & ESA_STOP_ASSP_CLOCK) != 0 || 876 (bus_space_read_1(iot, ioh, 877 ESA_ASSP_HOST_INT_STATUS) & ESA_DSP2HOST_REQ_TIMER) == 0) { 878 mutex_spin_exit(&sc->sc_intr_lock); 879 return 1; 880 } 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 mutex_spin_exit(&sc->sc_intr_lock); 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, __arraycount(p->segs), 932 &p->nsegs, BUS_DMA_WAITOK); 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_WAITOK | 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_WAITOK, &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_WAITOK); 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(device_t dev, cfdata_t 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(device_t parent, device_t 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 int revision, i, error; 1010 char intrbuf[PCI_INTRSTR_LEN]; 1011 1012 sc = device_private(self); 1013 pa = (struct pci_attach_args *)aux; 1014 tag = pa->pa_tag; 1015 pc = pa->pa_pc; 1016 1017 pci_aprint_devinfo(pa, "Audio controller"); 1018 1019 revision = PCI_REVISION(pa->pa_class); 1020 1021 for (card = esa_card_types; card->pci_vendor_id; card++) 1022 if (PCI_VENDOR(pa->pa_id) == card->pci_vendor_id && 1023 PCI_PRODUCT(pa->pa_id) == card->pci_product_id) { 1024 sc->type = card->type; 1025 sc->delay1 = card->delay1; 1026 sc->delay2 = card->delay2; 1027 break; 1028 } 1029 1030 data = pci_conf_read(pc, tag, PCI_COMMAND_STATUS_REG); 1031 data |= (PCI_COMMAND_IO_ENABLE | PCI_COMMAND_MEM_ENABLE 1032 | PCI_COMMAND_MASTER_ENABLE); 1033 pci_conf_write(pc, tag, PCI_COMMAND_STATUS_REG, data); 1034 1035 /* Map I/O register */ 1036 if (pci_mapreg_map(pa, PCI_CBIO, PCI_MAPREG_TYPE_IO, 0, 1037 &sc->sc_iot, &sc->sc_ioh, &sc->sc_iob, &sc->sc_ios)) { 1038 aprint_error_dev(sc->sc_dev, "can't map i/o space\n"); 1039 return; 1040 } 1041 1042 /* Initialize softc */ 1043 sc->sc_dev = self; 1044 sc->sc_tag = tag; 1045 sc->sc_pct = pc; 1046 sc->sc_dmat = pa->pa_dmat; 1047 1048 mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_NONE); 1049 mutex_init(&sc->sc_intr_lock, MUTEX_DEFAULT, IPL_AUDIO); 1050 1051 /* Map and establish an interrupt */ 1052 if (pci_intr_map(pa, &ih)) { 1053 aprint_error_dev(sc->sc_dev, "can't map interrupt\n"); 1054 mutex_destroy(&sc->sc_lock); 1055 mutex_destroy(&sc->sc_intr_lock); 1056 return; 1057 } 1058 intrstr = pci_intr_string(pc, ih, intrbuf, sizeof(intrbuf)); 1059 sc->sc_ih = pci_intr_establish_xname(pc, ih, IPL_AUDIO, esa_intr, sc, 1060 device_xname(self)); 1061 if (sc->sc_ih == NULL) { 1062 aprint_error_dev(sc->sc_dev, "can't establish interrupt"); 1063 if (intrstr != NULL) 1064 aprint_error(" at %s", intrstr); 1065 aprint_error("\n"); 1066 mutex_destroy(&sc->sc_lock); 1067 mutex_destroy(&sc->sc_intr_lock); 1068 return; 1069 } 1070 aprint_normal_dev(sc->sc_dev, "interrupting at %s\n", intrstr); 1071 1072 /* power up chip */ 1073 if ((error = pci_activate(pa->pa_pc, pa->pa_tag, self, 1074 pci_activate_null)) && error != EOPNOTSUPP) { 1075 aprint_error_dev(sc->sc_dev, "cannot activate %d\n", error); 1076 mutex_destroy(&sc->sc_lock); 1077 mutex_destroy(&sc->sc_intr_lock); 1078 return; 1079 } 1080 1081 /* Init chip */ 1082 if (esa_init(sc) == -1) { 1083 aprint_error_dev(sc->sc_dev, 1084 "esa_attach: unable to initialize the card\n"); 1085 mutex_destroy(&sc->sc_lock); 1086 mutex_destroy(&sc->sc_intr_lock); 1087 return; 1088 } 1089 1090 /* create suspend save area */ 1091 sc->savememsz = sizeof(uint16_t) * (ESA_REV_B_CODE_MEMORY_LENGTH 1092 + ESA_REV_B_DATA_MEMORY_LENGTH + 1); 1093 sc->savemem = kmem_zalloc(sc->savememsz, KM_SLEEP); 1094 1095 /* 1096 * Every card I've seen has had their channels swapped with respect 1097 * to the mixer. Ie: 1098 * $ mixerctl -w outputs.master=0,191 1099 * Would result in the _right_ speaker being turned off. 1100 * 1101 * So, we will swap the left and right mixer channels to compensate 1102 * for this. 1103 * 1104 * XXX PR# 23620: The Dell C810 channels are not swapped. Match 1105 * on revision ID for now; this is probably wrong. 1106 */ 1107 if (revision == 0x10 && sc->type == ESS_MAESTRO3) 1108 sc->codec_flags = 0; 1109 else 1110 sc->codec_flags = AC97_HOST_SWAPPED_CHANNELS; 1111 1112 /* initialize list management structures */ 1113 sc->mixer_list.mem_addr = ESA_KDATA_MIXER_XFER0; 1114 sc->mixer_list.max = ESA_MAX_VIRTUAL_MIXER_CHANNELS; 1115 sc->adc1_list.mem_addr = ESA_KDATA_ADC1_XFER0; 1116 sc->adc1_list.max = ESA_MAX_VIRTUAL_ADC1_CHANNELS; 1117 sc->dma_list.mem_addr = ESA_KDATA_DMA_XFER0; 1118 sc->dma_list.max = ESA_MAX_VIRTUAL_DMA_CHANNELS; 1119 sc->msrc_list.mem_addr = ESA_KDATA_INSTANCE0_MINISRC; 1120 sc->msrc_list.max = ESA_MAX_INSTANCE_MINISRC; 1121 1122 /* initialize index maps */ 1123 for (i = 0; i < ESA_NUM_VOICES * 2; i++) { 1124 sc->mixer_list.indexmap[i] = -1; 1125 sc->msrc_list.indexmap[i] = -1; 1126 sc->dma_list.indexmap[i] = -1; 1127 sc->adc1_list.indexmap[i] = -1; 1128 } 1129 1130 /* Attach AC97 host interface */ 1131 sc->host_if.arg = sc; 1132 sc->host_if.attach = esa_attach_codec; 1133 sc->host_if.read = esa_read_codec; 1134 sc->host_if.write = esa_write_codec; 1135 sc->host_if.reset = esa_reset_codec; 1136 sc->host_if.flags = esa_flags_codec; 1137 1138 if (ac97_attach(&sc->host_if, self, &sc->sc_lock) != 0) { 1139 mutex_destroy(&sc->sc_lock); 1140 mutex_destroy(&sc->sc_intr_lock); 1141 return; 1142 } 1143 1144 /* Attach audio interface. */ 1145 for (i = 0; i < ESA_NUM_VOICES; i++) { 1146 sc->voice[i].parent = sc->sc_dev; 1147 sc->voice[i].index = i; 1148 sc->sc_audiodev[i] = 1149 audio_attach_mi(&esa_hw_if, &sc->voice[i], sc->sc_dev); 1150 } 1151 1152 if (!pmf_device_register(self, esa_suspend, esa_resume)) 1153 aprint_error_dev(self, "couldn't establish power handler\n"); 1154 1155 return; 1156 } 1157 1158 void 1159 esa_childdet(device_t self, device_t child) 1160 { 1161 struct esa_softc *sc = device_private(self); 1162 int i; 1163 1164 for (i = 0; i < ESA_NUM_VOICES; i++) { 1165 if (sc->sc_audiodev[i] == child) { 1166 sc->sc_audiodev[i] = NULL; 1167 break; 1168 } 1169 } 1170 KASSERT(i < ESA_NUM_VOICES); 1171 } 1172 1173 static int 1174 esa_detach(device_t self, int flags) 1175 { 1176 struct esa_softc *sc; 1177 int i; 1178 1179 sc = device_private(self); 1180 for (i = 0; i < ESA_NUM_VOICES; i++) { 1181 if (sc->sc_audiodev[i] != NULL) 1182 config_detach(sc->sc_audiodev[i], flags); 1183 } 1184 1185 if (sc->sc_ih != NULL) 1186 pci_intr_disestablish(sc->sc_pct, sc->sc_ih); 1187 if (sc->sc_ios) 1188 bus_space_unmap(sc->sc_iot, sc->sc_ioh, sc->sc_ios); 1189 1190 kmem_free(sc->savemem, sc->savememsz); 1191 mutex_destroy(&sc->sc_lock); 1192 mutex_destroy(&sc->sc_intr_lock); 1193 1194 return 0; 1195 } 1196 1197 static uint16_t 1198 esa_read_assp(struct esa_softc *sc, uint16_t region, uint16_t index) 1199 { 1200 uint16_t data; 1201 bus_space_tag_t iot; 1202 bus_space_handle_t ioh; 1203 1204 iot = sc->sc_iot; 1205 ioh = sc->sc_ioh; 1206 bus_space_write_2(iot, ioh, ESA_DSP_PORT_MEMORY_TYPE, 1207 region & ESA_MEMTYPE_MASK); 1208 bus_space_write_2(iot, ioh, ESA_DSP_PORT_MEMORY_INDEX, index); 1209 data = bus_space_read_2(iot, ioh, ESA_DSP_PORT_MEMORY_DATA); 1210 1211 return data; 1212 } 1213 1214 static void 1215 esa_write_assp(struct esa_softc *sc, uint16_t region, uint16_t index, 1216 uint16_t data) 1217 { 1218 bus_space_tag_t iot; 1219 bus_space_handle_t ioh; 1220 1221 iot = sc->sc_iot; 1222 ioh = sc->sc_ioh; 1223 bus_space_write_2(iot, ioh, ESA_DSP_PORT_MEMORY_TYPE, 1224 region & ESA_MEMTYPE_MASK); 1225 bus_space_write_2(iot, ioh, ESA_DSP_PORT_MEMORY_INDEX, index); 1226 bus_space_write_2(iot, ioh, ESA_DSP_PORT_MEMORY_DATA, data); 1227 1228 return; 1229 } 1230 1231 static int 1232 esa_init_codec(struct esa_softc *sc) 1233 { 1234 bus_space_tag_t iot; 1235 bus_space_handle_t ioh; 1236 uint32_t data; 1237 1238 iot = sc->sc_iot; 1239 ioh = sc->sc_ioh; 1240 data = bus_space_read_1(iot, ioh, ESA_CODEC_COMMAND); 1241 1242 return (data & 0x1) ? 0 : 1; 1243 } 1244 1245 static int 1246 esa_attach_codec(void *aux, struct ac97_codec_if *codec_if) 1247 { 1248 struct esa_softc *sc; 1249 1250 sc = aux; 1251 sc->codec_if = codec_if; 1252 1253 return 0; 1254 } 1255 1256 static int 1257 esa_read_codec(void *aux, uint8_t reg, uint16_t *result) 1258 { 1259 struct esa_softc *sc; 1260 bus_space_tag_t iot; 1261 bus_space_handle_t ioh; 1262 1263 sc = aux; 1264 iot = sc->sc_iot; 1265 ioh = sc->sc_ioh; 1266 if (esa_wait(sc)) 1267 aprint_error_dev(sc->sc_dev, "esa_read_codec: timed out\n"); 1268 bus_space_write_1(iot, ioh, ESA_CODEC_COMMAND, (reg & 0x7f) | 0x80); 1269 delay(50); 1270 if (esa_wait(sc)) 1271 aprint_error_dev(sc->sc_dev, "esa_read_codec: timed out\n"); 1272 *result = bus_space_read_2(iot, ioh, ESA_CODEC_DATA); 1273 1274 return 0; 1275 } 1276 1277 static int 1278 esa_write_codec(void *aux, uint8_t reg, uint16_t data) 1279 { 1280 struct esa_softc *sc; 1281 bus_space_tag_t iot; 1282 bus_space_handle_t ioh; 1283 1284 sc = aux; 1285 iot = sc->sc_iot; 1286 ioh = sc->sc_ioh; 1287 if (esa_wait(sc)) { 1288 aprint_error_dev(sc->sc_dev, "esa_write_codec: timed out\n"); 1289 return -1; 1290 } 1291 bus_space_write_2(iot, ioh, ESA_CODEC_DATA, data); 1292 bus_space_write_1(iot, ioh, ESA_CODEC_COMMAND, reg & 0x7f); 1293 delay(50); 1294 1295 return 0; 1296 } 1297 1298 static int 1299 esa_reset_codec(void *aux) 1300 { 1301 1302 return 0; 1303 } 1304 1305 static enum ac97_host_flags 1306 esa_flags_codec(void *aux) 1307 { 1308 struct esa_softc *sc; 1309 1310 sc = aux; 1311 return sc->codec_flags; 1312 } 1313 1314 static int 1315 esa_wait(struct esa_softc *sc) 1316 { 1317 int i, val; 1318 bus_space_tag_t iot; 1319 bus_space_handle_t ioh; 1320 1321 iot = sc->sc_iot; 1322 ioh = sc->sc_ioh; 1323 for (i = 0; i < 20; i++) { 1324 val = bus_space_read_1(iot, ioh, ESA_CODEC_STATUS); 1325 if ((val & 1) == 0) 1326 return 0; 1327 delay(2); 1328 } 1329 1330 return -1; 1331 } 1332 1333 static int 1334 esa_init(struct esa_softc *sc) 1335 { 1336 struct esa_voice *vc; 1337 bus_space_tag_t iot; 1338 bus_space_handle_t ioh; 1339 pcitag_t tag; 1340 pci_chipset_tag_t pc; 1341 uint32_t data, i, size; 1342 uint8_t reset_state; 1343 int data_bytes; 1344 1345 iot = sc->sc_iot; 1346 ioh = sc->sc_ioh; 1347 tag = sc->sc_tag; 1348 pc = sc->sc_pct; 1349 data_bytes = (((ESA_MINISRC_TMP_BUFFER_SIZE & ~1) + 1350 (ESA_MINISRC_IN_BUFFER_SIZE & ~1) + 1351 (ESA_MINISRC_OUT_BUFFER_SIZE & ~1) + 4) + 255) & ~255; 1352 1353 mutex_spin_enter(&sc->sc_intr_lock); 1354 1355 /* Disable legacy emulation */ 1356 data = pci_conf_read(pc, tag, PCI_LEGACY_AUDIO_CTRL); 1357 data |= DISABLE_LEGACY; 1358 pci_conf_write(pc, tag, PCI_LEGACY_AUDIO_CTRL, data); 1359 1360 esa_config(sc); 1361 1362 reset_state = esa_assp_halt(sc); 1363 1364 esa_init_codec(sc); 1365 esa_codec_reset(sc); 1366 1367 /* Zero kernel and mixer data */ 1368 size = ESA_REV_B_DATA_MEMORY_UNIT_LENGTH * ESA_NUM_UNITS_KERNEL_DATA; 1369 for (i = 0; i < size / 2; i++) { 1370 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, 1371 ESA_KDATA_BASE_ADDR + i, 0); 1372 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, 1373 ESA_KDATA_BASE_ADDR2 + i, 0); 1374 } 1375 1376 /* Init DMA pointer */ 1377 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, ESA_KDATA_CURRENT_DMA, 1378 ESA_KDATA_DMA_XFER0); 1379 1380 /* Write kernel code into memory */ 1381 for (i = 0; i < __arraycount(esa_assp_kernel_image); i++) 1382 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_CODE, 1383 ESA_REV_B_CODE_MEMORY_BEGIN + i, esa_assp_kernel_image[i]); 1384 1385 for (i = 0; i < __arraycount(esa_assp_minisrc_image); i++) 1386 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_CODE, 0x400 + i, 1387 esa_assp_minisrc_image[i]); 1388 1389 /* Write the coefficients for the low pass filter */ 1390 for (i = 0; i < __arraycount(esa_minisrc_lpf_image); i++) 1391 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_CODE, 1392 0x400 + ESA_MINISRC_COEF_LOC + i, 1393 esa_minisrc_lpf_image[i]); 1394 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_CODE, 1395 0x400 + ESA_MINISRC_COEF_LOC + size, 0x8000); 1396 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, ESA_KDATA_TASK0, 0x400); 1397 /* Init the mixer number */ 1398 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, 1399 ESA_KDATA_MIXER_TASK_NUMBER, 0); 1400 /* Extreme kernel master volume */ 1401 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, 1402 ESA_KDATA_DAC_LEFT_VOLUME, ESA_ARB_VOLUME); 1403 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, 1404 ESA_KDATA_DAC_RIGHT_VOLUME, ESA_ARB_VOLUME); 1405 1406 if (esa_amp_enable(sc)) 1407 return -1; 1408 1409 /* Zero entire DAC/ADC area */ 1410 for (i = 0x1100; i < 0x1c00; i++) 1411 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, i, 0); 1412 1413 /* set some sane defaults */ 1414 for (i = 0; i < ESA_NUM_VOICES; i++) { 1415 vc = &sc->voice[i]; 1416 vc->play.data_offset = ESA_DAC_DATA + (data_bytes * i); 1417 vc->rec.data_offset = ESA_DAC_DATA + (data_bytes * i * 2); 1418 } 1419 1420 esa_enable_interrupts(sc); 1421 1422 bus_space_write_1(iot, ioh, ESA_DSP_PORT_CONTROL_REG_B, 1423 reset_state | ESA_REGB_ENABLE_RESET); 1424 1425 mutex_spin_exit(&sc->sc_intr_lock); 1426 1427 return 0; 1428 } 1429 1430 static void 1431 esa_config(struct esa_softc *sc) 1432 { 1433 bus_space_tag_t iot; 1434 bus_space_handle_t ioh; 1435 pcitag_t tag; 1436 pci_chipset_tag_t pc; 1437 uint32_t data; 1438 1439 iot = sc->sc_iot; 1440 ioh = sc->sc_ioh; 1441 tag = sc->sc_tag; 1442 pc = sc->sc_pct; 1443 1444 data = pci_conf_read(pc, tag, ESA_PCI_ALLEGRO_CONFIG); 1445 data &= ESA_REDUCED_DEBOUNCE; 1446 data |= ESA_PM_CTRL_ENABLE | ESA_CLK_DIV_BY_49 | ESA_USE_PCI_TIMING; 1447 pci_conf_write(pc, tag, ESA_PCI_ALLEGRO_CONFIG, data); 1448 1449 bus_space_write_1(iot, ioh, ESA_ASSP_CONTROL_B, ESA_RESET_ASSP); 1450 data = pci_conf_read(pc, tag, ESA_PCI_ALLEGRO_CONFIG); 1451 data &= ~ESA_INT_CLK_SELECT; 1452 if (sc->type == ESS_MAESTRO3) { 1453 data &= ~ESA_INT_CLK_MULT_ENABLE; 1454 data |= ESA_INT_CLK_SRC_NOT_PCI; 1455 } 1456 data &= ~(ESA_CLK_MULT_MODE_SELECT | ESA_CLK_MULT_MODE_SELECT_2); 1457 pci_conf_write(pc, tag, ESA_PCI_ALLEGRO_CONFIG, data); 1458 1459 if (sc->type == ESS_ALLEGRO1) { 1460 data = pci_conf_read(pc, tag, ESA_PCI_USER_CONFIG); 1461 data |= ESA_IN_CLK_12MHZ_SELECT; 1462 pci_conf_write(pc, tag, ESA_PCI_USER_CONFIG, data); 1463 } 1464 1465 data = bus_space_read_1(iot, ioh, ESA_ASSP_CONTROL_A); 1466 data &= ~(ESA_DSP_CLK_36MHZ_SELECT | ESA_ASSP_CLK_49MHZ_SELECT); 1467 data |= ESA_ASSP_CLK_49MHZ_SELECT; /* XXX: Assumes 49MHz DSP */ 1468 data |= ESA_ASSP_0_WS_ENABLE; 1469 bus_space_write_1(iot, ioh, ESA_ASSP_CONTROL_A, data); 1470 1471 bus_space_write_1(iot, ioh, ESA_ASSP_CONTROL_B, ESA_RUN_ASSP); 1472 1473 return; 1474 } 1475 1476 static uint8_t 1477 esa_assp_halt(struct esa_softc *sc) 1478 { 1479 bus_space_tag_t iot; 1480 bus_space_handle_t ioh; 1481 uint8_t data, reset_state; 1482 1483 iot = sc->sc_iot; 1484 ioh = sc->sc_ioh; 1485 data = bus_space_read_1(iot, ioh, ESA_DSP_PORT_CONTROL_REG_B); 1486 reset_state = data & ~ESA_REGB_STOP_CLOCK; 1487 delay(10000); 1488 bus_space_write_1(iot, ioh, ESA_DSP_PORT_CONTROL_REG_B, 1489 reset_state & ~ESA_REGB_ENABLE_RESET); 1490 delay(10000); 1491 1492 return reset_state; 1493 } 1494 1495 static void 1496 esa_codec_reset(struct esa_softc *sc) 1497 { 1498 bus_space_tag_t iot; 1499 bus_space_handle_t ioh; 1500 uint16_t data, dir; 1501 int retry; 1502 1503 iot = sc->sc_iot; 1504 ioh = sc->sc_ioh; 1505 retry = 0; 1506 do { 1507 data = bus_space_read_2(iot, ioh, ESA_GPIO_DIRECTION); 1508 dir = data | 0x10; /* assuming pci bus master? */ 1509 1510 /* remote codec config */ 1511 data = bus_space_read_2(iot, ioh, ESA_RING_BUS_CTRL_B); 1512 bus_space_write_2(iot, ioh, ESA_RING_BUS_CTRL_B, 1513 data & ~ESA_SECOND_CODEC_ID_MASK); 1514 data = bus_space_read_2(iot, ioh, ESA_SDO_OUT_DEST_CTRL); 1515 bus_space_write_2(iot, ioh, ESA_SDO_OUT_DEST_CTRL, 1516 data & ~ESA_COMMAND_ADDR_OUT); 1517 data = bus_space_read_2(iot, ioh, ESA_SDO_IN_DEST_CTRL); 1518 bus_space_write_2(iot, ioh, ESA_SDO_IN_DEST_CTRL, 1519 data & ~ESA_STATUS_ADDR_IN); 1520 1521 bus_space_write_2(iot, ioh, ESA_RING_BUS_CTRL_A, 1522 ESA_IO_SRAM_ENABLE); 1523 delay(20); 1524 1525 bus_space_write_2(iot, ioh, ESA_GPIO_DIRECTION, 1526 dir & ~ESA_GPO_PRIMARY_AC97); 1527 bus_space_write_2(iot, ioh, ESA_GPIO_MASK, 1528 ~ESA_GPO_PRIMARY_AC97); 1529 bus_space_write_2(iot, ioh, ESA_GPIO_DATA, 0); 1530 bus_space_write_2(iot, ioh, ESA_GPIO_DIRECTION, 1531 dir | ESA_GPO_PRIMARY_AC97); 1532 delay(sc->delay1 * 1000); 1533 bus_space_write_2(iot, ioh, ESA_GPIO_DATA, 1534 ESA_GPO_PRIMARY_AC97); 1535 delay(5); 1536 bus_space_write_2(iot, ioh, ESA_RING_BUS_CTRL_A, 1537 ESA_IO_SRAM_ENABLE | ESA_SERIAL_AC_LINK_ENABLE); 1538 bus_space_write_2(iot, ioh, ESA_GPIO_MASK, ~0); 1539 delay(sc->delay2 * 1000); 1540 1541 esa_read_codec(sc, 0x7c, &data); 1542 if ((data == 0) || (data == 0xffff)) { 1543 retry++; 1544 if (retry > 3) { 1545 aprint_error_dev(sc->sc_dev, 1546 "esa_codec_reset: failed\n"); 1547 break; 1548 } 1549 aprint_normal_dev(sc->sc_dev, 1550 "esa_codec_reset: retrying\n"); 1551 } else 1552 retry = 0; 1553 } while (retry); 1554 1555 return; 1556 } 1557 1558 static int 1559 esa_amp_enable(struct esa_softc *sc) 1560 { 1561 bus_space_tag_t iot; 1562 bus_space_handle_t ioh; 1563 uint32_t gpo, polarity_port, polarity; 1564 uint16_t data; 1565 1566 iot = sc->sc_iot; 1567 ioh = sc->sc_ioh; 1568 switch (sc->type) { 1569 case ESS_ALLEGRO1: 1570 polarity_port = 0x1800; 1571 break; 1572 case ESS_MAESTRO3: 1573 polarity_port = 0x1100; 1574 break; 1575 default: 1576 aprint_error_dev(sc->sc_dev, 1577 "esa_amp_enable: Unknown chip type!!!\n"); 1578 return 1; 1579 } 1580 1581 gpo = (polarity_port >> 8) & 0x0f; 1582 polarity = polarity_port >> 12; 1583 polarity = !polarity; /* Enable */ 1584 polarity = polarity << gpo; 1585 gpo = 1 << gpo; 1586 bus_space_write_2(iot, ioh, ESA_GPIO_MASK, ~gpo); 1587 data = bus_space_read_2(iot, ioh, ESA_GPIO_DIRECTION); 1588 bus_space_write_2(iot, ioh, ESA_GPIO_DIRECTION, data | gpo); 1589 data = ESA_GPO_SECONDARY_AC97 | ESA_GPO_PRIMARY_AC97 | polarity; 1590 bus_space_write_2(iot, ioh, ESA_GPIO_DATA, data); 1591 bus_space_write_2(iot, ioh, ESA_GPIO_MASK, ~0); 1592 1593 return 0; 1594 } 1595 1596 static void 1597 esa_enable_interrupts(struct esa_softc *sc) 1598 { 1599 bus_space_tag_t iot; 1600 bus_space_handle_t ioh; 1601 uint8_t data; 1602 1603 iot = sc->sc_iot; 1604 ioh = sc->sc_ioh; 1605 bus_space_write_2(iot, ioh, ESA_HOST_INT_CTRL, 1606 ESA_ASSP_INT_ENABLE | ESA_HV_INT_ENABLE); 1607 data = bus_space_read_1(iot, ioh, ESA_ASSP_CONTROL_C); 1608 bus_space_write_1(iot, ioh, ESA_ASSP_CONTROL_C, 1609 data | ESA_ASSP_HOST_INT_ENABLE); 1610 } 1611 1612 /* 1613 * List management 1614 */ 1615 static int 1616 esa_add_list(struct esa_voice *vc, struct esa_list *el, 1617 uint16_t val, int index) 1618 { 1619 struct esa_softc *sc; 1620 1621 sc = device_private(vc->parent); 1622 el->indexmap[index] = el->currlen; 1623 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, 1624 el->mem_addr + el->currlen, 1625 val); 1626 1627 return el->currlen++; 1628 } 1629 1630 static void 1631 esa_remove_list(struct esa_voice *vc, struct esa_list *el, int index) 1632 { 1633 struct esa_softc *sc; 1634 uint16_t val; 1635 int lastindex; 1636 int vindex; 1637 int i; 1638 1639 sc = device_private(vc->parent); 1640 lastindex = el->currlen - 1; 1641 vindex = el->indexmap[index]; 1642 1643 /* reset our virtual index */ 1644 el->indexmap[index] = -1; 1645 1646 if (vindex != lastindex) { 1647 val = esa_read_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, 1648 el->mem_addr + lastindex); 1649 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, 1650 el->mem_addr + vindex, 1651 val); 1652 for (i = 0; i < ESA_NUM_VOICES * 2; i++) 1653 if (el->indexmap[i] == lastindex) 1654 break; 1655 if (i >= ESA_NUM_VOICES * 2) 1656 aprint_error_dev(sc->sc_dev, 1657 "esa_remove_list: invalid task index\n"); 1658 else 1659 el->indexmap[i] = vindex; 1660 } 1661 1662 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, 1663 el->mem_addr + lastindex, 0); 1664 el->currlen--; 1665 1666 return; 1667 } 1668 1669 static bool 1670 esa_suspend(device_t dv, const pmf_qual_t *qual) 1671 { 1672 struct esa_softc *sc = device_private(dv); 1673 bus_space_tag_t iot = sc->sc_iot; 1674 bus_space_handle_t ioh = sc->sc_ioh; 1675 int i, index; 1676 1677 index = 0; 1678 1679 mutex_enter(&sc->sc_lock); 1680 mutex_spin_enter(&sc->sc_intr_lock); 1681 1682 bus_space_write_2(iot, ioh, ESA_HOST_INT_CTRL, 0); 1683 bus_space_write_1(iot, ioh, ESA_ASSP_CONTROL_C, 0); 1684 1685 esa_assp_halt(sc); 1686 1687 /* Save ASSP state */ 1688 for (i = ESA_REV_B_CODE_MEMORY_BEGIN; i <= ESA_REV_B_CODE_MEMORY_END; 1689 i++) 1690 sc->savemem[index++] = esa_read_assp(sc, 1691 ESA_MEMTYPE_INTERNAL_CODE, i); 1692 for (i = ESA_REV_B_DATA_MEMORY_BEGIN; i <= ESA_REV_B_DATA_MEMORY_END; 1693 i++) 1694 sc->savemem[index++] = esa_read_assp(sc, 1695 ESA_MEMTYPE_INTERNAL_DATA, i); 1696 1697 mutex_spin_exit(&sc->sc_intr_lock); 1698 mutex_exit(&sc->sc_lock); 1699 1700 return true; 1701 } 1702 1703 static bool 1704 esa_resume(device_t dv, const pmf_qual_t *qual) 1705 { 1706 struct esa_softc *sc = device_private(dv); 1707 bus_space_tag_t iot = sc->sc_iot; 1708 bus_space_handle_t ioh = sc->sc_ioh; 1709 int i, index; 1710 uint8_t reset_state; 1711 pcireg_t data; 1712 1713 index = 0; 1714 1715 delay(10000); 1716 1717 mutex_enter(&sc->sc_lock); 1718 mutex_spin_enter(&sc->sc_intr_lock); 1719 1720 data = pci_conf_read(sc->sc_pct, sc->sc_tag, PCI_LEGACY_AUDIO_CTRL); 1721 pci_conf_write(sc->sc_pct, sc->sc_tag, PCI_LEGACY_AUDIO_CTRL, 1722 data | DISABLE_LEGACY); 1723 1724 bus_space_write_4(iot, ioh, ESA_PCI_ACPI_CONTROL, ESA_PCI_ACPI_D0); 1725 1726 esa_config(sc); 1727 1728 reset_state = esa_assp_halt(sc); 1729 1730 esa_init_codec(sc); 1731 esa_codec_reset(sc); 1732 1733 /* restore ASSP */ 1734 for (i = ESA_REV_B_CODE_MEMORY_BEGIN; i <= ESA_REV_B_CODE_MEMORY_END; 1735 i++) 1736 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_CODE, i, 1737 sc->savemem[index++]); 1738 for (i = ESA_REV_B_DATA_MEMORY_BEGIN; i <= ESA_REV_B_DATA_MEMORY_END; 1739 i++) 1740 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, i, 1741 sc->savemem[index++]); 1742 1743 esa_write_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, ESA_KDATA_DMA_ACTIVE, 0); 1744 bus_space_write_1(iot, ioh, ESA_DSP_PORT_CONTROL_REG_B, 1745 reset_state | ESA_REGB_ENABLE_RESET); 1746 1747 esa_enable_interrupts(sc); 1748 esa_amp_enable(sc); 1749 1750 mutex_spin_exit(&sc->sc_intr_lock); 1751 1752 /* Finally, power up AC97 codec */ 1753 delay(1000); 1754 1755 sc->codec_if->vtbl->restore_ports(sc->codec_if); 1756 1757 mutex_exit(&sc->sc_lock); 1758 1759 return true; 1760 } 1761 1762 static uint32_t 1763 esa_get_pointer(struct esa_softc *sc, struct esa_channel *ch) 1764 { 1765 uint16_t hi, lo; 1766 uint32_t addr; 1767 int data_offset; 1768 1769 data_offset = ch->data_offset; 1770 hi = esa_read_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, data_offset + 1771 ESA_CDATA_HOST_SRC_CURRENTH); 1772 lo = esa_read_assp(sc, ESA_MEMTYPE_INTERNAL_DATA, data_offset + 1773 ESA_CDATA_HOST_SRC_CURRENTL); 1774 1775 addr = lo | ((uint32_t)hi << 16); 1776 return (addr - ch->start); 1777 } 1778 1779 static paddr_t 1780 esa_mappage(void *addr, void *mem, off_t off, int prot) 1781 { 1782 struct esa_voice *vc; 1783 struct esa_softc *sc; 1784 struct esa_dma *p; 1785 1786 vc = addr; 1787 sc = device_private(vc->parent); 1788 if (off < 0) 1789 return -1; 1790 for (p = vc->dma; p && KERNADDR(p) != mem; p = p->next) 1791 continue; 1792 if (p == NULL) 1793 return -1; 1794 return bus_dmamem_mmap(sc->sc_dmat, p->segs, p->nsegs, 1795 off, prot, BUS_DMA_WAITOK); 1796 } 1797 1798 static void 1799 esa_get_locks(void *addr, kmutex_t **intr, kmutex_t **proc) 1800 { 1801 struct esa_voice *vc; 1802 struct esa_softc *sc; 1803 1804 vc = addr; 1805 sc = device_private(vc->parent); 1806 1807 *intr = &sc->sc_intr_lock; 1808 *proc = &sc->sc_lock; 1809 } 1810
Indexes created Tue Sep 23 14:10:03 GMT 2025