1fd1aaeccSCameron Grant /* 2fd1aaeccSCameron Grant * Copyright (c) 1999 Cameron Grant <gandalf@vilnya.demon.co.uk> 3fd1aaeccSCameron Grant * 4fd1aaeccSCameron Grant * Redistribution and use in source and binary forms, with or without 5fd1aaeccSCameron Grant * modification, are permitted provided that the following conditions 6fd1aaeccSCameron Grant * are met: 7fd1aaeccSCameron Grant * 1. Redistributions of source code must retain the above copyright 8fd1aaeccSCameron Grant * notice, this list of conditions and the following disclaimer. 9fd1aaeccSCameron Grant * 2. Redistributions in binary form must reproduce the above copyright 10fd1aaeccSCameron Grant * notice, this list of conditions and the following disclaimer in the 11fd1aaeccSCameron Grant * documentation and/or other materials provided with the distribution. 12fd1aaeccSCameron Grant * 13fd1aaeccSCameron Grant * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 14fd1aaeccSCameron Grant * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 15fd1aaeccSCameron Grant * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 16fd1aaeccSCameron Grant * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 17fd1aaeccSCameron Grant * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 18fd1aaeccSCameron Grant * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 19fd1aaeccSCameron Grant * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 20fd1aaeccSCameron Grant * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 21fd1aaeccSCameron Grant * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 22fd1aaeccSCameron Grant * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 23fd1aaeccSCameron Grant * SUCH DAMAGE. 24fd1aaeccSCameron Grant * 25fd1aaeccSCameron Grant * $FreeBSD$ 26fd1aaeccSCameron Grant */ 27fd1aaeccSCameron Grant 28fd1aaeccSCameron Grant #include <dev/sound/pcm/sound.h> 29fd1aaeccSCameron Grant 30fd1aaeccSCameron Grant #include <pci/pcireg.h> 31fd1aaeccSCameron Grant #include <pci/pcivar.h> 32fd1aaeccSCameron Grant 33fd1aaeccSCameron Grant #include <dev/sound/isa/sb.h> 34fd1aaeccSCameron Grant #include <dev/sound/chip.h> 35fd1aaeccSCameron Grant 36fd1aaeccSCameron Grant #define ESS_BUFFSIZE (4096) 37fd1aaeccSCameron Grant #define ABS(x) (((x) < 0)? -(x) : (x)) 38fd1aaeccSCameron Grant 39fd1aaeccSCameron Grant /* audio2 never generates irqs and sounds very noisy */ 40fd1aaeccSCameron Grant #undef ESS18XX_DUPLEX 41fd1aaeccSCameron Grant 42fd1aaeccSCameron Grant /* more accurate clocks and split audio1/audio2 rates */ 43fd1aaeccSCameron Grant #define ESS18XX_NEWSPEED 44fd1aaeccSCameron Grant 45fd1aaeccSCameron Grant /* channel interface for ESS */ 46fd1aaeccSCameron Grant static void *esschan_init(void *devinfo, snd_dbuf *b, pcm_channel *c, int dir); 47fd1aaeccSCameron Grant static int esschan_setdir(void *data, int dir); 48fd1aaeccSCameron Grant static int esschan_setformat(void *data, u_int32_t format); 49fd1aaeccSCameron Grant static int esschan_setspeed(void *data, u_int32_t speed); 50fd1aaeccSCameron Grant static int esschan_setblocksize(void *data, u_int32_t blocksize); 51fd1aaeccSCameron Grant static int esschan_trigger(void *data, int go); 52fd1aaeccSCameron Grant static int esschan_getptr(void *data); 53fd1aaeccSCameron Grant static pcmchan_caps *esschan_getcaps(void *data); 54fd1aaeccSCameron Grant 55fd1aaeccSCameron Grant static pcmchan_caps ess_playcaps = { 56fd1aaeccSCameron Grant 5000, 49000, 57fd1aaeccSCameron Grant AFMT_STEREO | AFMT_U8 | AFMT_S8 | AFMT_U16_LE | AFMT_S16_LE, 58fd1aaeccSCameron Grant AFMT_STEREO | AFMT_S16_LE 59fd1aaeccSCameron Grant }; 60fd1aaeccSCameron Grant 61fd1aaeccSCameron Grant static pcmchan_caps ess_reccaps = { 62fd1aaeccSCameron Grant 5000, 49000, 63fd1aaeccSCameron Grant AFMT_STEREO | AFMT_U8 | AFMT_S8 | AFMT_U16_LE | AFMT_S16_LE, 64fd1aaeccSCameron Grant AFMT_STEREO | AFMT_S16_LE 65fd1aaeccSCameron Grant }; 66fd1aaeccSCameron Grant 67fd1aaeccSCameron Grant static pcm_channel ess_chantemplate = { 68fd1aaeccSCameron Grant esschan_init, 69fd1aaeccSCameron Grant esschan_setdir, 70fd1aaeccSCameron Grant esschan_setformat, 71fd1aaeccSCameron Grant esschan_setspeed, 72fd1aaeccSCameron Grant esschan_setblocksize, 73fd1aaeccSCameron Grant esschan_trigger, 74fd1aaeccSCameron Grant esschan_getptr, 75fd1aaeccSCameron Grant esschan_getcaps, 76fd1aaeccSCameron Grant }; 77fd1aaeccSCameron Grant 78fd1aaeccSCameron Grant struct ess_info; 79fd1aaeccSCameron Grant 80fd1aaeccSCameron Grant struct ess_chinfo { 81fd1aaeccSCameron Grant struct ess_info *parent; 82fd1aaeccSCameron Grant pcm_channel *channel; 83fd1aaeccSCameron Grant snd_dbuf *buffer; 84fd1aaeccSCameron Grant int dir, hwch, stopping; 85fd1aaeccSCameron Grant u_int32_t fmt, spd; 86fd1aaeccSCameron Grant }; 87fd1aaeccSCameron Grant 88fd1aaeccSCameron Grant struct ess_info { 89fd1aaeccSCameron Grant struct resource *io, *sb, *vc, *mpu, *gp; /* I/O address for the board */ 90fd1aaeccSCameron Grant struct resource *irq; 91fd1aaeccSCameron Grant bus_dma_tag_t parent_dmat; 92fd1aaeccSCameron Grant 93fd1aaeccSCameron Grant int type, duplex:1, newspeed:1, dmasz[2]; 94fd1aaeccSCameron Grant struct ess_chinfo pch, rch; 95fd1aaeccSCameron Grant }; 96fd1aaeccSCameron Grant 97fd1aaeccSCameron Grant static int ess_rd(struct ess_info *sc, int reg); 98fd1aaeccSCameron Grant static void ess_wr(struct ess_info *sc, int reg, u_int8_t val); 99fd1aaeccSCameron Grant static int ess_dspready(struct ess_info *sc); 100fd1aaeccSCameron Grant static int ess_cmd(struct ess_info *sc, u_char val); 101fd1aaeccSCameron Grant static int ess_cmd1(struct ess_info *sc, u_char cmd, int val); 102fd1aaeccSCameron Grant static int ess_get_byte(struct ess_info *sc); 103fd1aaeccSCameron Grant static void ess_setmixer(struct ess_info *sc, u_int port, u_int value); 104fd1aaeccSCameron Grant static int ess_getmixer(struct ess_info *sc, u_int port); 105fd1aaeccSCameron Grant static int ess_reset_dsp(struct ess_info *sc); 106fd1aaeccSCameron Grant 107fd1aaeccSCameron Grant static int ess_write(struct ess_info *sc, u_char reg, int val); 108fd1aaeccSCameron Grant static int ess_read(struct ess_info *sc, u_char reg); 109fd1aaeccSCameron Grant 110fd1aaeccSCameron Grant static void ess_intr(void *arg); 111fd1aaeccSCameron Grant static int ess_setupch(struct ess_info *sc, int ch, int dir, int spd, u_int32_t fmt, int len); 112fd1aaeccSCameron Grant static int ess_start(struct ess_chinfo *ch); 113fd1aaeccSCameron Grant static int ess_stop(struct ess_chinfo *ch); 114fd1aaeccSCameron Grant 115fd1aaeccSCameron Grant static int ess_dmasetup(struct ess_info *sc, int ch, u_int32_t base, u_int16_t cnt, int dir); 116fd1aaeccSCameron Grant static int ess_dmapos(struct ess_info *sc, int ch); 117fd1aaeccSCameron Grant static int ess_dmatrigger(struct ess_info *sc, int ch, int go); 118fd1aaeccSCameron Grant 119fd1aaeccSCameron Grant static int essmix_init(snd_mixer *m); 120fd1aaeccSCameron Grant static int essmix_set(snd_mixer *m, unsigned dev, unsigned left, unsigned right); 121fd1aaeccSCameron Grant static int essmix_setrecsrc(snd_mixer *m, u_int32_t src); 122fd1aaeccSCameron Grant 123fd1aaeccSCameron Grant static snd_mixer ess_mixer = { 124fd1aaeccSCameron Grant "ESS mixer", 125fd1aaeccSCameron Grant essmix_init, 126fd1aaeccSCameron Grant essmix_set, 127fd1aaeccSCameron Grant essmix_setrecsrc, 128fd1aaeccSCameron Grant }; 129fd1aaeccSCameron Grant 130fd1aaeccSCameron Grant static devclass_t pcm_devclass; 131fd1aaeccSCameron Grant 132fd1aaeccSCameron Grant /* 133fd1aaeccSCameron Grant * Common code for the midi and pcm functions 134fd1aaeccSCameron Grant * 135fd1aaeccSCameron Grant * ess_cmd write a single byte to the CMD port. 136fd1aaeccSCameron Grant * ess_cmd1 write a CMD + 1 byte arg 137fd1aaeccSCameron Grant * ess_cmd2 write a CMD + 2 byte arg 138fd1aaeccSCameron Grant * ess_get_byte returns a single byte from the DSP data port 139fd1aaeccSCameron Grant * 140fd1aaeccSCameron Grant * ess_write is actually ess_cmd1 141fd1aaeccSCameron Grant * ess_read access ext. regs via ess_cmd(0xc0, reg) followed by ess_get_byte 142fd1aaeccSCameron Grant */ 143fd1aaeccSCameron Grant 144fd1aaeccSCameron Grant static int 145fd1aaeccSCameron Grant port_rd(struct resource *port, int regno, int size) 146fd1aaeccSCameron Grant { 147fd1aaeccSCameron Grant bus_space_tag_t st = rman_get_bustag(port); 148fd1aaeccSCameron Grant bus_space_handle_t sh = rman_get_bushandle(port); 149fd1aaeccSCameron Grant 150fd1aaeccSCameron Grant switch (size) { 151fd1aaeccSCameron Grant case 1: 152fd1aaeccSCameron Grant return bus_space_read_1(st, sh, regno); 153fd1aaeccSCameron Grant case 2: 154fd1aaeccSCameron Grant return bus_space_read_2(st, sh, regno); 155fd1aaeccSCameron Grant case 4: 156fd1aaeccSCameron Grant return bus_space_read_4(st, sh, regno); 157fd1aaeccSCameron Grant default: 158fd1aaeccSCameron Grant return 0xffffffff; 159fd1aaeccSCameron Grant } 160fd1aaeccSCameron Grant } 161fd1aaeccSCameron Grant 162fd1aaeccSCameron Grant static void 163fd1aaeccSCameron Grant port_wr(struct resource *port, int regno, u_int32_t data, int size) 164fd1aaeccSCameron Grant { 165fd1aaeccSCameron Grant bus_space_tag_t st = rman_get_bustag(port); 166fd1aaeccSCameron Grant bus_space_handle_t sh = rman_get_bushandle(port); 167fd1aaeccSCameron Grant 168fd1aaeccSCameron Grant switch (size) { 169fd1aaeccSCameron Grant case 1: 170fd1aaeccSCameron Grant bus_space_write_1(st, sh, regno, data); 171fd1aaeccSCameron Grant break; 172fd1aaeccSCameron Grant case 2: 173fd1aaeccSCameron Grant bus_space_write_2(st, sh, regno, data); 174fd1aaeccSCameron Grant break; 175fd1aaeccSCameron Grant case 4: 176fd1aaeccSCameron Grant bus_space_write_4(st, sh, regno, data); 177fd1aaeccSCameron Grant break; 178fd1aaeccSCameron Grant } 179fd1aaeccSCameron Grant } 180fd1aaeccSCameron Grant 181fd1aaeccSCameron Grant static int 182fd1aaeccSCameron Grant ess_rd(struct ess_info *sc, int reg) 183fd1aaeccSCameron Grant { 184fd1aaeccSCameron Grant return port_rd(sc->sb, reg, 1); 185fd1aaeccSCameron Grant } 186fd1aaeccSCameron Grant 187fd1aaeccSCameron Grant static void 188fd1aaeccSCameron Grant ess_wr(struct ess_info *sc, int reg, u_int8_t val) 189fd1aaeccSCameron Grant { 190fd1aaeccSCameron Grant port_wr(sc->sb, reg, val, 1); 191fd1aaeccSCameron Grant } 192fd1aaeccSCameron Grant 193fd1aaeccSCameron Grant static int 194fd1aaeccSCameron Grant ess_dspready(struct ess_info *sc) 195fd1aaeccSCameron Grant { 196fd1aaeccSCameron Grant return ((ess_rd(sc, SBDSP_STATUS) & 0x80) == 0); 197fd1aaeccSCameron Grant } 198fd1aaeccSCameron Grant 199fd1aaeccSCameron Grant static int 200fd1aaeccSCameron Grant ess_dspwr(struct ess_info *sc, u_char val) 201fd1aaeccSCameron Grant { 202fd1aaeccSCameron Grant int i; 203fd1aaeccSCameron Grant 204fd1aaeccSCameron Grant for (i = 0; i < 1000; i++) { 205fd1aaeccSCameron Grant if (ess_dspready(sc)) { 206fd1aaeccSCameron Grant ess_wr(sc, SBDSP_CMD, val); 207fd1aaeccSCameron Grant return 1; 208fd1aaeccSCameron Grant } 209fd1aaeccSCameron Grant if (i > 10) DELAY((i > 100)? 1000 : 10); 210fd1aaeccSCameron Grant } 211fd1aaeccSCameron Grant printf("ess_dspwr(0x%02x) timed out.\n", val); 212fd1aaeccSCameron Grant return 0; 213fd1aaeccSCameron Grant } 214fd1aaeccSCameron Grant 215fd1aaeccSCameron Grant static int 216fd1aaeccSCameron Grant ess_cmd(struct ess_info *sc, u_char val) 217fd1aaeccSCameron Grant { 218fd1aaeccSCameron Grant #if 0 219fd1aaeccSCameron Grant printf("ess_cmd: %x\n", val); 220fd1aaeccSCameron Grant #endif 221fd1aaeccSCameron Grant return ess_dspwr(sc, val); 222fd1aaeccSCameron Grant } 223fd1aaeccSCameron Grant 224fd1aaeccSCameron Grant static int 225fd1aaeccSCameron Grant ess_cmd1(struct ess_info *sc, u_char cmd, int val) 226fd1aaeccSCameron Grant { 227fd1aaeccSCameron Grant #if 0 228fd1aaeccSCameron Grant printf("ess_cmd1: %x, %x\n", cmd, val); 229fd1aaeccSCameron Grant #endif 230fd1aaeccSCameron Grant if (ess_dspwr(sc, cmd)) { 231fd1aaeccSCameron Grant return ess_dspwr(sc, val & 0xff); 232fd1aaeccSCameron Grant } else return 0; 233fd1aaeccSCameron Grant } 234fd1aaeccSCameron Grant 235fd1aaeccSCameron Grant static void 236fd1aaeccSCameron Grant ess_setmixer(struct ess_info *sc, u_int port, u_int value) 237fd1aaeccSCameron Grant { 238fd1aaeccSCameron Grant u_long flags; 239fd1aaeccSCameron Grant 240fd1aaeccSCameron Grant DEB(printf("ess_setmixer: reg=%x, val=%x\n", port, value);) 241fd1aaeccSCameron Grant flags = spltty(); 242fd1aaeccSCameron Grant ess_wr(sc, SB_MIX_ADDR, (u_char) (port & 0xff)); /* Select register */ 243fd1aaeccSCameron Grant DELAY(10); 244fd1aaeccSCameron Grant ess_wr(sc, SB_MIX_DATA, (u_char) (value & 0xff)); 245fd1aaeccSCameron Grant DELAY(10); 246fd1aaeccSCameron Grant splx(flags); 247fd1aaeccSCameron Grant } 248fd1aaeccSCameron Grant 249fd1aaeccSCameron Grant static int 250fd1aaeccSCameron Grant ess_getmixer(struct ess_info *sc, u_int port) 251fd1aaeccSCameron Grant { 252fd1aaeccSCameron Grant int val; 253fd1aaeccSCameron Grant u_long flags; 254fd1aaeccSCameron Grant 255fd1aaeccSCameron Grant flags = spltty(); 256fd1aaeccSCameron Grant ess_wr(sc, SB_MIX_ADDR, (u_char) (port & 0xff)); /* Select register */ 257fd1aaeccSCameron Grant DELAY(10); 258fd1aaeccSCameron Grant val = ess_rd(sc, SB_MIX_DATA); 259fd1aaeccSCameron Grant DELAY(10); 260fd1aaeccSCameron Grant splx(flags); 261fd1aaeccSCameron Grant 262fd1aaeccSCameron Grant return val; 263fd1aaeccSCameron Grant } 264fd1aaeccSCameron Grant 265fd1aaeccSCameron Grant static int 266fd1aaeccSCameron Grant ess_get_byte(struct ess_info *sc) 267fd1aaeccSCameron Grant { 268fd1aaeccSCameron Grant int i; 269fd1aaeccSCameron Grant 270fd1aaeccSCameron Grant for (i = 1000; i > 0; i--) { 271fd1aaeccSCameron Grant if (ess_rd(sc, DSP_DATA_AVAIL) & 0x80) 272fd1aaeccSCameron Grant return ess_rd(sc, DSP_READ); 273fd1aaeccSCameron Grant else 274fd1aaeccSCameron Grant DELAY(20); 275fd1aaeccSCameron Grant } 276fd1aaeccSCameron Grant return -1; 277fd1aaeccSCameron Grant } 278fd1aaeccSCameron Grant 279fd1aaeccSCameron Grant static int 280fd1aaeccSCameron Grant ess_write(struct ess_info *sc, u_char reg, int val) 281fd1aaeccSCameron Grant { 282fd1aaeccSCameron Grant return ess_cmd1(sc, reg, val); 283fd1aaeccSCameron Grant } 284fd1aaeccSCameron Grant 285fd1aaeccSCameron Grant static int 286fd1aaeccSCameron Grant ess_read(struct ess_info *sc, u_char reg) 287fd1aaeccSCameron Grant { 288fd1aaeccSCameron Grant return (ess_cmd(sc, 0xc0) && ess_cmd(sc, reg))? ess_get_byte(sc) : -1; 289fd1aaeccSCameron Grant } 290fd1aaeccSCameron Grant 291fd1aaeccSCameron Grant static int 292fd1aaeccSCameron Grant ess_reset_dsp(struct ess_info *sc) 293fd1aaeccSCameron Grant { 294fd1aaeccSCameron Grant ess_wr(sc, SBDSP_RST, 3); 295fd1aaeccSCameron Grant DELAY(100); 296fd1aaeccSCameron Grant ess_wr(sc, SBDSP_RST, 0); 297fd1aaeccSCameron Grant if (ess_get_byte(sc) != 0xAA) { 298fd1aaeccSCameron Grant DEB(printf("ess_reset_dsp 0x%lx failed\n", 299fd1aaeccSCameron Grant rman_get_start(d->io_base))); 300fd1aaeccSCameron Grant return ENXIO; /* Sorry */ 301fd1aaeccSCameron Grant } 302fd1aaeccSCameron Grant ess_cmd(sc, 0xc6); 303fd1aaeccSCameron Grant return 0; 304fd1aaeccSCameron Grant } 305fd1aaeccSCameron Grant 306fd1aaeccSCameron Grant static void 307fd1aaeccSCameron Grant ess_intr(void *arg) 308fd1aaeccSCameron Grant { 309fd1aaeccSCameron Grant struct ess_info *sc = (struct ess_info *)arg; 310fd1aaeccSCameron Grant int src, pirq, rirq; 311fd1aaeccSCameron Grant 312fd1aaeccSCameron Grant src = 0; 313fd1aaeccSCameron Grant if (ess_getmixer(sc, 0x7a) & 0x80) 314fd1aaeccSCameron Grant src |= 2; 315fd1aaeccSCameron Grant if (ess_rd(sc, 0x0c) & 0x01) 316fd1aaeccSCameron Grant src |= 1; 317fd1aaeccSCameron Grant 318fd1aaeccSCameron Grant pirq = (src & sc->pch.hwch)? 1 : 0; 319fd1aaeccSCameron Grant rirq = (src & sc->rch.hwch)? 1 : 0; 320fd1aaeccSCameron Grant 321fd1aaeccSCameron Grant if (pirq) { 322fd1aaeccSCameron Grant if (sc->pch.stopping) { 323fd1aaeccSCameron Grant ess_dmatrigger(sc, sc->pch.hwch, 0); 324fd1aaeccSCameron Grant sc->pch.stopping = 0; 325fd1aaeccSCameron Grant if (sc->pch.hwch == 1) 326fd1aaeccSCameron Grant ess_write(sc, 0xb8, ess_read(sc, 0xb8) & ~0x01); 327fd1aaeccSCameron Grant else 328fd1aaeccSCameron Grant ess_setmixer(sc, 0x78, ess_getmixer(sc, 0x78) & ~0x03); 329fd1aaeccSCameron Grant } 330fd1aaeccSCameron Grant chn_intr(sc->pch.channel); 331fd1aaeccSCameron Grant } 332fd1aaeccSCameron Grant 333fd1aaeccSCameron Grant if (rirq) { 334fd1aaeccSCameron Grant if (sc->rch.stopping) { 335fd1aaeccSCameron Grant ess_dmatrigger(sc, sc->rch.hwch, 0); 336fd1aaeccSCameron Grant sc->rch.stopping = 0; 337fd1aaeccSCameron Grant /* XXX: will this stop audio2? */ 338fd1aaeccSCameron Grant ess_write(sc, 0xb8, ess_read(sc, 0xb8) & ~0x01); 339fd1aaeccSCameron Grant } 340fd1aaeccSCameron Grant chn_intr(sc->rch.channel); 341fd1aaeccSCameron Grant } 342fd1aaeccSCameron Grant 343fd1aaeccSCameron Grant if (src & 2) 344fd1aaeccSCameron Grant ess_setmixer(sc, 0x7a, ess_getmixer(sc, 0x7a) & ~0x80); 345fd1aaeccSCameron Grant if (src & 1) 346fd1aaeccSCameron Grant ess_rd(sc, DSP_DATA_AVAIL); 347fd1aaeccSCameron Grant } 348fd1aaeccSCameron Grant 349fd1aaeccSCameron Grant /* utility functions for ESS */ 350fd1aaeccSCameron Grant static u_int8_t 351fd1aaeccSCameron Grant ess_calcspeed8(int *spd) 352fd1aaeccSCameron Grant { 353fd1aaeccSCameron Grant int speed = *spd; 354fd1aaeccSCameron Grant u_int32_t t; 355fd1aaeccSCameron Grant 356fd1aaeccSCameron Grant if (speed > 22000) { 357fd1aaeccSCameron Grant t = (795500 + speed / 2) / speed; 358fd1aaeccSCameron Grant speed = (795500 + t / 2) / t; 359fd1aaeccSCameron Grant t = (256 - t) | 0x80; 360fd1aaeccSCameron Grant } else { 361fd1aaeccSCameron Grant t = (397700 + speed / 2) / speed; 362fd1aaeccSCameron Grant speed = (397700 + t / 2) / t; 363fd1aaeccSCameron Grant t = 128 - t; 364fd1aaeccSCameron Grant } 365fd1aaeccSCameron Grant *spd = speed; 366fd1aaeccSCameron Grant return t & 0x000000ff; 367fd1aaeccSCameron Grant } 368fd1aaeccSCameron Grant 369fd1aaeccSCameron Grant static u_int8_t 370fd1aaeccSCameron Grant ess_calcspeed9(int *spd) 371fd1aaeccSCameron Grant { 372fd1aaeccSCameron Grant int speed, s0, s1, use0; 373fd1aaeccSCameron Grant u_int8_t t0, t1; 374fd1aaeccSCameron Grant 375fd1aaeccSCameron Grant /* rate = source / (256 - divisor) */ 376fd1aaeccSCameron Grant /* divisor = 256 - (source / rate) */ 377fd1aaeccSCameron Grant speed = *spd; 378fd1aaeccSCameron Grant t0 = 128 - (793800 / speed); 379fd1aaeccSCameron Grant s0 = 793800 / (128 - t0); 380fd1aaeccSCameron Grant 381fd1aaeccSCameron Grant t1 = 128 - (768000 / speed); 382fd1aaeccSCameron Grant s1 = 768000 / (128 - t1); 383fd1aaeccSCameron Grant t1 |= 0x80; 384fd1aaeccSCameron Grant 385fd1aaeccSCameron Grant use0 = (ABS(speed - s0) < ABS(speed - s1))? 1 : 0; 386fd1aaeccSCameron Grant 387fd1aaeccSCameron Grant *spd = use0? s0 : s1; 388fd1aaeccSCameron Grant return use0? t0 : t1; 389fd1aaeccSCameron Grant } 390fd1aaeccSCameron Grant 391fd1aaeccSCameron Grant static u_int8_t 392fd1aaeccSCameron Grant ess_calcfilter(int spd) 393fd1aaeccSCameron Grant { 394fd1aaeccSCameron Grant int cutoff; 395fd1aaeccSCameron Grant 396fd1aaeccSCameron Grant /* cutoff = 7160000 / (256 - divisor) */ 397fd1aaeccSCameron Grant /* divisor = 256 - (7160000 / cutoff) */ 398fd1aaeccSCameron Grant cutoff = (spd * 9 * 82) / 20; 399fd1aaeccSCameron Grant return (256 - (7160000 / cutoff)); 400fd1aaeccSCameron Grant } 401fd1aaeccSCameron Grant 402fd1aaeccSCameron Grant static int 403fd1aaeccSCameron Grant ess_setupch(struct ess_info *sc, int ch, int dir, int spd, u_int32_t fmt, int len) 404fd1aaeccSCameron Grant { 405fd1aaeccSCameron Grant int play = (dir == PCMDIR_PLAY)? 1 : 0; 406fd1aaeccSCameron Grant int b16 = (fmt & AFMT_16BIT)? 1 : 0; 407fd1aaeccSCameron Grant int stereo = (fmt & AFMT_STEREO)? 1 : 0; 408fd1aaeccSCameron Grant int unsign = (fmt == AFMT_U8 || fmt == AFMT_U16_LE)? 1 : 0; 409fd1aaeccSCameron Grant u_int8_t spdval, fmtval; 410fd1aaeccSCameron Grant 411fd1aaeccSCameron Grant 412fd1aaeccSCameron Grant spdval = (sc->newspeed)? ess_calcspeed9(&spd) : ess_calcspeed8(&spd); 413fd1aaeccSCameron Grant 414fd1aaeccSCameron Grant if (ch == 1) { 415fd1aaeccSCameron Grant KASSERT((dir == PCMDIR_PLAY) || (dir == PCMDIR_REC), ("ess_setupch: dir1 bad")); 416fd1aaeccSCameron Grant len = -len; 417fd1aaeccSCameron Grant /* transfer length low */ 418fd1aaeccSCameron Grant ess_write(sc, 0xa4, len & 0x00ff); 419fd1aaeccSCameron Grant /* transfer length high */ 420fd1aaeccSCameron Grant ess_write(sc, 0xa5, (len & 0xff00) >> 8); 421fd1aaeccSCameron Grant /* autoinit, dma dir */ 422fd1aaeccSCameron Grant ess_write(sc, 0xb8, 0x04 | (play? 0x00 : 0x0a)); 423fd1aaeccSCameron Grant /* mono/stereo */ 424fd1aaeccSCameron Grant ess_write(sc, 0xa8, (ess_read(sc, 0xa8) & ~0x03) | (stereo? 0x01 : 0x02)); 425fd1aaeccSCameron Grant /* demand mode, 4 bytes/xfer */ 426fd1aaeccSCameron Grant ess_write(sc, 0xb9, 0x02); 427fd1aaeccSCameron Grant /* sample rate */ 428fd1aaeccSCameron Grant ess_write(sc, 0xa1, spdval); 429fd1aaeccSCameron Grant /* filter cutoff */ 430fd1aaeccSCameron Grant ess_write(sc, 0xa2, ess_calcfilter(spd)); 431fd1aaeccSCameron Grant /* setup dac/adc */ 432fd1aaeccSCameron Grant /* 433fd1aaeccSCameron Grant if (play) 434fd1aaeccSCameron Grant ess_write(sc, 0xb6, unsign? 0x80 : 0x00); 435fd1aaeccSCameron Grant */ 436fd1aaeccSCameron Grant /* mono, b16: signed, load signal */ 437fd1aaeccSCameron Grant /* 438fd1aaeccSCameron Grant ess_write(sc, 0xb7, 0x51 | (unsign? 0x00 : 0x20)); 439fd1aaeccSCameron Grant */ 440fd1aaeccSCameron Grant /* setup fifo */ 441fd1aaeccSCameron Grant ess_write(sc, 0xb7, 0x91 | (unsign? 0x00 : 0x20) | 442fd1aaeccSCameron Grant (b16? 0x04 : 0x00) | 443fd1aaeccSCameron Grant (stereo? 0x08 : 0x40)); 444fd1aaeccSCameron Grant /* irq control */ 445fd1aaeccSCameron Grant ess_write(sc, 0xb1, (ess_read(sc, 0xb1) & 0x0f) | 0x50); 446fd1aaeccSCameron Grant /* drq control */ 447fd1aaeccSCameron Grant ess_write(sc, 0xb2, (ess_read(sc, 0xb2) & 0x0f) | 0x50); 448fd1aaeccSCameron Grant } else if (ch == 2) { 449fd1aaeccSCameron Grant KASSERT(dir == PCMDIR_PLAY, ("ess_setupch: dir2 bad")); 450fd1aaeccSCameron Grant len >>= 1; 451fd1aaeccSCameron Grant len = -len; 452fd1aaeccSCameron Grant /* transfer length low */ 453fd1aaeccSCameron Grant ess_setmixer(sc, 0x74, len & 0x00ff); 454fd1aaeccSCameron Grant /* transfer length high */ 455fd1aaeccSCameron Grant ess_setmixer(sc, 0x76, (len & 0xff00) >> 8); 456fd1aaeccSCameron Grant /* autoinit, 4 bytes/req */ 457fd1aaeccSCameron Grant ess_setmixer(sc, 0x78, 0x10); 458fd1aaeccSCameron Grant fmtval = b16 | (stereo << 1) | (unsign << 2); 459fd1aaeccSCameron Grant /* enable irq, set format */ 460fd1aaeccSCameron Grant ess_setmixer(sc, 0x7a, 0x40 | fmtval); 461fd1aaeccSCameron Grant if (sc->newspeed) { 462fd1aaeccSCameron Grant /* sample rate */ 463fd1aaeccSCameron Grant ess_setmixer(sc, 0x70, spdval); 464fd1aaeccSCameron Grant /* filter cutoff */ 465fd1aaeccSCameron Grant ess_setmixer(sc, 0x72, ess_calcfilter(spd)); 466fd1aaeccSCameron Grant } 467fd1aaeccSCameron Grant 468fd1aaeccSCameron Grant } 469fd1aaeccSCameron Grant return 0; 470fd1aaeccSCameron Grant } 471fd1aaeccSCameron Grant static int 472fd1aaeccSCameron Grant ess_start(struct ess_chinfo *ch) 473fd1aaeccSCameron Grant { 474fd1aaeccSCameron Grant struct ess_info *sc = ch->parent; 475fd1aaeccSCameron Grant 476fd1aaeccSCameron Grant ess_setupch(sc, ch->hwch, ch->dir, ch->spd, ch->fmt, ch->buffer->dl); 477fd1aaeccSCameron Grant ch->stopping = 0; 478fd1aaeccSCameron Grant if (ch->hwch == 1) 479fd1aaeccSCameron Grant ess_write(sc, 0xb8, ess_read(sc, 0xb8) | 0x01); 480fd1aaeccSCameron Grant else 481fd1aaeccSCameron Grant ess_setmixer(sc, 0x78, ess_getmixer(sc, 0x78) | 0x03); 482fd1aaeccSCameron Grant return 0; 483fd1aaeccSCameron Grant } 484fd1aaeccSCameron Grant 485fd1aaeccSCameron Grant static int 486fd1aaeccSCameron Grant ess_stop(struct ess_chinfo *ch) 487fd1aaeccSCameron Grant { 488fd1aaeccSCameron Grant struct ess_info *sc = ch->parent; 489fd1aaeccSCameron Grant 490fd1aaeccSCameron Grant ch->stopping = 1; 491fd1aaeccSCameron Grant if (ch->hwch == 1) 492fd1aaeccSCameron Grant ess_write(sc, 0xb8, ess_read(sc, 0xb8) & ~0x04); 493fd1aaeccSCameron Grant else 494fd1aaeccSCameron Grant ess_setmixer(sc, 0x78, ess_getmixer(sc, 0x78) & ~0x10); 495fd1aaeccSCameron Grant return 0; 496fd1aaeccSCameron Grant } 497fd1aaeccSCameron Grant 498fd1aaeccSCameron Grant /* channel interface for ESS18xx */ 499fd1aaeccSCameron Grant static void * 500fd1aaeccSCameron Grant esschan_init(void *devinfo, snd_dbuf *b, pcm_channel *c, int dir) 501fd1aaeccSCameron Grant { 502fd1aaeccSCameron Grant struct ess_info *sc = devinfo; 503fd1aaeccSCameron Grant struct ess_chinfo *ch = (dir == PCMDIR_PLAY)? &sc->pch : &sc->rch; 504fd1aaeccSCameron Grant 505fd1aaeccSCameron Grant ch->parent = sc; 506fd1aaeccSCameron Grant ch->channel = c; 507fd1aaeccSCameron Grant ch->buffer = b; 508fd1aaeccSCameron Grant ch->buffer->bufsize = ESS_BUFFSIZE; 509fd1aaeccSCameron Grant if (chn_allocbuf(ch->buffer, sc->parent_dmat) == -1) 510fd1aaeccSCameron Grant return NULL; 511fd1aaeccSCameron Grant ch->hwch = 1; 512fd1aaeccSCameron Grant if ((dir == PCMDIR_PLAY) && (sc->duplex)) 513fd1aaeccSCameron Grant ch->hwch = 2; 514fd1aaeccSCameron Grant return ch; 515fd1aaeccSCameron Grant } 516fd1aaeccSCameron Grant 517fd1aaeccSCameron Grant static int 518fd1aaeccSCameron Grant esschan_setdir(void *data, int dir) 519fd1aaeccSCameron Grant { 520fd1aaeccSCameron Grant struct ess_chinfo *ch = data; 521fd1aaeccSCameron Grant 522fd1aaeccSCameron Grant ch->dir = dir; 523fd1aaeccSCameron Grant return 0; 524fd1aaeccSCameron Grant } 525fd1aaeccSCameron Grant 526fd1aaeccSCameron Grant static int 527fd1aaeccSCameron Grant esschan_setformat(void *data, u_int32_t format) 528fd1aaeccSCameron Grant { 529fd1aaeccSCameron Grant struct ess_chinfo *ch = data; 530fd1aaeccSCameron Grant 531fd1aaeccSCameron Grant ch->fmt = format; 532fd1aaeccSCameron Grant return 0; 533fd1aaeccSCameron Grant } 534fd1aaeccSCameron Grant 535fd1aaeccSCameron Grant static int 536fd1aaeccSCameron Grant esschan_setspeed(void *data, u_int32_t speed) 537fd1aaeccSCameron Grant { 538fd1aaeccSCameron Grant struct ess_chinfo *ch = data; 539fd1aaeccSCameron Grant struct ess_info *sc = ch->parent; 540fd1aaeccSCameron Grant 541fd1aaeccSCameron Grant ch->spd = speed; 542fd1aaeccSCameron Grant if (sc->newspeed) 543fd1aaeccSCameron Grant ess_calcspeed9(&ch->spd); 544fd1aaeccSCameron Grant else 545fd1aaeccSCameron Grant ess_calcspeed8(&ch->spd); 546fd1aaeccSCameron Grant return ch->spd; 547fd1aaeccSCameron Grant } 548fd1aaeccSCameron Grant 549fd1aaeccSCameron Grant static int 550fd1aaeccSCameron Grant esschan_setblocksize(void *data, u_int32_t blocksize) 551fd1aaeccSCameron Grant { 552fd1aaeccSCameron Grant return blocksize; 553fd1aaeccSCameron Grant } 554fd1aaeccSCameron Grant 555fd1aaeccSCameron Grant static int 556fd1aaeccSCameron Grant esschan_trigger(void *data, int go) 557fd1aaeccSCameron Grant { 558fd1aaeccSCameron Grant struct ess_chinfo *ch = data; 559fd1aaeccSCameron Grant struct ess_info *sc = ch->parent; 560fd1aaeccSCameron Grant 561fd1aaeccSCameron Grant if (go == PCMTRIG_EMLDMAWR || go == PCMTRIG_EMLDMARD) 562fd1aaeccSCameron Grant return 0; 563fd1aaeccSCameron Grant 564fd1aaeccSCameron Grant switch (go) { 565fd1aaeccSCameron Grant case PCMTRIG_START: 566fd1aaeccSCameron Grant ess_dmasetup(sc, ch->hwch, vtophys(ch->buffer->buf), ch->buffer->bufsize, ch->dir); 567fd1aaeccSCameron Grant ess_dmatrigger(sc, ch->hwch, 1); 568fd1aaeccSCameron Grant ess_start(ch); 569fd1aaeccSCameron Grant break; 570fd1aaeccSCameron Grant 571fd1aaeccSCameron Grant case PCMTRIG_STOP: 572fd1aaeccSCameron Grant case PCMTRIG_ABORT: 573fd1aaeccSCameron Grant default: 574fd1aaeccSCameron Grant ess_stop(ch); 575fd1aaeccSCameron Grant break; 576fd1aaeccSCameron Grant } 577fd1aaeccSCameron Grant return 0; 578fd1aaeccSCameron Grant } 579fd1aaeccSCameron Grant 580fd1aaeccSCameron Grant static int 581fd1aaeccSCameron Grant esschan_getptr(void *data) 582fd1aaeccSCameron Grant { 583fd1aaeccSCameron Grant struct ess_chinfo *ch = data; 584fd1aaeccSCameron Grant struct ess_info *sc = ch->parent; 585fd1aaeccSCameron Grant 586fd1aaeccSCameron Grant return ess_dmapos(sc, ch->hwch); 587fd1aaeccSCameron Grant } 588fd1aaeccSCameron Grant 589fd1aaeccSCameron Grant static pcmchan_caps * 590fd1aaeccSCameron Grant esschan_getcaps(void *data) 591fd1aaeccSCameron Grant { 592fd1aaeccSCameron Grant struct ess_chinfo *ch = data; 593fd1aaeccSCameron Grant 594fd1aaeccSCameron Grant return (ch->dir == PCMDIR_PLAY)? &ess_playcaps : &ess_reccaps; 595fd1aaeccSCameron Grant } 596fd1aaeccSCameron Grant 597fd1aaeccSCameron Grant /************************************************************/ 598fd1aaeccSCameron Grant 599fd1aaeccSCameron Grant static int 600fd1aaeccSCameron Grant essmix_init(snd_mixer *m) 601fd1aaeccSCameron Grant { 602fd1aaeccSCameron Grant struct ess_info *sc = mix_getdevinfo(m); 603fd1aaeccSCameron Grant 604fd1aaeccSCameron Grant mix_setrecdevs(m, SOUND_MASK_CD | SOUND_MASK_MIC | SOUND_MASK_LINE | 605fd1aaeccSCameron Grant SOUND_MASK_IMIX); 606fd1aaeccSCameron Grant 607fd1aaeccSCameron Grant mix_setdevs(m, SOUND_MASK_SYNTH | SOUND_MASK_PCM | SOUND_MASK_LINE | 608fd1aaeccSCameron Grant SOUND_MASK_MIC | SOUND_MASK_CD | SOUND_MASK_VOLUME | 609fd1aaeccSCameron Grant SOUND_MASK_LINE1); 610fd1aaeccSCameron Grant 611fd1aaeccSCameron Grant ess_setmixer(sc, 0, 0); /* reset */ 612fd1aaeccSCameron Grant 613fd1aaeccSCameron Grant return 0; 614fd1aaeccSCameron Grant } 615fd1aaeccSCameron Grant 616fd1aaeccSCameron Grant static int 617fd1aaeccSCameron Grant essmix_set(snd_mixer *m, unsigned dev, unsigned left, unsigned right) 618fd1aaeccSCameron Grant { 619fd1aaeccSCameron Grant struct ess_info *sc = mix_getdevinfo(m); 620fd1aaeccSCameron Grant int preg = 0, rreg = 0, l, r; 621fd1aaeccSCameron Grant 622fd1aaeccSCameron Grant l = (left * 15) / 100; 623fd1aaeccSCameron Grant r = (right * 15) / 100; 624fd1aaeccSCameron Grant switch (dev) { 625fd1aaeccSCameron Grant case SOUND_MIXER_SYNTH: 626fd1aaeccSCameron Grant preg = 0x36; 627fd1aaeccSCameron Grant rreg = 0x6b; 628fd1aaeccSCameron Grant break; 629fd1aaeccSCameron Grant 630fd1aaeccSCameron Grant case SOUND_MIXER_PCM: 631fd1aaeccSCameron Grant preg = 0x14; 632fd1aaeccSCameron Grant rreg = 0x7c; 633fd1aaeccSCameron Grant break; 634fd1aaeccSCameron Grant 635fd1aaeccSCameron Grant case SOUND_MIXER_LINE: 636fd1aaeccSCameron Grant preg = 0x3e; 637fd1aaeccSCameron Grant rreg = 0x6e; 638fd1aaeccSCameron Grant break; 639fd1aaeccSCameron Grant 640fd1aaeccSCameron Grant case SOUND_MIXER_MIC: 641fd1aaeccSCameron Grant preg = 0x1a; 642fd1aaeccSCameron Grant rreg = 0x68; 643fd1aaeccSCameron Grant break; 644fd1aaeccSCameron Grant 645fd1aaeccSCameron Grant case SOUND_MIXER_LINE1: 646fd1aaeccSCameron Grant preg = 0x3a; 647fd1aaeccSCameron Grant rreg = 0x6c; 648fd1aaeccSCameron Grant break; 649fd1aaeccSCameron Grant 650fd1aaeccSCameron Grant case SOUND_MIXER_CD: 651fd1aaeccSCameron Grant preg = 0x38; 652fd1aaeccSCameron Grant rreg = 0x6a; 653fd1aaeccSCameron Grant break; 654fd1aaeccSCameron Grant 655fd1aaeccSCameron Grant case SOUND_MIXER_VOLUME: 656fd1aaeccSCameron Grant l = left? (left * 63) / 100 : 64; 657fd1aaeccSCameron Grant r = right? (right * 63) / 100 : 64; 658fd1aaeccSCameron Grant ess_setmixer(sc, 0x60, l); 659fd1aaeccSCameron Grant ess_setmixer(sc, 0x62, r); 660fd1aaeccSCameron Grant left = (l == 64)? 0 : (l * 100) / 63; 661fd1aaeccSCameron Grant right = (r == 64)? 0 : (r * 100) / 63; 662fd1aaeccSCameron Grant return left | (right << 8); 663fd1aaeccSCameron Grant } 664fd1aaeccSCameron Grant 665fd1aaeccSCameron Grant if (preg) 666fd1aaeccSCameron Grant ess_setmixer(sc, preg, (l << 4) | r); 667fd1aaeccSCameron Grant if (rreg) 668fd1aaeccSCameron Grant ess_setmixer(sc, rreg, (l << 4) | r); 669fd1aaeccSCameron Grant 670fd1aaeccSCameron Grant left = (l * 100) / 15; 671fd1aaeccSCameron Grant right = (r * 100) / 15; 672fd1aaeccSCameron Grant 673fd1aaeccSCameron Grant return left | (right << 8); 674fd1aaeccSCameron Grant } 675fd1aaeccSCameron Grant 676fd1aaeccSCameron Grant static int 677fd1aaeccSCameron Grant essmix_setrecsrc(snd_mixer *m, u_int32_t src) 678fd1aaeccSCameron Grant { 679fd1aaeccSCameron Grant struct ess_info *sc = mix_getdevinfo(m); 680fd1aaeccSCameron Grant u_char recdev; 681fd1aaeccSCameron Grant 682fd1aaeccSCameron Grant switch (src) { 683fd1aaeccSCameron Grant case SOUND_MASK_CD: 684fd1aaeccSCameron Grant recdev = 0x02; 685fd1aaeccSCameron Grant break; 686fd1aaeccSCameron Grant 687fd1aaeccSCameron Grant case SOUND_MASK_LINE: 688fd1aaeccSCameron Grant recdev = 0x06; 689fd1aaeccSCameron Grant break; 690fd1aaeccSCameron Grant 691fd1aaeccSCameron Grant case SOUND_MASK_IMIX: 692fd1aaeccSCameron Grant recdev = 0x05; 693fd1aaeccSCameron Grant break; 694fd1aaeccSCameron Grant 695fd1aaeccSCameron Grant case SOUND_MASK_MIC: 696fd1aaeccSCameron Grant default: 697fd1aaeccSCameron Grant recdev = 0x00; 698fd1aaeccSCameron Grant src = SOUND_MASK_MIC; 699fd1aaeccSCameron Grant break; 700fd1aaeccSCameron Grant } 701fd1aaeccSCameron Grant 702fd1aaeccSCameron Grant ess_setmixer(sc, 0x1c, recdev); 703fd1aaeccSCameron Grant 704fd1aaeccSCameron Grant return src; 705fd1aaeccSCameron Grant } 706fd1aaeccSCameron Grant 707fd1aaeccSCameron Grant /************************************************************/ 708fd1aaeccSCameron Grant 709fd1aaeccSCameron Grant static int 710fd1aaeccSCameron Grant ess_dmasetup(struct ess_info *sc, int ch, u_int32_t base, u_int16_t cnt, int dir) 711fd1aaeccSCameron Grant { 712fd1aaeccSCameron Grant KASSERT(ch == 1 || ch == 2, ("bad ch")); 713fd1aaeccSCameron Grant sc->dmasz[ch - 1] = cnt; 714fd1aaeccSCameron Grant if (ch == 1) { 715fd1aaeccSCameron Grant port_wr(sc->vc, 0x8, 0x50 | (dir == PCMDIR_PLAY)? 0x04 : 0x02, 1); /* command */ 716fd1aaeccSCameron Grant port_wr(sc->vc, 0xd, 0xff, 1); /* reset */ 717fd1aaeccSCameron Grant port_wr(sc->vc, 0xf, 0x01, 1); /* mask */ 718fd1aaeccSCameron Grant port_wr(sc->vc, 0x0, base, 4); 719fd1aaeccSCameron Grant port_wr(sc->vc, 0x4, cnt, 2); 720fd1aaeccSCameron Grant 721fd1aaeccSCameron Grant } else if (ch == 2) { 722fd1aaeccSCameron Grant port_wr(sc->io, 0x6, 0x08, 1); /* autoinit */ 723fd1aaeccSCameron Grant port_wr(sc->io, 0x0, base, 4); 724fd1aaeccSCameron Grant port_wr(sc->io, 0x4, cnt, 2); 725fd1aaeccSCameron Grant } 726fd1aaeccSCameron Grant return 0; 727fd1aaeccSCameron Grant } 728fd1aaeccSCameron Grant 729fd1aaeccSCameron Grant static int 730fd1aaeccSCameron Grant ess_dmapos(struct ess_info *sc, int ch) 731fd1aaeccSCameron Grant { 732fd1aaeccSCameron Grant int p = 0; 733fd1aaeccSCameron Grant 734fd1aaeccSCameron Grant KASSERT(ch == 1 || ch == 2, ("bad ch")); 735fd1aaeccSCameron Grant if (ch == 1) 736fd1aaeccSCameron Grant p = port_rd(sc->vc, 0x4, 2) + 1; 737fd1aaeccSCameron Grant else if (ch == 2) 738fd1aaeccSCameron Grant p = port_rd(sc->io, 0x4, 2); 739fd1aaeccSCameron Grant return sc->dmasz[ch - 1] - p; 740fd1aaeccSCameron Grant } 741fd1aaeccSCameron Grant 742fd1aaeccSCameron Grant static int 743fd1aaeccSCameron Grant ess_dmatrigger(struct ess_info *sc, int ch, int go) 744fd1aaeccSCameron Grant { 745fd1aaeccSCameron Grant KASSERT(ch == 1 || ch == 2, ("bad ch")); 746fd1aaeccSCameron Grant if (ch == 1) 747fd1aaeccSCameron Grant port_wr(sc->vc, 0xf, go? 0x01 : 0x00, 1); /* mask */ 748fd1aaeccSCameron Grant else if (ch == 2) 749fd1aaeccSCameron Grant port_wr(sc->io, 0x6, 0x08 | (go? 0x02 : 0x00), 1); /* autoinit */ 750fd1aaeccSCameron Grant return 0; 751fd1aaeccSCameron Grant } 752fd1aaeccSCameron Grant 753fd1aaeccSCameron Grant static void 754fd1aaeccSCameron Grant ess_release_resources(struct ess_info *sc, device_t dev) 755fd1aaeccSCameron Grant { 756fd1aaeccSCameron Grant /* should we bus_teardown_intr here? */ 757fd1aaeccSCameron Grant if (sc->irq) { 758fd1aaeccSCameron Grant bus_release_resource(dev, SYS_RES_IRQ, 0, sc->irq); 759fd1aaeccSCameron Grant sc->irq = 0; 760fd1aaeccSCameron Grant } 761fd1aaeccSCameron Grant if (sc->io) { 762fd1aaeccSCameron Grant bus_release_resource(dev, SYS_RES_IOPORT, 0 * 4 + PCIR_MAPS, sc->io); 763fd1aaeccSCameron Grant sc->io = 0; 764fd1aaeccSCameron Grant } 765fd1aaeccSCameron Grant 766fd1aaeccSCameron Grant if (sc->sb) { 767fd1aaeccSCameron Grant bus_release_resource(dev, SYS_RES_IOPORT, 1 * 4 + PCIR_MAPS, sc->sb); 768fd1aaeccSCameron Grant sc->sb = 0; 769fd1aaeccSCameron Grant } 770fd1aaeccSCameron Grant 771fd1aaeccSCameron Grant if (sc->vc) { 772fd1aaeccSCameron Grant bus_release_resource(dev, SYS_RES_IOPORT, 2 * 4 + PCIR_MAPS, sc->vc); 773fd1aaeccSCameron Grant sc->vc = 0; 774fd1aaeccSCameron Grant } 775fd1aaeccSCameron Grant 776fd1aaeccSCameron Grant if (sc->mpu) { 777fd1aaeccSCameron Grant bus_release_resource(dev, SYS_RES_IOPORT, 3 * 4 + PCIR_MAPS, sc->mpu); 778fd1aaeccSCameron Grant sc->mpu = 0; 779fd1aaeccSCameron Grant } 780fd1aaeccSCameron Grant 781fd1aaeccSCameron Grant if (sc->gp) { 782fd1aaeccSCameron Grant bus_release_resource(dev, SYS_RES_IOPORT, 4 * 4 + PCIR_MAPS, sc->gp); 783fd1aaeccSCameron Grant sc->gp = 0; 784fd1aaeccSCameron Grant } 785fd1aaeccSCameron Grant 786fd1aaeccSCameron Grant free(sc, M_DEVBUF); 787fd1aaeccSCameron Grant } 788fd1aaeccSCameron Grant 789fd1aaeccSCameron Grant static int 790fd1aaeccSCameron Grant ess_alloc_resources(struct ess_info *sc, device_t dev) 791fd1aaeccSCameron Grant { 792fd1aaeccSCameron Grant int rid; 793fd1aaeccSCameron Grant 794fd1aaeccSCameron Grant rid = 0 * 4 + PCIR_MAPS; 795fd1aaeccSCameron Grant sc->io = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid, 0, ~0, 1, RF_ACTIVE); 796fd1aaeccSCameron Grant 797fd1aaeccSCameron Grant rid = 1 * 4 + PCIR_MAPS; 798fd1aaeccSCameron Grant sc->sb = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid, 0, ~0, 1, RF_ACTIVE); 799fd1aaeccSCameron Grant 800fd1aaeccSCameron Grant rid = 2 * 4 + PCIR_MAPS; 801fd1aaeccSCameron Grant sc->vc = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid, 0, ~0, 1, RF_ACTIVE); 802fd1aaeccSCameron Grant 803fd1aaeccSCameron Grant rid = 3 * 4 + PCIR_MAPS; 804fd1aaeccSCameron Grant sc->mpu = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid, 0, ~0, 1, RF_ACTIVE); 805fd1aaeccSCameron Grant 806fd1aaeccSCameron Grant rid = 4 * 4 + PCIR_MAPS; 807fd1aaeccSCameron Grant sc->gp = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid, 0, ~0, 1, RF_ACTIVE); 808fd1aaeccSCameron Grant 809fd1aaeccSCameron Grant rid = 0; 810fd1aaeccSCameron Grant sc->irq = bus_alloc_resource(dev, SYS_RES_IRQ, &rid, 0, ~0, 1, RF_ACTIVE | RF_SHAREABLE); 811fd1aaeccSCameron Grant 812fd1aaeccSCameron Grant return (sc->irq && sc->io && sc->sb && sc->vc && sc->mpu && sc->gp)? 0 : ENXIO; 813fd1aaeccSCameron Grant } 814fd1aaeccSCameron Grant 815fd1aaeccSCameron Grant static int 816fd1aaeccSCameron Grant ess_probe(device_t dev) 817fd1aaeccSCameron Grant { 818fd1aaeccSCameron Grant char *s = NULL; 819fd1aaeccSCameron Grant u_int32_t subdev; 820fd1aaeccSCameron Grant 821fd1aaeccSCameron Grant subdev = (pci_get_subdevice(dev) << 16) | pci_get_subvendor(dev); 822fd1aaeccSCameron Grant switch (pci_get_devid(dev)) { 823fd1aaeccSCameron Grant case 0x1969125d: 824fd1aaeccSCameron Grant if (subdev == 0x8888125d) 825fd1aaeccSCameron Grant s = "ESS Solo-1E"; 826fd1aaeccSCameron Grant else if (subdev == 0x1818125d) 827fd1aaeccSCameron Grant s = "ESS Solo-1"; 828fd1aaeccSCameron Grant else 829fd1aaeccSCameron Grant s = "ESS Solo-1 (unknown vendor)"; 830fd1aaeccSCameron Grant break; 831fd1aaeccSCameron Grant } 832fd1aaeccSCameron Grant 833fd1aaeccSCameron Grant if (s) 834fd1aaeccSCameron Grant device_set_desc(dev, s); 835fd1aaeccSCameron Grant return s? 0 : ENXIO; 836fd1aaeccSCameron Grant } 837fd1aaeccSCameron Grant 838fd1aaeccSCameron Grant #define PCI_LEGACYCONTROL 0x40 839fd1aaeccSCameron Grant #define PCI_CONFIG 0x50 840fd1aaeccSCameron Grant #define PCI_DDMACONTROL 0x60 841fd1aaeccSCameron Grant 842fd1aaeccSCameron Grant static int 843fd1aaeccSCameron Grant ess_attach(device_t dev) 844fd1aaeccSCameron Grant { 845fd1aaeccSCameron Grant snddev_info *d = device_get_softc(dev); 846fd1aaeccSCameron Grant struct ess_info *sc; 847fd1aaeccSCameron Grant void *ih; 848fd1aaeccSCameron Grant char status[SND_STATUSLEN]; 849fd1aaeccSCameron Grant u_int16_t ddma; 850fd1aaeccSCameron Grant u_int32_t data; 851fd1aaeccSCameron Grant 852fd1aaeccSCameron Grant sc = (struct ess_info *)malloc(sizeof *sc, M_DEVBUF, M_NOWAIT); 853fd1aaeccSCameron Grant if (!sc) 854fd1aaeccSCameron Grant return ENXIO; 855fd1aaeccSCameron Grant bzero(sc, sizeof *sc); 856fd1aaeccSCameron Grant 857fd1aaeccSCameron Grant data = pci_read_config(dev, PCIR_COMMAND, 2); 858fd1aaeccSCameron Grant data |= PCIM_CMD_PORTEN | PCIM_CMD_BUSMASTEREN; 859fd1aaeccSCameron Grant pci_write_config(dev, PCIR_COMMAND, data, 2); 860fd1aaeccSCameron Grant data = pci_read_config(dev, PCIR_COMMAND, 2); 861fd1aaeccSCameron Grant 862fd1aaeccSCameron Grant if (ess_alloc_resources(sc, dev)) 863fd1aaeccSCameron Grant goto no; 864fd1aaeccSCameron Grant 865fd1aaeccSCameron Grant ddma = rman_get_start(sc->vc) | 1; 866fd1aaeccSCameron Grant pci_write_config(dev, PCI_LEGACYCONTROL, 0x805f, 2); 867fd1aaeccSCameron Grant pci_write_config(dev, PCI_DDMACONTROL, ddma, 2); 868fd1aaeccSCameron Grant pci_write_config(dev, PCI_CONFIG, 0, 2); 869fd1aaeccSCameron Grant 870fd1aaeccSCameron Grant if (ess_reset_dsp(sc)) 871fd1aaeccSCameron Grant goto no; 872fd1aaeccSCameron Grant mixer_init(d, &ess_mixer, sc); 873fd1aaeccSCameron Grant 874fd1aaeccSCameron Grant port_wr(sc->io, 0x7, 0xb0, 1); /* enable irqs */ 875fd1aaeccSCameron Grant sc->duplex = 1; 876fd1aaeccSCameron Grant sc->newspeed = 1; 877fd1aaeccSCameron Grant 878fd1aaeccSCameron Grant if (sc->newspeed) 879fd1aaeccSCameron Grant ess_setmixer(sc, 0x71, 0x2a); 880fd1aaeccSCameron Grant 881fd1aaeccSCameron Grant bus_setup_intr(dev, sc->irq, INTR_TYPE_TTY, ess_intr, sc, &ih); 882fd1aaeccSCameron Grant if (!sc->duplex) 883fd1aaeccSCameron Grant pcm_setflags(dev, pcm_getflags(dev) | SD_F_SIMPLEX); 884fd1aaeccSCameron Grant 885fd1aaeccSCameron Grant if (bus_dma_tag_create(/*parent*/NULL, /*alignment*/2, /*boundary*/0, 886fd1aaeccSCameron Grant /*lowaddr*/BUS_SPACE_MAXADDR_24BIT, 887fd1aaeccSCameron Grant /*highaddr*/BUS_SPACE_MAXADDR, 888fd1aaeccSCameron Grant /*filter*/NULL, /*filterarg*/NULL, 889fd1aaeccSCameron Grant /*maxsize*/ESS_BUFFSIZE, /*nsegments*/1, 890fd1aaeccSCameron Grant /*maxsegz*/0x3ffff, 891fd1aaeccSCameron Grant /*flags*/0, &sc->parent_dmat) != 0) { 892fd1aaeccSCameron Grant device_printf(dev, "unable to create dma tag\n"); 893fd1aaeccSCameron Grant goto no; 894fd1aaeccSCameron Grant } 895fd1aaeccSCameron Grant 896fd1aaeccSCameron Grant snprintf(status, SND_STATUSLEN, "at io 0x%lx,0x%lx,0x%lx irq %ld", 897fd1aaeccSCameron Grant rman_get_start(sc->io), rman_get_start(sc->sb), rman_get_start(sc->vc), 898fd1aaeccSCameron Grant rman_get_start(sc->irq)); 899fd1aaeccSCameron Grant 900fd1aaeccSCameron Grant if (pcm_register(dev, sc, 1, 1)) 901fd1aaeccSCameron Grant goto no; 902fd1aaeccSCameron Grant pcm_addchan(dev, PCMDIR_REC, &ess_chantemplate, sc); 903fd1aaeccSCameron Grant pcm_addchan(dev, PCMDIR_PLAY, &ess_chantemplate, sc); 904fd1aaeccSCameron Grant pcm_setstatus(dev, status); 905fd1aaeccSCameron Grant 906fd1aaeccSCameron Grant return 0; 907fd1aaeccSCameron Grant 908fd1aaeccSCameron Grant no: 909fd1aaeccSCameron Grant ess_release_resources(sc, dev); 910fd1aaeccSCameron Grant return ENXIO; 911fd1aaeccSCameron Grant } 912fd1aaeccSCameron Grant 913fd1aaeccSCameron Grant static device_method_t ess_methods[] = { 914fd1aaeccSCameron Grant /* Device interface */ 915fd1aaeccSCameron Grant DEVMETHOD(device_probe, ess_probe), 916fd1aaeccSCameron Grant DEVMETHOD(device_attach, ess_attach), 917fd1aaeccSCameron Grant 918fd1aaeccSCameron Grant { 0, 0 } 919fd1aaeccSCameron Grant }; 920fd1aaeccSCameron Grant 921fd1aaeccSCameron Grant static driver_t ess_driver = { 922fd1aaeccSCameron Grant "pcm", 923fd1aaeccSCameron Grant ess_methods, 924fd1aaeccSCameron Grant sizeof(snddev_info), 925fd1aaeccSCameron Grant }; 926fd1aaeccSCameron Grant 927fd1aaeccSCameron Grant DRIVER_MODULE(snd_solo, pci, ess_driver, pcm_devclass, 0, 0); 928fd1aaeccSCameron Grant MODULE_DEPEND(snd_solo, snd_pcm, PCM_MINVER, PCM_PREFVER, PCM_MAXVER); 929fd1aaeccSCameron Grant MODULE_VERSION(snd_solo, 1); 930fd1aaeccSCameron Grant 931fd1aaeccSCameron Grant 932fd1aaeccSCameron Grant 933