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 $
27 * $DragonFly: src/sys/dev/sound/pci/ds1.c,v 1.11 2008/01/07 09:42:07 swildner Exp $
30 #include <dev/sound/pcm/sound.h>
31 #include <dev/sound/pcm/ac97.h>
33 #include <bus/pci/pcireg.h>
34 #include <bus/pci/pcivar.h>
36 #include <dev/sound/pci/ds1.h>
37 #include <dev/sound/pci/ds1-fw.h>
39 SND_DECLARE_FILE("$DragonFly: src/sys/dev/sound/pci/ds1.c,v 1.11 2008/01/07 09:42:07 swildner Exp $");
41 /* -------------------------------------------------------------------- */
44 #define DS1_RECPRIMARY 0
45 #define DS1_IRQHZ ((48000 << 8) / 256)
46 #define DS1_BUFFSIZE 4096
49 volatile u_int32_t Format;
50 volatile u_int32_t LoopDefault;
51 volatile u_int32_t PgBase;
52 volatile u_int32_t PgLoop;
53 volatile u_int32_t PgLoopEnd;
54 volatile u_int32_t PgLoopFrac;
55 volatile u_int32_t PgDeltaEnd;
56 volatile u_int32_t LpfKEnd;
57 volatile u_int32_t EgGainEnd;
58 volatile u_int32_t LchGainEnd;
59 volatile u_int32_t RchGainEnd;
60 volatile u_int32_t Effect1GainEnd;
61 volatile u_int32_t Effect2GainEnd;
62 volatile u_int32_t Effect3GainEnd;
63 volatile u_int32_t LpfQ;
64 volatile u_int32_t Status;
65 volatile u_int32_t NumOfFrames;
66 volatile u_int32_t LoopCount;
67 volatile u_int32_t PgStart;
68 volatile u_int32_t PgStartFrac;
69 volatile u_int32_t PgDelta;
70 volatile u_int32_t LpfK;
71 volatile u_int32_t EgGain;
72 volatile u_int32_t LchGain;
73 volatile u_int32_t RchGain;
74 volatile u_int32_t Effect1Gain;
75 volatile u_int32_t Effect2Gain;
76 volatile u_int32_t Effect3Gain;
77 volatile u_int32_t LpfD1;
78 volatile u_int32_t LpfD2;
82 volatile u_int32_t PgBase;
83 volatile u_int32_t PgLoopEnd;
84 volatile u_int32_t PgStart;
85 volatile u_int32_t NumOfLoops;
90 /* channel registers */
92 int run, spd, dir, fmt;
93 struct snd_dbuf *buffer;
94 struct pcm_channel *channel;
95 volatile struct pbank *lslot, *rslot;
97 struct sc_info *parent;
101 int run, spd, dir, fmt, num;
102 struct snd_dbuf *buffer;
103 struct pcm_channel *channel;
104 volatile struct rbank *slot;
105 struct sc_info *parent;
108 /* device private data */
112 u_int32_t cd2id, ctrlbase;
115 bus_space_handle_t sh;
116 bus_dma_tag_t buffer_dmat, control_dmat;
119 struct resource *reg, *irq;
125 u_int32_t *pbase, pbankbase, pbanksize;
126 volatile struct pbank *pbank[2 * 64];
127 volatile struct rbank *rbank;
128 int pslotfree, currbank, pchn, rchn;
131 struct sc_pchinfo pch[DS1_CHANS];
132 struct sc_rchinfo rch[2];
136 u_int32_t dev, subdev;
140 {0x00041073, 0, "Yamaha DS-1 (YMF724)", CntrlInst},
141 {0x000d1073, 0, "Yamaha DS-1E (YMF724F)", CntrlInst1E},
142 {0x00051073, 0, "Yamaha DS-1? (YMF734)", CntrlInst},
143 {0x00081073, 0, "Yamaha DS-1? (YMF737)", CntrlInst},
144 {0x00201073, 0, "Yamaha DS-1? (YMF738)", CntrlInst},
145 {0x00061073, 0, "Yamaha DS-1? (YMF738_TEG)", CntrlInst},
146 {0x000a1073, 0x00041073, "Yamaha DS-1 (YMF740)", CntrlInst},
147 {0x000a1073, 0x000a1073, "Yamaha DS-1 (YMF740B)", CntrlInst},
148 {0x000a1073, 0x53328086, "Yamaha DS-1 (YMF740I)", CntrlInst},
149 {0x000a1073, 0, "Yamaha DS-1 (YMF740?)", CntrlInst},
150 {0x000c1073, 0, "Yamaha DS-1E (YMF740C)", CntrlInst1E},
151 {0x00101073, 0, "Yamaha DS-1E (YMF744)", CntrlInst1E},
152 {0x00121073, 0, "Yamaha DS-1E (YMF754)", CntrlInst1E},
156 /* -------------------------------------------------------------------- */
163 static int ds_init(struct sc_info *);
164 static void ds_intr(void *);
166 /* talk to the card */
167 static u_int32_t ds_rd(struct sc_info *, int, int);
168 static void ds_wr(struct sc_info *, int, u_int32_t, int);
170 /* -------------------------------------------------------------------- */
172 static u_int32_t ds_recfmt[] = {
174 AFMT_STEREO | AFMT_U8,
176 AFMT_STEREO | AFMT_S8,
178 AFMT_STEREO | AFMT_S16_LE,
180 AFMT_STEREO | AFMT_U16_LE,
183 static struct pcmchan_caps ds_reccaps = {4000, 48000, ds_recfmt, 0};
185 static u_int32_t ds_playfmt[] = {
187 AFMT_STEREO | AFMT_U8,
189 AFMT_STEREO | AFMT_S16_LE,
192 static struct pcmchan_caps ds_playcaps = {4000, 96000, ds_playfmt, 0};
194 /* -------------------------------------------------------------------- */
197 ds_rd(struct sc_info *sc, int regno, int size)
201 return bus_space_read_1(sc->st, sc->sh, regno);
203 return bus_space_read_2(sc->st, sc->sh, regno);
205 return bus_space_read_4(sc->st, sc->sh, regno);
212 ds_wr(struct sc_info *sc, int regno, u_int32_t data, int size)
216 bus_space_write_1(sc->st, sc->sh, regno, data);
219 bus_space_write_2(sc->st, sc->sh, regno, data);
222 bus_space_write_4(sc->st, sc->sh, regno, data);
228 wrl(struct sc_info *sc, u_int32_t *ptr, u_int32_t val)
230 *(volatile u_int32_t *)ptr = val;
231 bus_space_barrier(sc->st, sc->sh, 0, 0, BUS_SPACE_BARRIER_WRITE);
234 /* -------------------------------------------------------------------- */
237 ds_cdbusy(struct sc_info *sc, int sec)
241 reg = sec? YDSXGR_SECSTATUSADR : YDSXGR_PRISTATUSADR;
242 i = YDSXG_AC97TIMEOUT;
244 if (!(ds_rd(sc, reg, 2) & 0x8000))
252 ds_initcd(kobj_t obj, void *devinfo)
254 struct sc_info *sc = (struct sc_info *)devinfo;
257 x = pci_read_config(sc->dev, PCIR_DSXGCTRL, 1);
259 pci_write_config(sc->dev, PCIR_DSXGCTRL, x & ~0x03, 1);
260 pci_write_config(sc->dev, PCIR_DSXGCTRL, x | 0x03, 1);
261 pci_write_config(sc->dev, PCIR_DSXGCTRL, x & ~0x03, 1);
263 * The YMF740 on some Intel motherboards requires a pretty
264 * hefty delay after this reset for some reason... Otherwise:
265 * "pcm0: ac97 codec init failed"
266 * Maybe this is needed for all YMF740's?
267 * 400ms and 500ms here seem to work, 300ms does not.
269 * do it for all chips -cg
274 return ds_cdbusy(sc, 0)? 0 : 1;
278 ds_rdcd(kobj_t obj, void *devinfo, int regno)
280 struct sc_info *sc = (struct sc_info *)devinfo;
286 cid = sec? (sc->cd2id << 8) : 0;
287 reg = sec? YDSXGR_SECSTATUSDATA : YDSXGR_PRISTATUSDATA;
291 cmd = YDSXG_AC97READCMD | cid | regno;
292 ds_wr(sc, YDSXGR_AC97CMDADR, cmd, 2);
294 if (ds_cdbusy(sc, sec))
297 if (sc->type == 11 && sc->rev < 2)
298 for (i = 0; i < 600; i++)
301 return ds_rd(sc, reg, 2);
305 ds_wrcd(kobj_t obj, void *devinfo, int regno, u_int32_t data)
307 struct sc_info *sc = (struct sc_info *)devinfo;
313 cid = sec? (sc->cd2id << 8) : 0;
317 cmd = YDSXG_AC97WRITECMD | cid | regno;
320 ds_wr(sc, YDSXGR_AC97CMDDATA, cmd, 4);
322 return ds_cdbusy(sc, sec);
325 static kobj_method_t ds_ac97_methods[] = {
326 KOBJMETHOD(ac97_init, ds_initcd),
327 KOBJMETHOD(ac97_read, ds_rdcd),
328 KOBJMETHOD(ac97_write, ds_wrcd),
331 AC97_DECLARE(ds_ac97);
333 /* -------------------------------------------------------------------- */
336 ds_enadsp(struct sc_info *sc, int on)
342 ds_wr(sc, YDSXGR_CONFIG, 0x00000001, 4);
344 if (ds_rd(sc, YDSXGR_CONFIG, 4))
345 ds_wr(sc, YDSXGR_CONFIG, 0x00000000, 4);
346 i = YDSXG_WORKBITTIMEOUT;
348 if (!(ds_rd(sc, YDSXGR_CONFIG, 4) & 0x00000002))
355 static volatile struct pbank *
356 ds_allocpslot(struct sc_info *sc)
360 if (sc->pslotfree > 63)
362 slot = sc->pslotfree++;
363 return sc->pbank[slot * 2];
367 ds_initpbank(volatile struct pbank *pb, int ch, int b16, int stereo, u_int32_t rate, bus_addr_t base, u_int32_t len)
369 u_int32_t lv[] = {1, 1, 0, 0, 0};
370 u_int32_t rv[] = {1, 0, 1, 0, 0};
371 u_int32_t e1[] = {0, 0, 0, 0, 0};
372 u_int32_t e2[] = {1, 0, 0, 1, 0};
373 u_int32_t e3[] = {1, 0, 0, 0, 1};
380 { 100, 0x00570000, 0x35280000},
381 { 2000, 0x06aa0000, 0x34a70000},
382 { 8000, 0x18b20000, 0x32020000},
383 {11025, 0x20930000, 0x31770000},
384 {16000, 0x2b9a0000, 0x31390000},
385 {22050, 0x35a10000, 0x31c90000},
386 {32000, 0x3eaa0000, 0x33d00000},
387 /* {44100, 0x04646000, 0x370a0000},
388 */ {48000, 0x40000000, 0x40000000},
393 delta = (65536 * rate) / 48000;
395 while (i < 7 && speedinfo[i].rate < rate)
398 pb->Format = stereo? 0x00010000 : 0;
399 pb->Format |= b16? 0 : 0x80000000;
400 pb->Format |= (stereo && (ch == 2 || ch == 4))? 0x00000001 : 0;
402 pb->PgBase = base? base : 0;
404 pb->PgLoopEnd = len >> ss;
411 pb->PgDelta = pb->PgDeltaEnd = delta << 12;
412 pb->LpfQ = speedinfo[i].fQ;
413 pb->LpfK = pb->LpfKEnd = speedinfo[i].fK;
414 pb->LpfD1 = pb->LpfD2 = 0;
415 pb->EgGain = pb->EgGainEnd = 0x40000000;
416 pb->LchGain = pb->LchGainEnd = lv[ch] * 0x40000000;
417 pb->RchGain = pb->RchGainEnd = rv[ch] * 0x40000000;
418 pb->Effect1Gain = pb->Effect1GainEnd = e1[ch] * 0x40000000;
419 pb->Effect2Gain = pb->Effect2GainEnd = e2[ch] * 0x40000000;
420 pb->Effect3Gain = pb->Effect3GainEnd = e3[ch] * 0x40000000;
426 ds_enapslot(struct sc_info *sc, int slot, int go)
428 wrl(sc, &sc->pbase[slot + 1], go? (sc->pbankbase + 2 * slot * sc->pbanksize) : 0);
429 /* kprintf("pbase[%d] = 0x%x\n", slot + 1, go? (sc->pbankbase + 2 * slot * sc->pbanksize) : 0); */
433 ds_setuppch(struct sc_pchinfo *ch)
435 int stereo, b16, c, sz;
438 stereo = (ch->fmt & AFMT_STEREO)? 1 : 0;
439 b16 = (ch->fmt & AFMT_16BIT)? 1 : 0;
441 addr = sndbuf_getbufaddr(ch->buffer);
442 sz = sndbuf_getsize(ch->buffer);
444 ds_initpbank(ch->lslot, c, stereo, b16, ch->spd, addr, sz);
445 ds_initpbank(ch->lslot + 1, c, stereo, b16, ch->spd, addr, sz);
446 ds_initpbank(ch->rslot, 2, stereo, b16, ch->spd, addr, sz);
447 ds_initpbank(ch->rslot + 1, 2, stereo, b16, ch->spd, addr, sz);
451 ds_setuprch(struct sc_rchinfo *ch)
453 struct sc_info *sc = ch->parent;
454 int stereo, b16, i, sz, pri;
458 stereo = (ch->fmt & AFMT_STEREO)? 1 : 0;
459 b16 = (ch->fmt & AFMT_16BIT)? 1 : 0;
460 addr = sndbuf_getbufaddr(ch->buffer);
461 sz = sndbuf_getsize(ch->buffer);
462 pri = (ch->num == DS1_RECPRIMARY)? 1 : 0;
464 for (i = 0; i < 2; i++) {
465 ch->slot[i].PgBase = addr;
466 ch->slot[i].PgLoopEnd = sz;
467 ch->slot[i].PgStart = 0;
468 ch->slot[i].NumOfLoops = 0;
470 x = (b16? 0x00 : 0x01) | (stereo? 0x02 : 0x00);
471 y = (48000 * 4096) / ch->spd;
473 /* kprintf("pri = %d, x = %d, y = %d\n", pri, x, y); */
474 ds_wr(sc, pri? YDSXGR_ADCFORMAT : YDSXGR_RECFORMAT, x, 4);
475 ds_wr(sc, pri? YDSXGR_ADCSLOTSR : YDSXGR_RECSLOTSR, y, 4);
478 /* -------------------------------------------------------------------- */
479 /* play channel interface */
481 ds1pchan_init(kobj_t obj, void *devinfo, struct snd_dbuf *b, struct pcm_channel *c, int dir)
483 struct sc_info *sc = devinfo;
484 struct sc_pchinfo *ch;
486 KASSERT(dir == PCMDIR_PLAY, ("ds1pchan_init: bad direction"));
488 ch = &sc->pch[sc->pchn++];
496 if (sndbuf_alloc(ch->buffer, sc->buffer_dmat, sc->bufsz) != 0)
499 ch->lsnum = sc->pslotfree;
500 ch->lslot = ds_allocpslot(sc);
501 ch->rsnum = sc->pslotfree;
502 ch->rslot = ds_allocpslot(sc);
509 ds1pchan_setformat(kobj_t obj, void *data, u_int32_t format)
511 struct sc_pchinfo *ch = data;
519 ds1pchan_setspeed(kobj_t obj, void *data, u_int32_t speed)
521 struct sc_pchinfo *ch = data;
529 ds1pchan_setblocksize(kobj_t obj, void *data, u_int32_t blocksize)
531 struct sc_pchinfo *ch = data;
532 struct sc_info *sc = ch->parent;
535 /* irq rate is fixed at 187.5hz */
536 drate = ch->spd * sndbuf_getbps(ch->buffer);
537 blocksize = roundup2((drate << 8) / DS1_IRQHZ, 4);
538 sndbuf_resize(ch->buffer, sc->bufsz / blocksize, blocksize);
543 /* semantic note: must start at beginning of buffer */
545 ds1pchan_trigger(kobj_t obj, void *data, int go)
547 struct sc_pchinfo *ch = data;
548 struct sc_info *sc = ch->parent;
551 if (go == PCMTRIG_EMLDMAWR || go == PCMTRIG_EMLDMARD)
553 stereo = (ch->fmt & AFMT_STEREO)? 1 : 0;
554 if (go == PCMTRIG_START) {
557 ds_enapslot(sc, ch->lsnum, 1);
558 ds_enapslot(sc, ch->rsnum, stereo);
559 snd_mtxlock(sc->lock);
560 ds_wr(sc, YDSXGR_MODE, 0x00000003, 4);
561 snd_mtxunlock(sc->lock);
564 /* ds_setuppch(ch); */
565 ds_enapslot(sc, ch->lsnum, 0);
566 ds_enapslot(sc, ch->rsnum, 0);
573 ds1pchan_getptr(kobj_t obj, void *data)
575 struct sc_pchinfo *ch = data;
576 struct sc_info *sc = ch->parent;
577 volatile struct pbank *bank;
581 ss = (ch->fmt & AFMT_STEREO)? 1 : 0;
582 ss += (ch->fmt & AFMT_16BIT)? 1 : 0;
584 bank = ch->lslot + sc->currbank;
585 /* kprintf("getptr: %d\n", bank->PgStart << ss); */
591 static struct pcmchan_caps *
592 ds1pchan_getcaps(kobj_t obj, void *data)
597 static kobj_method_t ds1pchan_methods[] = {
598 KOBJMETHOD(channel_init, ds1pchan_init),
599 KOBJMETHOD(channel_setformat, ds1pchan_setformat),
600 KOBJMETHOD(channel_setspeed, ds1pchan_setspeed),
601 KOBJMETHOD(channel_setblocksize, ds1pchan_setblocksize),
602 KOBJMETHOD(channel_trigger, ds1pchan_trigger),
603 KOBJMETHOD(channel_getptr, ds1pchan_getptr),
604 KOBJMETHOD(channel_getcaps, ds1pchan_getcaps),
607 CHANNEL_DECLARE(ds1pchan);
609 /* -------------------------------------------------------------------- */
610 /* record channel interface */
612 ds1rchan_init(kobj_t obj, void *devinfo, struct snd_dbuf *b, struct pcm_channel *c, int dir)
614 struct sc_info *sc = devinfo;
615 struct sc_rchinfo *ch;
617 KASSERT(dir == PCMDIR_REC, ("ds1rchan_init: bad direction"));
619 ch = &sc->rch[sc->rchn];
620 ch->num = sc->rchn++;
627 if (sndbuf_alloc(ch->buffer, sc->buffer_dmat, sc->bufsz) != 0)
630 ch->slot = (ch->num == DS1_RECPRIMARY)? sc->rbank + 2: sc->rbank;
637 ds1rchan_setformat(kobj_t obj, void *data, u_int32_t format)
639 struct sc_rchinfo *ch = data;
647 ds1rchan_setspeed(kobj_t obj, void *data, u_int32_t speed)
649 struct sc_rchinfo *ch = data;
657 ds1rchan_setblocksize(kobj_t obj, void *data, u_int32_t blocksize)
659 struct sc_rchinfo *ch = data;
660 struct sc_info *sc = ch->parent;
663 /* irq rate is fixed at 187.5hz */
664 drate = ch->spd * sndbuf_getbps(ch->buffer);
665 blocksize = roundup2((drate << 8) / DS1_IRQHZ, 4);
666 sndbuf_resize(ch->buffer, sc->bufsz / blocksize, blocksize);
671 /* semantic note: must start at beginning of buffer */
673 ds1rchan_trigger(kobj_t obj, void *data, int go)
675 struct sc_rchinfo *ch = data;
676 struct sc_info *sc = ch->parent;
679 if (go == PCMTRIG_EMLDMAWR || go == PCMTRIG_EMLDMARD)
681 if (go == PCMTRIG_START) {
684 snd_mtxlock(sc->lock);
685 x = ds_rd(sc, YDSXGR_MAPOFREC, 4);
686 x |= (ch->num == DS1_RECPRIMARY)? 0x02 : 0x01;
687 ds_wr(sc, YDSXGR_MAPOFREC, x, 4);
688 ds_wr(sc, YDSXGR_MODE, 0x00000003, 4);
689 snd_mtxunlock(sc->lock);
692 snd_mtxlock(sc->lock);
693 x = ds_rd(sc, YDSXGR_MAPOFREC, 4);
694 x &= ~((ch->num == DS1_RECPRIMARY)? 0x02 : 0x01);
695 ds_wr(sc, YDSXGR_MAPOFREC, x, 4);
696 snd_mtxunlock(sc->lock);
703 ds1rchan_getptr(kobj_t obj, void *data)
705 struct sc_rchinfo *ch = data;
706 struct sc_info *sc = ch->parent;
708 return ch->slot[sc->currbank].PgStart;
711 static struct pcmchan_caps *
712 ds1rchan_getcaps(kobj_t obj, void *data)
717 static kobj_method_t ds1rchan_methods[] = {
718 KOBJMETHOD(channel_init, ds1rchan_init),
719 KOBJMETHOD(channel_setformat, ds1rchan_setformat),
720 KOBJMETHOD(channel_setspeed, ds1rchan_setspeed),
721 KOBJMETHOD(channel_setblocksize, ds1rchan_setblocksize),
722 KOBJMETHOD(channel_trigger, ds1rchan_trigger),
723 KOBJMETHOD(channel_getptr, ds1rchan_getptr),
724 KOBJMETHOD(channel_getcaps, ds1rchan_getcaps),
727 CHANNEL_DECLARE(ds1rchan);
729 /* -------------------------------------------------------------------- */
730 /* The interrupt handler */
734 struct sc_info *sc = (struct sc_info *)p;
737 snd_mtxlock(sc->lock);
738 i = ds_rd(sc, YDSXGR_STATUS, 4);
740 device_printf(sc->dev, "timeout irq\n");
741 if (i & 0x80008000) {
742 ds_wr(sc, YDSXGR_STATUS, i & 0x80008000, 4);
743 sc->currbank = ds_rd(sc, YDSXGR_CTRLSELECT, 4) & 0x00000001;
746 for (i = 0; i < DS1_CHANS; i++) {
747 if (sc->pch[i].run) {
749 snd_mtxunlock(sc->lock);
750 chn_intr(sc->pch[i].channel);
751 snd_mtxlock(sc->lock);
754 for (i = 0; i < 2; i++) {
755 if (sc->rch[i].run) {
757 snd_mtxunlock(sc->lock);
758 chn_intr(sc->rch[i].channel);
759 snd_mtxlock(sc->lock);
762 i = ds_rd(sc, YDSXGR_MODE, 4);
764 ds_wr(sc, YDSXGR_MODE, i | 0x00000002, 4);
767 snd_mtxunlock(sc->lock);
770 /* -------------------------------------------------------------------- */
773 * Probe and attach the card
777 ds_setmap(void *arg, bus_dma_segment_t *segs, int nseg, int error)
779 struct sc_info *sc = arg;
781 sc->ctrlbase = error? 0 : (u_int32_t)segs->ds_addr;
784 kprintf("ds1: setmap (%lx, %lx), nseg=%d, error=%d\n",
785 (unsigned long)segs->ds_addr, (unsigned long)segs->ds_len,
791 ds_init(struct sc_info *sc)
794 u_int32_t *ci, r, pcs, rcs, ecs, ws, memsz, cb;
798 ci = ds_devs[sc->type].mcode;
800 ds_wr(sc, YDSXGR_NATIVEDACOUTVOL, 0x00000000, 4);
802 ds_wr(sc, YDSXGR_MODE, 0x00010000, 4);
803 ds_wr(sc, YDSXGR_MODE, 0x00000000, 4);
804 ds_wr(sc, YDSXGR_MAPOFREC, 0x00000000, 4);
805 ds_wr(sc, YDSXGR_MAPOFEFFECT, 0x00000000, 4);
806 ds_wr(sc, YDSXGR_PLAYCTRLBASE, 0x00000000, 4);
807 ds_wr(sc, YDSXGR_RECCTRLBASE, 0x00000000, 4);
808 ds_wr(sc, YDSXGR_EFFCTRLBASE, 0x00000000, 4);
809 r = ds_rd(sc, YDSXGR_GLOBALCTRL, 2);
810 ds_wr(sc, YDSXGR_GLOBALCTRL, r & ~0x0007, 2);
812 for (i = 0; i < YDSXG_DSPLENGTH; i += 4)
813 ds_wr(sc, YDSXGR_DSPINSTRAM + i, DspInst[i >> 2], 4);
815 for (i = 0; i < YDSXG_CTRLLENGTH; i += 4)
816 ds_wr(sc, YDSXGR_CTRLINSTRAM + i, ci[i >> 2], 4);
821 for (i = 100; i > 0; i--) {
822 pcs = ds_rd(sc, YDSXGR_PLAYCTRLSIZE, 4) << 2;
823 if (pcs == sizeof(struct pbank))
827 if (pcs != sizeof(struct pbank)) {
828 device_printf(sc->dev, "preposterous playctrlsize (%d)\n", pcs);
831 rcs = ds_rd(sc, YDSXGR_RECCTRLSIZE, 4) << 2;
832 ecs = ds_rd(sc, YDSXGR_EFFCTRLSIZE, 4) << 2;
833 ws = ds_rd(sc, YDSXGR_WORKSIZE, 4) << 2;
835 memsz = 64 * 2 * pcs + 2 * 2 * rcs + 5 * 2 * ecs + ws;
836 memsz += (64 + 1) * 4;
838 if (sc->regbase == NULL) {
839 if (bus_dma_tag_create(NULL, 2, 0, BUS_SPACE_MAXADDR_32BIT, BUS_SPACE_MAXADDR,
840 NULL, NULL, memsz, 1, memsz, 0,
843 if (bus_dmamem_alloc(sc->control_dmat, &buf, BUS_DMA_NOWAIT, &sc->map))
845 if (bus_dmamap_load(sc->control_dmat, sc->map, buf, memsz, ds_setmap, sc, 0) || !sc->ctrlbase) {
846 device_printf(sc->dev, "pcs=%d, rcs=%d, ecs=%d, ws=%d, memsz=%d\n",
847 pcs, rcs, ecs, ws, memsz);
856 ds_wr(sc, YDSXGR_WORKBASE, sc->ctrlbase + cb, 4);
858 sc->pbase = (u_int32_t *)(t + cb);
859 /* kprintf("pbase = %p -> 0x%x\n", sc->pbase, sc->ctrlbase + cb); */
860 ds_wr(sc, YDSXGR_PLAYCTRLBASE, sc->ctrlbase + cb, 4);
862 sc->rbank = (struct rbank *)(t + cb);
863 ds_wr(sc, YDSXGR_RECCTRLBASE, sc->ctrlbase + cb, 4);
865 ds_wr(sc, YDSXGR_EFFCTRLBASE, sc->ctrlbase + cb, 4);
868 sc->pbankbase = sc->ctrlbase + cb;
870 for (i = 0; i < 64; i++) {
871 wrl(sc, &sc->pbase[i + 1], 0);
872 sc->pbank[i * 2] = (struct pbank *)(t + cb);
873 /* kprintf("pbank[%d] = %p -> 0x%x; ", i * 2, (struct pbank *)(t + cb), sc->ctrlbase + cb - vtophys(t + cb)); */
875 sc->pbank[i * 2 + 1] = (struct pbank *)(t + cb);
876 /* kprintf("pbank[%d] = %p -> 0x%x\n", i * 2 + 1, (struct pbank *)(t + cb), sc->ctrlbase + cb - vtophys(t + cb)); */
879 wrl(sc, &sc->pbase[0], DS1_CHANS * 2);
881 sc->pchn = sc->rchn = 0;
882 ds_wr(sc, YDSXGR_NATIVEDACOUTVOL, 0x3fff3fff, 4);
883 ds_wr(sc, YDSXGR_NATIVEADCINVOL, 0x3fff3fff, 4);
884 ds_wr(sc, YDSXGR_NATIVEDACINVOL, 0x3fff3fff, 4);
890 ds_uninit(struct sc_info *sc)
892 ds_wr(sc, YDSXGR_NATIVEDACOUTVOL, 0x00000000, 4);
893 ds_wr(sc, YDSXGR_NATIVEADCINVOL, 0, 4);
894 ds_wr(sc, YDSXGR_NATIVEDACINVOL, 0, 4);
896 ds_wr(sc, YDSXGR_MODE, 0x00010000, 4);
897 ds_wr(sc, YDSXGR_MAPOFREC, 0x00000000, 4);
898 ds_wr(sc, YDSXGR_MAPOFEFFECT, 0x00000000, 4);
899 ds_wr(sc, YDSXGR_PLAYCTRLBASE, 0x00000000, 4);
900 ds_wr(sc, YDSXGR_RECCTRLBASE, 0x00000000, 4);
901 ds_wr(sc, YDSXGR_EFFCTRLBASE, 0x00000000, 4);
902 ds_wr(sc, YDSXGR_GLOBALCTRL, 0, 2);
904 bus_dmamap_unload(sc->control_dmat, sc->map);
905 bus_dmamem_free(sc->control_dmat, sc->regbase, sc->map);
911 ds_finddev(u_int32_t dev, u_int32_t subdev)
915 for (i = 0; ds_devs[i].dev; i++) {
916 if (ds_devs[i].dev == dev &&
917 (ds_devs[i].subdev == subdev || ds_devs[i].subdev == 0))
924 ds_pci_probe(device_t dev)
929 subdev = (pci_get_subdevice(dev) << 16) | pci_get_subvendor(dev);
930 i = ds_finddev(pci_get_devid(dev), subdev);
932 device_set_desc(dev, ds_devs[i].name);
933 return BUS_PROBE_DEFAULT;
939 ds_pci_attach(device_t dev)
944 struct ac97_info *codec = NULL;
945 char status[SND_STATUSLEN];
947 sc = kmalloc(sizeof(*sc), M_DEVBUF, M_WAITOK | M_ZERO);
949 sc->lock = snd_mtxcreate(device_get_nameunit(dev), "sound softc");
951 subdev = (pci_get_subdevice(dev) << 16) | pci_get_subvendor(dev);
952 sc->type = ds_finddev(pci_get_devid(dev), subdev);
953 sc->rev = pci_get_revid(dev);
955 data = pci_read_config(dev, PCIR_COMMAND, 2);
956 data |= (PCIM_CMD_PORTEN|PCIM_CMD_MEMEN|PCIM_CMD_BUSMASTEREN);
957 pci_write_config(dev, PCIR_COMMAND, data, 2);
958 data = pci_read_config(dev, PCIR_COMMAND, 2);
960 sc->regid = PCIR_BAR(0);
961 sc->reg = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &sc->regid,
964 device_printf(dev, "unable to map register space\n");
968 sc->st = rman_get_bustag(sc->reg);
969 sc->sh = rman_get_bushandle(sc->reg);
971 sc->bufsz = pcm_getbuffersize(dev, 4096, DS1_BUFFSIZE, 65536);
973 if (bus_dma_tag_create(/*parent*/NULL, /*alignment*/2, /*boundary*/0,
974 /*lowaddr*/BUS_SPACE_MAXADDR_32BIT,
975 /*highaddr*/BUS_SPACE_MAXADDR,
976 /*filter*/NULL, /*filterarg*/NULL,
977 /*maxsize*/sc->bufsz, /*nsegments*/1, /*maxsegz*/0x3ffff,
979 &sc->buffer_dmat) != 0) {
980 device_printf(dev, "unable to create dma tag\n");
985 if (ds_init(sc) == -1) {
986 device_printf(dev, "unable to initialize the card\n");
990 codec = AC97_CREATE(dev, sc, ds_ac97);
994 * Turn on inverted external amplifier sense flags for few
998 case 0x81171033: /* NEC ValueStar (VT550/0) */
999 ac97_setflags(codec, ac97_getflags(codec) | AC97_F_EAPD_INV);
1004 mixer_init(dev, ac97_getmixerclass(), codec);
1007 sc->irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &sc->irqid,
1008 RF_ACTIVE | RF_SHAREABLE);
1009 if (!sc->irq || snd_setup_intr(dev, sc->irq, INTR_MPSAFE, ds_intr, sc, &sc->ih)) {
1010 device_printf(dev, "unable to map interrupt\n");
1014 ksnprintf(status, SND_STATUSLEN, "at memory 0x%lx irq %ld %s",
1015 rman_get_start(sc->reg), rman_get_start(sc->irq),PCM_KLDSTRING(snd_ds1));
1017 if (pcm_register(dev, sc, DS1_CHANS, 2))
1019 for (i = 0; i < DS1_CHANS; i++)
1020 pcm_addchan(dev, PCMDIR_PLAY, &ds1pchan_class, sc);
1021 for (i = 0; i < 2; i++)
1022 pcm_addchan(dev, PCMDIR_REC, &ds1rchan_class, sc);
1023 pcm_setstatus(dev, status);
1029 ac97_destroy(codec);
1031 bus_release_resource(dev, SYS_RES_MEMORY, sc->regid, sc->reg);
1033 bus_teardown_intr(dev, sc->irq, sc->ih);
1035 bus_release_resource(dev, SYS_RES_IRQ, sc->irqid, sc->irq);
1036 if (sc->buffer_dmat)
1037 bus_dma_tag_destroy(sc->buffer_dmat);
1038 if (sc->control_dmat)
1039 bus_dma_tag_destroy(sc->control_dmat);
1041 snd_mtxfree(sc->lock);
1042 kfree(sc, M_DEVBUF);
1047 ds_pci_resume(device_t dev)
1051 sc = pcm_getdevinfo(dev);
1053 if (ds_init(sc) == -1) {
1054 device_printf(dev, "unable to reinitialize the card\n");
1057 if (mixer_reinit(dev) == -1) {
1058 device_printf(dev, "unable to reinitialize the mixer\n");
1065 ds_pci_detach(device_t dev)
1070 r = pcm_unregister(dev);
1074 sc = pcm_getdevinfo(dev);
1076 bus_release_resource(dev, SYS_RES_MEMORY, sc->regid, sc->reg);
1077 bus_teardown_intr(dev, sc->irq, sc->ih);
1078 bus_release_resource(dev, SYS_RES_IRQ, sc->irqid, sc->irq);
1079 bus_dma_tag_destroy(sc->buffer_dmat);
1080 bus_dma_tag_destroy(sc->control_dmat);
1081 snd_mtxfree(sc->lock);
1082 kfree(sc, M_DEVBUF);
1086 static device_method_t ds1_methods[] = {
1087 /* Device interface */
1088 DEVMETHOD(device_probe, ds_pci_probe),
1089 DEVMETHOD(device_attach, ds_pci_attach),
1090 DEVMETHOD(device_detach, ds_pci_detach),
1091 DEVMETHOD(device_resume, ds_pci_resume),
1095 static driver_t ds1_driver = {
1101 DRIVER_MODULE(snd_ds1, pci, ds1_driver, pcm_devclass, 0, 0);
1102 MODULE_DEPEND(snd_ds1, sound, SOUND_MINVER, SOUND_PREFVER, SOUND_MAXVER);
1103 MODULE_VERSION(snd_ds1, 1);