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