2 * Copyright (c) 2000 Cameron Grant <cg@freebsd.org>
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHERIN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THEPOSSIBILITY OF
26 * $FreeBSD: src/sys/dev/sound/pci/ds1.c,v 1.43.2.1 2006/01/18 01:05:34 ariff Exp $
29 #include <dev/sound/pcm/sound.h>
30 #include <dev/sound/pcm/ac97.h>
32 #include <bus/pci/pcireg.h>
33 #include <bus/pci/pcivar.h>
35 #include <dev/sound/pci/ds1.h>
36 #include <dev/sound/pci/ds1-fw.h>
38 SND_DECLARE_FILE("$DragonFly: src/sys/dev/sound/pci/ds1.c,v 1.11 2008/01/07 09:42:07 swildner Exp $");
40 /* -------------------------------------------------------------------- */
43 #define DS1_RECPRIMARY 0
44 #define DS1_IRQHZ ((48000 << 8) / 256)
45 #define DS1_BUFFSIZE 4096
48 volatile u_int32_t Format;
49 volatile u_int32_t LoopDefault;
50 volatile u_int32_t PgBase;
51 volatile u_int32_t PgLoop;
52 volatile u_int32_t PgLoopEnd;
53 volatile u_int32_t PgLoopFrac;
54 volatile u_int32_t PgDeltaEnd;
55 volatile u_int32_t LpfKEnd;
56 volatile u_int32_t EgGainEnd;
57 volatile u_int32_t LchGainEnd;
58 volatile u_int32_t RchGainEnd;
59 volatile u_int32_t Effect1GainEnd;
60 volatile u_int32_t Effect2GainEnd;
61 volatile u_int32_t Effect3GainEnd;
62 volatile u_int32_t LpfQ;
63 volatile u_int32_t Status;
64 volatile u_int32_t NumOfFrames;
65 volatile u_int32_t LoopCount;
66 volatile u_int32_t PgStart;
67 volatile u_int32_t PgStartFrac;
68 volatile u_int32_t PgDelta;
69 volatile u_int32_t LpfK;
70 volatile u_int32_t EgGain;
71 volatile u_int32_t LchGain;
72 volatile u_int32_t RchGain;
73 volatile u_int32_t Effect1Gain;
74 volatile u_int32_t Effect2Gain;
75 volatile u_int32_t Effect3Gain;
76 volatile u_int32_t LpfD1;
77 volatile u_int32_t LpfD2;
81 volatile u_int32_t PgBase;
82 volatile u_int32_t PgLoopEnd;
83 volatile u_int32_t PgStart;
84 volatile u_int32_t NumOfLoops;
89 /* channel registers */
91 int run, spd, dir, fmt;
92 struct snd_dbuf *buffer;
93 struct pcm_channel *channel;
94 volatile struct pbank *lslot, *rslot;
96 struct sc_info *parent;
100 int run, spd, dir, fmt, num;
101 struct snd_dbuf *buffer;
102 struct pcm_channel *channel;
103 volatile struct rbank *slot;
104 struct sc_info *parent;
107 /* device private data */
111 u_int32_t cd2id, ctrlbase;
114 bus_space_handle_t sh;
115 bus_dma_tag_t buffer_dmat, control_dmat;
118 struct resource *reg, *irq;
124 u_int32_t *pbase, pbankbase, pbanksize;
125 volatile struct pbank *pbank[2 * 64];
126 volatile struct rbank *rbank;
127 int pslotfree, currbank, pchn, rchn;
130 struct sc_pchinfo pch[DS1_CHANS];
131 struct sc_rchinfo rch[2];
135 u_int32_t dev, subdev;
139 {0x00041073, 0, "Yamaha DS-1 (YMF724)", CntrlInst},
140 {0x000d1073, 0, "Yamaha DS-1E (YMF724F)", CntrlInst1E},
141 {0x00051073, 0, "Yamaha DS-1? (YMF734)", CntrlInst},
142 {0x00081073, 0, "Yamaha DS-1? (YMF737)", CntrlInst},
143 {0x00201073, 0, "Yamaha DS-1? (YMF738)", CntrlInst},
144 {0x00061073, 0, "Yamaha DS-1? (YMF738_TEG)", CntrlInst},
145 {0x000a1073, 0x00041073, "Yamaha DS-1 (YMF740)", CntrlInst},
146 {0x000a1073, 0x000a1073, "Yamaha DS-1 (YMF740B)", CntrlInst},
147 {0x000a1073, 0x53328086, "Yamaha DS-1 (YMF740I)", CntrlInst},
148 {0x000a1073, 0, "Yamaha DS-1 (YMF740?)", CntrlInst},
149 {0x000c1073, 0, "Yamaha DS-1E (YMF740C)", CntrlInst1E},
150 {0x00101073, 0, "Yamaha DS-1E (YMF744)", CntrlInst1E},
151 {0x00121073, 0, "Yamaha DS-1E (YMF754)", CntrlInst1E},
155 /* -------------------------------------------------------------------- */
162 static int ds_init(struct sc_info *);
163 static void ds_intr(void *);
165 /* talk to the card */
166 static u_int32_t ds_rd(struct sc_info *, int, int);
167 static void ds_wr(struct sc_info *, int, u_int32_t, int);
169 /* -------------------------------------------------------------------- */
171 static u_int32_t ds_recfmt[] = {
173 AFMT_STEREO | AFMT_U8,
175 AFMT_STEREO | AFMT_S8,
177 AFMT_STEREO | AFMT_S16_LE,
179 AFMT_STEREO | AFMT_U16_LE,
182 static struct pcmchan_caps ds_reccaps = {4000, 48000, ds_recfmt, 0};
184 static u_int32_t ds_playfmt[] = {
186 AFMT_STEREO | AFMT_U8,
188 AFMT_STEREO | AFMT_S16_LE,
191 static struct pcmchan_caps ds_playcaps = {4000, 96000, ds_playfmt, 0};
193 /* -------------------------------------------------------------------- */
196 ds_rd(struct sc_info *sc, int regno, int size)
200 return bus_space_read_1(sc->st, sc->sh, regno);
202 return bus_space_read_2(sc->st, sc->sh, regno);
204 return bus_space_read_4(sc->st, sc->sh, regno);
211 ds_wr(struct sc_info *sc, int regno, u_int32_t data, int size)
215 bus_space_write_1(sc->st, sc->sh, regno, data);
218 bus_space_write_2(sc->st, sc->sh, regno, data);
221 bus_space_write_4(sc->st, sc->sh, regno, data);
227 wrl(struct sc_info *sc, u_int32_t *ptr, u_int32_t val)
229 *(volatile u_int32_t *)ptr = val;
230 bus_space_barrier(sc->st, sc->sh, 0, 0, BUS_SPACE_BARRIER_WRITE);
233 /* -------------------------------------------------------------------- */
236 ds_cdbusy(struct sc_info *sc, int sec)
240 reg = sec? YDSXGR_SECSTATUSADR : YDSXGR_PRISTATUSADR;
241 i = YDSXG_AC97TIMEOUT;
243 if (!(ds_rd(sc, reg, 2) & 0x8000))
251 ds_initcd(kobj_t obj, void *devinfo)
253 struct sc_info *sc = (struct sc_info *)devinfo;
256 x = pci_read_config(sc->dev, PCIR_DSXGCTRL, 1);
258 pci_write_config(sc->dev, PCIR_DSXGCTRL, x & ~0x03, 1);
259 pci_write_config(sc->dev, PCIR_DSXGCTRL, x | 0x03, 1);
260 pci_write_config(sc->dev, PCIR_DSXGCTRL, x & ~0x03, 1);
262 * The YMF740 on some Intel motherboards requires a pretty
263 * hefty delay after this reset for some reason... Otherwise:
264 * "pcm0: ac97 codec init failed"
265 * Maybe this is needed for all YMF740's?
266 * 400ms and 500ms here seem to work, 300ms does not.
268 * do it for all chips -cg
273 return ds_cdbusy(sc, 0)? 0 : 1;
277 ds_rdcd(kobj_t obj, void *devinfo, int regno)
279 struct sc_info *sc = (struct sc_info *)devinfo;
285 cid = sec? (sc->cd2id << 8) : 0;
286 reg = sec? YDSXGR_SECSTATUSDATA : YDSXGR_PRISTATUSDATA;
290 cmd = YDSXG_AC97READCMD | cid | regno;
291 ds_wr(sc, YDSXGR_AC97CMDADR, cmd, 2);
293 if (ds_cdbusy(sc, sec))
296 if (sc->type == 11 && sc->rev < 2)
297 for (i = 0; i < 600; i++)
300 return ds_rd(sc, reg, 2);
304 ds_wrcd(kobj_t obj, void *devinfo, int regno, u_int32_t data)
306 struct sc_info *sc = (struct sc_info *)devinfo;
312 cid = sec? (sc->cd2id << 8) : 0;
316 cmd = YDSXG_AC97WRITECMD | cid | regno;
319 ds_wr(sc, YDSXGR_AC97CMDDATA, cmd, 4);
321 return ds_cdbusy(sc, sec);
324 static kobj_method_t ds_ac97_methods[] = {
325 KOBJMETHOD(ac97_init, ds_initcd),
326 KOBJMETHOD(ac97_read, ds_rdcd),
327 KOBJMETHOD(ac97_write, ds_wrcd),
330 AC97_DECLARE(ds_ac97);
332 /* -------------------------------------------------------------------- */
335 ds_enadsp(struct sc_info *sc, int on)
341 ds_wr(sc, YDSXGR_CONFIG, 0x00000001, 4);
343 if (ds_rd(sc, YDSXGR_CONFIG, 4))
344 ds_wr(sc, YDSXGR_CONFIG, 0x00000000, 4);
345 i = YDSXG_WORKBITTIMEOUT;
347 if (!(ds_rd(sc, YDSXGR_CONFIG, 4) & 0x00000002))
354 static volatile struct pbank *
355 ds_allocpslot(struct sc_info *sc)
359 if (sc->pslotfree > 63)
361 slot = sc->pslotfree++;
362 return sc->pbank[slot * 2];
366 ds_initpbank(volatile struct pbank *pb, int ch, int b16, int stereo, u_int32_t rate, bus_addr_t base, u_int32_t len)
368 u_int32_t lv[] = {1, 1, 0, 0, 0};
369 u_int32_t rv[] = {1, 0, 1, 0, 0};
370 u_int32_t e1[] = {0, 0, 0, 0, 0};
371 u_int32_t e2[] = {1, 0, 0, 1, 0};
372 u_int32_t e3[] = {1, 0, 0, 0, 1};
379 { 100, 0x00570000, 0x35280000},
380 { 2000, 0x06aa0000, 0x34a70000},
381 { 8000, 0x18b20000, 0x32020000},
382 {11025, 0x20930000, 0x31770000},
383 {16000, 0x2b9a0000, 0x31390000},
384 {22050, 0x35a10000, 0x31c90000},
385 {32000, 0x3eaa0000, 0x33d00000},
386 /* {44100, 0x04646000, 0x370a0000},
387 */ {48000, 0x40000000, 0x40000000},
392 delta = (65536 * rate) / 48000;
394 while (i < 7 && speedinfo[i].rate < rate)
397 pb->Format = stereo? 0x00010000 : 0;
398 pb->Format |= b16? 0 : 0x80000000;
399 pb->Format |= (stereo && (ch == 2 || ch == 4))? 0x00000001 : 0;
401 pb->PgBase = base? base : 0;
403 pb->PgLoopEnd = len >> ss;
410 pb->PgDelta = pb->PgDeltaEnd = delta << 12;
411 pb->LpfQ = speedinfo[i].fQ;
412 pb->LpfK = pb->LpfKEnd = speedinfo[i].fK;
413 pb->LpfD1 = pb->LpfD2 = 0;
414 pb->EgGain = pb->EgGainEnd = 0x40000000;
415 pb->LchGain = pb->LchGainEnd = lv[ch] * 0x40000000;
416 pb->RchGain = pb->RchGainEnd = rv[ch] * 0x40000000;
417 pb->Effect1Gain = pb->Effect1GainEnd = e1[ch] * 0x40000000;
418 pb->Effect2Gain = pb->Effect2GainEnd = e2[ch] * 0x40000000;
419 pb->Effect3Gain = pb->Effect3GainEnd = e3[ch] * 0x40000000;
425 ds_enapslot(struct sc_info *sc, int slot, int go)
427 wrl(sc, &sc->pbase[slot + 1], go? (sc->pbankbase + 2 * slot * sc->pbanksize) : 0);
428 /* kprintf("pbase[%d] = 0x%x\n", slot + 1, go? (sc->pbankbase + 2 * slot * sc->pbanksize) : 0); */
432 ds_setuppch(struct sc_pchinfo *ch)
434 int stereo, b16, c, sz;
437 stereo = (ch->fmt & AFMT_STEREO)? 1 : 0;
438 b16 = (ch->fmt & AFMT_16BIT)? 1 : 0;
440 addr = sndbuf_getbufaddr(ch->buffer);
441 sz = sndbuf_getsize(ch->buffer);
443 ds_initpbank(ch->lslot, c, stereo, b16, ch->spd, addr, sz);
444 ds_initpbank(ch->lslot + 1, c, stereo, b16, ch->spd, addr, sz);
445 ds_initpbank(ch->rslot, 2, stereo, b16, ch->spd, addr, sz);
446 ds_initpbank(ch->rslot + 1, 2, stereo, b16, ch->spd, addr, sz);
450 ds_setuprch(struct sc_rchinfo *ch)
452 struct sc_info *sc = ch->parent;
453 int stereo, b16, i, sz, pri;
457 stereo = (ch->fmt & AFMT_STEREO)? 1 : 0;
458 b16 = (ch->fmt & AFMT_16BIT)? 1 : 0;
459 addr = sndbuf_getbufaddr(ch->buffer);
460 sz = sndbuf_getsize(ch->buffer);
461 pri = (ch->num == DS1_RECPRIMARY)? 1 : 0;
463 for (i = 0; i < 2; i++) {
464 ch->slot[i].PgBase = addr;
465 ch->slot[i].PgLoopEnd = sz;
466 ch->slot[i].PgStart = 0;
467 ch->slot[i].NumOfLoops = 0;
469 x = (b16? 0x00 : 0x01) | (stereo? 0x02 : 0x00);
470 y = (48000 * 4096) / ch->spd;
472 /* kprintf("pri = %d, x = %d, y = %d\n", pri, x, y); */
473 ds_wr(sc, pri? YDSXGR_ADCFORMAT : YDSXGR_RECFORMAT, x, 4);
474 ds_wr(sc, pri? YDSXGR_ADCSLOTSR : YDSXGR_RECSLOTSR, y, 4);
477 /* -------------------------------------------------------------------- */
478 /* play channel interface */
480 ds1pchan_init(kobj_t obj, void *devinfo, struct snd_dbuf *b, struct pcm_channel *c, int dir)
482 struct sc_info *sc = devinfo;
483 struct sc_pchinfo *ch;
485 KASSERT(dir == PCMDIR_PLAY, ("ds1pchan_init: bad direction"));
487 ch = &sc->pch[sc->pchn++];
495 if (sndbuf_alloc(ch->buffer, sc->buffer_dmat, sc->bufsz) != 0)
498 ch->lsnum = sc->pslotfree;
499 ch->lslot = ds_allocpslot(sc);
500 ch->rsnum = sc->pslotfree;
501 ch->rslot = ds_allocpslot(sc);
508 ds1pchan_setformat(kobj_t obj, void *data, u_int32_t format)
510 struct sc_pchinfo *ch = data;
518 ds1pchan_setspeed(kobj_t obj, void *data, u_int32_t speed)
520 struct sc_pchinfo *ch = data;
528 ds1pchan_setblocksize(kobj_t obj, void *data, u_int32_t blocksize)
530 struct sc_pchinfo *ch = data;
531 struct sc_info *sc = ch->parent;
534 /* irq rate is fixed at 187.5hz */
535 drate = ch->spd * sndbuf_getbps(ch->buffer);
536 blocksize = roundup2((drate << 8) / DS1_IRQHZ, 4);
537 sndbuf_resize(ch->buffer, sc->bufsz / blocksize, blocksize);
542 /* semantic note: must start at beginning of buffer */
544 ds1pchan_trigger(kobj_t obj, void *data, int go)
546 struct sc_pchinfo *ch = data;
547 struct sc_info *sc = ch->parent;
550 if (go == PCMTRIG_EMLDMAWR || go == PCMTRIG_EMLDMARD)
552 stereo = (ch->fmt & AFMT_STEREO)? 1 : 0;
553 if (go == PCMTRIG_START) {
556 ds_enapslot(sc, ch->lsnum, 1);
557 ds_enapslot(sc, ch->rsnum, stereo);
558 snd_mtxlock(sc->lock);
559 ds_wr(sc, YDSXGR_MODE, 0x00000003, 4);
560 snd_mtxunlock(sc->lock);
563 /* ds_setuppch(ch); */
564 ds_enapslot(sc, ch->lsnum, 0);
565 ds_enapslot(sc, ch->rsnum, 0);
572 ds1pchan_getptr(kobj_t obj, void *data)
574 struct sc_pchinfo *ch = data;
575 struct sc_info *sc = ch->parent;
576 volatile struct pbank *bank;
580 ss = (ch->fmt & AFMT_STEREO)? 1 : 0;
581 ss += (ch->fmt & AFMT_16BIT)? 1 : 0;
583 bank = ch->lslot + sc->currbank;
584 /* kprintf("getptr: %d\n", bank->PgStart << ss); */
590 static struct pcmchan_caps *
591 ds1pchan_getcaps(kobj_t obj, void *data)
596 static kobj_method_t ds1pchan_methods[] = {
597 KOBJMETHOD(channel_init, ds1pchan_init),
598 KOBJMETHOD(channel_setformat, ds1pchan_setformat),
599 KOBJMETHOD(channel_setspeed, ds1pchan_setspeed),
600 KOBJMETHOD(channel_setblocksize, ds1pchan_setblocksize),
601 KOBJMETHOD(channel_trigger, ds1pchan_trigger),
602 KOBJMETHOD(channel_getptr, ds1pchan_getptr),
603 KOBJMETHOD(channel_getcaps, ds1pchan_getcaps),
606 CHANNEL_DECLARE(ds1pchan);
608 /* -------------------------------------------------------------------- */
609 /* record channel interface */
611 ds1rchan_init(kobj_t obj, void *devinfo, struct snd_dbuf *b, struct pcm_channel *c, int dir)
613 struct sc_info *sc = devinfo;
614 struct sc_rchinfo *ch;
616 KASSERT(dir == PCMDIR_REC, ("ds1rchan_init: bad direction"));
618 ch = &sc->rch[sc->rchn];
619 ch->num = sc->rchn++;
626 if (sndbuf_alloc(ch->buffer, sc->buffer_dmat, sc->bufsz) != 0)
629 ch->slot = (ch->num == DS1_RECPRIMARY)? sc->rbank + 2: sc->rbank;
636 ds1rchan_setformat(kobj_t obj, void *data, u_int32_t format)
638 struct sc_rchinfo *ch = data;
646 ds1rchan_setspeed(kobj_t obj, void *data, u_int32_t speed)
648 struct sc_rchinfo *ch = data;
656 ds1rchan_setblocksize(kobj_t obj, void *data, u_int32_t blocksize)
658 struct sc_rchinfo *ch = data;
659 struct sc_info *sc = ch->parent;
662 /* irq rate is fixed at 187.5hz */
663 drate = ch->spd * sndbuf_getbps(ch->buffer);
664 blocksize = roundup2((drate << 8) / DS1_IRQHZ, 4);
665 sndbuf_resize(ch->buffer, sc->bufsz / blocksize, blocksize);
670 /* semantic note: must start at beginning of buffer */
672 ds1rchan_trigger(kobj_t obj, void *data, int go)
674 struct sc_rchinfo *ch = data;
675 struct sc_info *sc = ch->parent;
678 if (go == PCMTRIG_EMLDMAWR || go == PCMTRIG_EMLDMARD)
680 if (go == PCMTRIG_START) {
683 snd_mtxlock(sc->lock);
684 x = ds_rd(sc, YDSXGR_MAPOFREC, 4);
685 x |= (ch->num == DS1_RECPRIMARY)? 0x02 : 0x01;
686 ds_wr(sc, YDSXGR_MAPOFREC, x, 4);
687 ds_wr(sc, YDSXGR_MODE, 0x00000003, 4);
688 snd_mtxunlock(sc->lock);
691 snd_mtxlock(sc->lock);
692 x = ds_rd(sc, YDSXGR_MAPOFREC, 4);
693 x &= ~((ch->num == DS1_RECPRIMARY)? 0x02 : 0x01);
694 ds_wr(sc, YDSXGR_MAPOFREC, x, 4);
695 snd_mtxunlock(sc->lock);
702 ds1rchan_getptr(kobj_t obj, void *data)
704 struct sc_rchinfo *ch = data;
705 struct sc_info *sc = ch->parent;
707 return ch->slot[sc->currbank].PgStart;
710 static struct pcmchan_caps *
711 ds1rchan_getcaps(kobj_t obj, void *data)
716 static kobj_method_t ds1rchan_methods[] = {
717 KOBJMETHOD(channel_init, ds1rchan_init),
718 KOBJMETHOD(channel_setformat, ds1rchan_setformat),
719 KOBJMETHOD(channel_setspeed, ds1rchan_setspeed),
720 KOBJMETHOD(channel_setblocksize, ds1rchan_setblocksize),
721 KOBJMETHOD(channel_trigger, ds1rchan_trigger),
722 KOBJMETHOD(channel_getptr, ds1rchan_getptr),
723 KOBJMETHOD(channel_getcaps, ds1rchan_getcaps),
726 CHANNEL_DECLARE(ds1rchan);
728 /* -------------------------------------------------------------------- */
729 /* The interrupt handler */
733 struct sc_info *sc = (struct sc_info *)p;
736 snd_mtxlock(sc->lock);
737 i = ds_rd(sc, YDSXGR_STATUS, 4);
739 device_printf(sc->dev, "timeout irq\n");
740 if (i & 0x80008000) {
741 ds_wr(sc, YDSXGR_STATUS, i & 0x80008000, 4);
742 sc->currbank = ds_rd(sc, YDSXGR_CTRLSELECT, 4) & 0x00000001;
745 for (i = 0; i < DS1_CHANS; i++) {
746 if (sc->pch[i].run) {
748 snd_mtxunlock(sc->lock);
749 chn_intr(sc->pch[i].channel);
750 snd_mtxlock(sc->lock);
753 for (i = 0; i < 2; i++) {
754 if (sc->rch[i].run) {
756 snd_mtxunlock(sc->lock);
757 chn_intr(sc->rch[i].channel);
758 snd_mtxlock(sc->lock);
761 i = ds_rd(sc, YDSXGR_MODE, 4);
763 ds_wr(sc, YDSXGR_MODE, i | 0x00000002, 4);
766 snd_mtxunlock(sc->lock);
769 /* -------------------------------------------------------------------- */
772 * Probe and attach the card
776 ds_setmap(void *arg, bus_dma_segment_t *segs, int nseg, int error)
778 struct sc_info *sc = arg;
780 sc->ctrlbase = error? 0 : (u_int32_t)segs->ds_addr;
783 kprintf("ds1: setmap (%lx, %lx), nseg=%d, error=%d\n",
784 (unsigned long)segs->ds_addr, (unsigned long)segs->ds_len,
790 ds_init(struct sc_info *sc)
793 u_int32_t *ci, r, pcs, rcs, ecs, ws, memsz, cb;
797 ci = ds_devs[sc->type].mcode;
799 ds_wr(sc, YDSXGR_NATIVEDACOUTVOL, 0x00000000, 4);
801 ds_wr(sc, YDSXGR_MODE, 0x00010000, 4);
802 ds_wr(sc, YDSXGR_MODE, 0x00000000, 4);
803 ds_wr(sc, YDSXGR_MAPOFREC, 0x00000000, 4);
804 ds_wr(sc, YDSXGR_MAPOFEFFECT, 0x00000000, 4);
805 ds_wr(sc, YDSXGR_PLAYCTRLBASE, 0x00000000, 4);
806 ds_wr(sc, YDSXGR_RECCTRLBASE, 0x00000000, 4);
807 ds_wr(sc, YDSXGR_EFFCTRLBASE, 0x00000000, 4);
808 r = ds_rd(sc, YDSXGR_GLOBALCTRL, 2);
809 ds_wr(sc, YDSXGR_GLOBALCTRL, r & ~0x0007, 2);
811 for (i = 0; i < YDSXG_DSPLENGTH; i += 4)
812 ds_wr(sc, YDSXGR_DSPINSTRAM + i, DspInst[i >> 2], 4);
814 for (i = 0; i < YDSXG_CTRLLENGTH; i += 4)
815 ds_wr(sc, YDSXGR_CTRLINSTRAM + i, ci[i >> 2], 4);
820 for (i = 100; i > 0; i--) {
821 pcs = ds_rd(sc, YDSXGR_PLAYCTRLSIZE, 4) << 2;
822 if (pcs == sizeof(struct pbank))
826 if (pcs != sizeof(struct pbank)) {
827 device_printf(sc->dev, "preposterous playctrlsize (%d)\n", pcs);
830 rcs = ds_rd(sc, YDSXGR_RECCTRLSIZE, 4) << 2;
831 ecs = ds_rd(sc, YDSXGR_EFFCTRLSIZE, 4) << 2;
832 ws = ds_rd(sc, YDSXGR_WORKSIZE, 4) << 2;
834 memsz = 64 * 2 * pcs + 2 * 2 * rcs + 5 * 2 * ecs + ws;
835 memsz += (64 + 1) * 4;
837 if (sc->regbase == NULL) {
838 if (bus_dma_tag_create(NULL, 2, 0, BUS_SPACE_MAXADDR_32BIT, BUS_SPACE_MAXADDR,
839 NULL, NULL, memsz, 1, memsz, 0,
842 if (bus_dmamem_alloc(sc->control_dmat, &buf, BUS_DMA_NOWAIT, &sc->map))
844 if (bus_dmamap_load(sc->control_dmat, sc->map, buf, memsz, ds_setmap, sc, 0) || !sc->ctrlbase) {
845 device_printf(sc->dev, "pcs=%d, rcs=%d, ecs=%d, ws=%d, memsz=%d\n",
846 pcs, rcs, ecs, ws, memsz);
855 ds_wr(sc, YDSXGR_WORKBASE, sc->ctrlbase + cb, 4);
857 sc->pbase = (u_int32_t *)(t + cb);
858 /* kprintf("pbase = %p -> 0x%x\n", sc->pbase, sc->ctrlbase + cb); */
859 ds_wr(sc, YDSXGR_PLAYCTRLBASE, sc->ctrlbase + cb, 4);
861 sc->rbank = (struct rbank *)(t + cb);
862 ds_wr(sc, YDSXGR_RECCTRLBASE, sc->ctrlbase + cb, 4);
864 ds_wr(sc, YDSXGR_EFFCTRLBASE, sc->ctrlbase + cb, 4);
867 sc->pbankbase = sc->ctrlbase + cb;
869 for (i = 0; i < 64; i++) {
870 wrl(sc, &sc->pbase[i + 1], 0);
871 sc->pbank[i * 2] = (struct pbank *)(t + cb);
872 /* kprintf("pbank[%d] = %p -> 0x%x; ", i * 2, (struct pbank *)(t + cb), sc->ctrlbase + cb - vtophys(t + cb)); */
874 sc->pbank[i * 2 + 1] = (struct pbank *)(t + cb);
875 /* kprintf("pbank[%d] = %p -> 0x%x\n", i * 2 + 1, (struct pbank *)(t + cb), sc->ctrlbase + cb - vtophys(t + cb)); */
878 wrl(sc, &sc->pbase[0], DS1_CHANS * 2);
880 sc->pchn = sc->rchn = 0;
881 ds_wr(sc, YDSXGR_NATIVEDACOUTVOL, 0x3fff3fff, 4);
882 ds_wr(sc, YDSXGR_NATIVEADCINVOL, 0x3fff3fff, 4);
883 ds_wr(sc, YDSXGR_NATIVEDACINVOL, 0x3fff3fff, 4);
889 ds_uninit(struct sc_info *sc)
891 ds_wr(sc, YDSXGR_NATIVEDACOUTVOL, 0x00000000, 4);
892 ds_wr(sc, YDSXGR_NATIVEADCINVOL, 0, 4);
893 ds_wr(sc, YDSXGR_NATIVEDACINVOL, 0, 4);
895 ds_wr(sc, YDSXGR_MODE, 0x00010000, 4);
896 ds_wr(sc, YDSXGR_MAPOFREC, 0x00000000, 4);
897 ds_wr(sc, YDSXGR_MAPOFEFFECT, 0x00000000, 4);
898 ds_wr(sc, YDSXGR_PLAYCTRLBASE, 0x00000000, 4);
899 ds_wr(sc, YDSXGR_RECCTRLBASE, 0x00000000, 4);
900 ds_wr(sc, YDSXGR_EFFCTRLBASE, 0x00000000, 4);
901 ds_wr(sc, YDSXGR_GLOBALCTRL, 0, 2);
903 bus_dmamap_unload(sc->control_dmat, sc->map);
904 bus_dmamem_free(sc->control_dmat, sc->regbase, sc->map);
910 ds_finddev(u_int32_t dev, u_int32_t subdev)
914 for (i = 0; ds_devs[i].dev; i++) {
915 if (ds_devs[i].dev == dev &&
916 (ds_devs[i].subdev == subdev || ds_devs[i].subdev == 0))
923 ds_pci_probe(device_t dev)
928 subdev = (pci_get_subdevice(dev) << 16) | pci_get_subvendor(dev);
929 i = ds_finddev(pci_get_devid(dev), subdev);
931 device_set_desc(dev, ds_devs[i].name);
932 return BUS_PROBE_DEFAULT;
938 ds_pci_attach(device_t dev)
943 struct ac97_info *codec = NULL;
944 char status[SND_STATUSLEN];
946 sc = kmalloc(sizeof(*sc), M_DEVBUF, M_WAITOK | M_ZERO);
948 sc->lock = snd_mtxcreate(device_get_nameunit(dev), "sound softc");
950 subdev = (pci_get_subdevice(dev) << 16) | pci_get_subvendor(dev);
951 sc->type = ds_finddev(pci_get_devid(dev), subdev);
952 sc->rev = pci_get_revid(dev);
954 data = pci_read_config(dev, PCIR_COMMAND, 2);
955 data |= (PCIM_CMD_PORTEN|PCIM_CMD_MEMEN|PCIM_CMD_BUSMASTEREN);
956 pci_write_config(dev, PCIR_COMMAND, data, 2);
957 data = pci_read_config(dev, PCIR_COMMAND, 2);
959 sc->regid = PCIR_BAR(0);
960 sc->reg = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &sc->regid,
963 device_printf(dev, "unable to map register space\n");
967 sc->st = rman_get_bustag(sc->reg);
968 sc->sh = rman_get_bushandle(sc->reg);
970 sc->bufsz = pcm_getbuffersize(dev, 4096, DS1_BUFFSIZE, 65536);
972 if (bus_dma_tag_create(/*parent*/NULL, /*alignment*/2, /*boundary*/0,
973 /*lowaddr*/BUS_SPACE_MAXADDR_32BIT,
974 /*highaddr*/BUS_SPACE_MAXADDR,
975 /*filter*/NULL, /*filterarg*/NULL,
976 /*maxsize*/sc->bufsz, /*nsegments*/1, /*maxsegz*/0x3ffff,
978 &sc->buffer_dmat) != 0) {
979 device_printf(dev, "unable to create dma tag\n");
984 if (ds_init(sc) == -1) {
985 device_printf(dev, "unable to initialize the card\n");
989 codec = AC97_CREATE(dev, sc, ds_ac97);
993 * Turn on inverted external amplifier sense flags for few
997 case 0x81171033: /* NEC ValueStar (VT550/0) */
998 ac97_setflags(codec, ac97_getflags(codec) | AC97_F_EAPD_INV);
1003 mixer_init(dev, ac97_getmixerclass(), codec);
1006 sc->irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &sc->irqid,
1007 RF_ACTIVE | RF_SHAREABLE);
1008 if (!sc->irq || snd_setup_intr(dev, sc->irq, INTR_MPSAFE, ds_intr, sc, &sc->ih)) {
1009 device_printf(dev, "unable to map interrupt\n");
1013 ksnprintf(status, SND_STATUSLEN, "at memory 0x%lx irq %ld %s",
1014 rman_get_start(sc->reg), rman_get_start(sc->irq),PCM_KLDSTRING(snd_ds1));
1016 if (pcm_register(dev, sc, DS1_CHANS, 2))
1018 for (i = 0; i < DS1_CHANS; i++)
1019 pcm_addchan(dev, PCMDIR_PLAY, &ds1pchan_class, sc);
1020 for (i = 0; i < 2; i++)
1021 pcm_addchan(dev, PCMDIR_REC, &ds1rchan_class, sc);
1022 pcm_setstatus(dev, status);
1028 ac97_destroy(codec);
1030 bus_release_resource(dev, SYS_RES_MEMORY, sc->regid, sc->reg);
1032 bus_teardown_intr(dev, sc->irq, sc->ih);
1034 bus_release_resource(dev, SYS_RES_IRQ, sc->irqid, sc->irq);
1035 if (sc->buffer_dmat)
1036 bus_dma_tag_destroy(sc->buffer_dmat);
1037 if (sc->control_dmat)
1038 bus_dma_tag_destroy(sc->control_dmat);
1040 snd_mtxfree(sc->lock);
1041 kfree(sc, M_DEVBUF);
1046 ds_pci_resume(device_t dev)
1050 sc = pcm_getdevinfo(dev);
1052 if (ds_init(sc) == -1) {
1053 device_printf(dev, "unable to reinitialize the card\n");
1056 if (mixer_reinit(dev) == -1) {
1057 device_printf(dev, "unable to reinitialize the mixer\n");
1064 ds_pci_detach(device_t dev)
1069 r = pcm_unregister(dev);
1073 sc = pcm_getdevinfo(dev);
1075 bus_release_resource(dev, SYS_RES_MEMORY, sc->regid, sc->reg);
1076 bus_teardown_intr(dev, sc->irq, sc->ih);
1077 bus_release_resource(dev, SYS_RES_IRQ, sc->irqid, sc->irq);
1078 bus_dma_tag_destroy(sc->buffer_dmat);
1079 bus_dma_tag_destroy(sc->control_dmat);
1080 snd_mtxfree(sc->lock);
1081 kfree(sc, M_DEVBUF);
1085 static device_method_t ds1_methods[] = {
1086 /* Device interface */
1087 DEVMETHOD(device_probe, ds_pci_probe),
1088 DEVMETHOD(device_attach, ds_pci_attach),
1089 DEVMETHOD(device_detach, ds_pci_detach),
1090 DEVMETHOD(device_resume, ds_pci_resume),
1094 static driver_t ds1_driver = {
1100 DRIVER_MODULE(snd_ds1, pci, ds1_driver, pcm_devclass, NULL, NULL);
1101 MODULE_DEPEND(snd_ds1, sound, SOUND_MINVER, SOUND_PREFVER, SOUND_MAXVER);
1102 MODULE_VERSION(snd_ds1, 1);