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