2 * Copyright (c) 2012 Ruslan Bukin <br@bsdpad.com>
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, WHETHER IN 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 THE POSSIBILITY OF
28 * RME HDSPe driver for FreeBSD (pcm-part).
29 * Supported cards: AIO, RayDAT.
32 #include <dev/sound/pcm/sound.h>
33 #include <dev/sound/pci/hdspe.h>
34 #include <dev/sound/chip.h>
36 #include <bus/pci/pcireg.h>
37 #include <bus/pci/pcivar.h>
41 SND_DECLARE_FILE("$FreeBSD: head/sys/dev/sound/pci/hdspe-pcm.c 241066 2012-09-30 09:21:10Z kevlo $");
43 struct hdspe_latency {
49 static struct hdspe_latency latency_map[] = {
67 static struct hdspe_rate rate_map[] = {
68 { 32000, (HDSPE_FREQ_32000) },
69 { 44100, (HDSPE_FREQ_44100) },
70 { 48000, (HDSPE_FREQ_48000) },
71 { 64000, (HDSPE_FREQ_32000 | HDSPE_FREQ_DOUBLE) },
72 { 88200, (HDSPE_FREQ_44100 | HDSPE_FREQ_DOUBLE) },
73 { 96000, (HDSPE_FREQ_48000 | HDSPE_FREQ_DOUBLE) },
74 { 128000, (HDSPE_FREQ_32000 | HDSPE_FREQ_QUAD) },
75 { 176400, (HDSPE_FREQ_44100 | HDSPE_FREQ_QUAD) },
76 { 192000, (HDSPE_FREQ_48000 | HDSPE_FREQ_QUAD) },
83 hdspe_hw_mixer(struct sc_chinfo *ch, unsigned int dst,
84 unsigned int src, unsigned short data)
86 struct sc_pcminfo *scp = ch->parent;
87 struct sc_info *sc = scp->sc;
90 if (ch->dir == PCMDIR_PLAY)
93 hdspe_write_4(sc, HDSPE_MIXER_BASE +
94 ((offs + src + 128 * dst) * sizeof(uint32_t)),
101 hdspechan_setgain(struct sc_chinfo *ch)
104 hdspe_hw_mixer(ch, ch->lslot, ch->lslot,
105 ch->lvol * HDSPE_MAX_GAIN / 100);
106 hdspe_hw_mixer(ch, ch->rslot, ch->rslot,
107 ch->rvol * HDSPE_MAX_GAIN / 100);
113 hdspemixer_init(struct snd_mixer *m)
115 struct sc_pcminfo *scp = mix_getdevinfo(m);
116 struct sc_info *sc = scp->sc;
122 mask = SOUND_MASK_PCM;
125 mask |= SOUND_MASK_VOLUME;
128 mask |= SOUND_MASK_RECLEV;
130 snd_mtxlock(sc->lock);
131 pcm_setflags(scp->dev, pcm_getflags(scp->dev) | SD_F_SOFTPCMVOL);
132 mix_setdevs(m, mask);
133 snd_mtxunlock(sc->lock);
139 hdspemixer_set(struct snd_mixer *m, unsigned dev,
140 unsigned left, unsigned right)
142 struct sc_pcminfo *scp = mix_getdevinfo(m);
143 struct sc_chinfo *ch;
147 device_printf(scp->dev, "hdspemixer_set() %d %d\n",
151 for (i = 0; i < scp->chnum; i++) {
153 if ((dev == SOUND_MIXER_VOLUME && ch->dir == PCMDIR_PLAY) ||
154 (dev == SOUND_MIXER_RECLEV && ch->dir == PCMDIR_REC)) {
158 hdspechan_setgain(ch);
165 static kobj_method_t hdspemixer_methods[] = {
166 KOBJMETHOD(mixer_init, hdspemixer_init),
167 KOBJMETHOD(mixer_set, hdspemixer_set),
170 MIXER_DECLARE(hdspemixer);
173 hdspechan_enable(struct sc_chinfo *ch, int value)
175 struct sc_pcminfo *scp = ch->parent;
176 struct sc_info *sc = scp->sc;
179 if (ch->dir == PCMDIR_PLAY)
180 reg = HDSPE_OUT_ENABLE_BASE;
182 reg = HDSPE_IN_ENABLE_BASE;
186 hdspe_write_1(sc, reg + (4 * ch->lslot), value);
187 hdspe_write_1(sc, reg + (4 * ch->rslot), value);
191 hdspe_running(struct sc_info *sc)
193 struct sc_pcminfo *scp;
194 struct sc_chinfo *ch;
195 int i, j, devcount, err;
198 if ((err = device_get_children(sc->dev, &devlist, &devcount)) != 0)
201 for (i = 0; i < devcount; i++) {
202 scp = device_get_ivars(devlist[i]);
203 for (j = 0; j < scp->chnum; j++) {
210 kfree(devlist, M_TEMP);
215 device_printf(sc->dev,"hdspe is running\n");
218 kfree(devlist, M_TEMP);
223 hdspe_start_audio(struct sc_info *sc)
226 sc->ctrl_register |= (HDSPE_AUDIO_INT_ENABLE | HDSPE_ENABLE);
227 hdspe_write_4(sc, HDSPE_CONTROL_REG, sc->ctrl_register);
231 hdspe_stop_audio(struct sc_info *sc)
234 if (hdspe_running(sc) == 1)
237 sc->ctrl_register &= ~(HDSPE_AUDIO_INT_ENABLE | HDSPE_ENABLE);
238 hdspe_write_4(sc, HDSPE_CONTROL_REG, sc->ctrl_register);
241 /* Multiplex / demultiplex: 2.0 <-> 2 x 1.0. */
243 buffer_copy(struct sc_chinfo *ch)
245 struct sc_pcminfo *scp = ch->parent;
246 struct sc_info *sc = scp->sc;
251 length = sndbuf_getready(ch->buffer) /
252 (4 /* Bytes per sample. */ * 2 /* channels */);
254 if (ch->dir == PCMDIR_PLAY) {
255 src = sndbuf_getreadyptr(ch->buffer);
257 src = sndbuf_getfreeptr(ch->buffer);
260 src /= 4; /* Bytes per sample. */
261 dst = src / 2; /* Destination buffer twice smaller. */
263 ssize = ch->size / 4;
264 dsize = ch->size / 8;
267 * Use two fragment buffer to avoid sound clipping.
270 for (i = 0; i < sc->period * 2 /* fragments */; i++) {
271 if (ch->dir == PCMDIR_PLAY) {
272 sc->pbuf[dst + HDSPE_CHANBUF_SAMPLES * ch->lslot] =
274 sc->pbuf[dst + HDSPE_CHANBUF_SAMPLES * ch->rslot] =
279 sc->rbuf[dst + HDSPE_CHANBUF_SAMPLES * ch->lslot];
281 sc->rbuf[dst + HDSPE_CHANBUF_SAMPLES * ch->rslot];
292 clean(struct sc_chinfo *ch){
293 struct sc_pcminfo *scp = ch->parent;
294 struct sc_info *sc = scp->sc;
295 uint32_t *buf = sc->rbuf;
297 if (ch->dir == PCMDIR_PLAY) {
301 bzero(buf + HDSPE_CHANBUF_SAMPLES * ch->lslot, HDSPE_CHANBUF_SIZE);
302 bzero(buf + HDSPE_CHANBUF_SAMPLES * ch->rslot, HDSPE_CHANBUF_SIZE);
308 /* Channel interface. */
310 hdspechan_init(kobj_t obj, void *devinfo, struct snd_dbuf *b,
311 struct pcm_channel *c, int dir)
313 struct sc_pcminfo *scp = devinfo;
314 struct sc_info *sc = scp->sc;
315 struct sc_chinfo *ch;
318 snd_mtxlock(sc->lock);
321 ch = &scp->chan[num];
322 ch->lslot = scp->hc->left;
323 ch->rslot = scp->hc->right;
328 ch->size = HDSPE_CHANBUF_SIZE * 2 /* slots */;
329 ch->data = kmalloc(ch->size, M_HDSPE, M_WAITOK | M_ZERO);
337 snd_mtxunlock(sc->lock);
339 if (sndbuf_setup(ch->buffer, ch->data, ch->size) != 0) {
340 device_printf(scp->dev, "Can't setup sndbuf.\n");
348 hdspechan_trigger(kobj_t obj, void *data, int go)
350 struct sc_chinfo *ch = data;
351 struct sc_pcminfo *scp = ch->parent;
352 struct sc_info *sc = scp->sc;
354 snd_mtxlock(sc->lock);
358 device_printf(scp->dev, "hdspechan_trigger(): start\n");
360 hdspechan_enable(ch, 1);
361 hdspechan_setgain(ch);
362 hdspe_start_audio(sc);
368 device_printf(scp->dev, "hdspechan_trigger(): stop or abort\n");
371 hdspechan_enable(ch, 0);
372 hdspe_stop_audio(sc);
375 case PCMTRIG_EMLDMAWR:
376 case PCMTRIG_EMLDMARD:
382 snd_mtxunlock(sc->lock);
388 hdspechan_getptr(kobj_t obj, void *data)
390 struct sc_chinfo *ch = data;
391 struct sc_pcminfo *scp = ch->parent;
392 struct sc_info *sc = scp->sc;
395 snd_mtxlock(sc->lock);
396 ret = hdspe_read_2(sc, HDSPE_STATUS_REG);
397 snd_mtxunlock(sc->lock);
399 pos = ret & HDSPE_BUF_POSITION_MASK;
400 pos *= 2; /* Hardbuf twice bigger. */
406 hdspechan_free(kobj_t obj, void *data)
408 struct sc_chinfo *ch = data;
409 struct sc_pcminfo *scp = ch->parent;
410 struct sc_info *sc = scp->sc;
413 device_printf(scp->dev, "hdspechan_free()\n");
415 snd_mtxlock(sc->lock);
416 if (ch->data != NULL) {
417 kfree(ch->data, M_HDSPE);
420 snd_mtxunlock(sc->lock);
426 hdspechan_setformat(kobj_t obj, void *data, uint32_t format)
428 struct sc_chinfo *ch = data;
431 struct sc_pcminfo *scp = ch->parent;
432 device_printf(scp->dev, "hdspechan_setformat(%d)\n", format);
441 hdspechan_setspeed(kobj_t obj, void *data, uint32_t speed)
443 struct sc_chinfo *ch = data;
444 struct sc_pcminfo *scp = ch->parent;
445 struct sc_info *sc = scp->sc;
446 struct hdspe_rate *hr = NULL;
452 device_printf(scp->dev, "hdspechan_setspeed(%d)\n", speed);
455 if (hdspe_running(sc) == 1)
458 /* First look for equal frequency. */
459 for (i = 0; rate_map[i].speed != 0; i++) {
460 if (rate_map[i].speed == speed)
464 /* If no match, just find nearest. */
466 for (i = 0; rate_map[i].speed != 0; i++) {
468 threshold = hr->speed + ((rate_map[i + 1].speed != 0) ?
469 ((rate_map[i + 1].speed - hr->speed) >> 1) : 0);
470 if (speed < threshold)
478 period = HDSPE_FREQ_AIO;
481 /* Unsupported card. */
485 /* Write frequency on the device. */
486 sc->ctrl_register &= ~HDSPE_FREQ_MASK;
487 sc->ctrl_register |= hr->reg;
488 hdspe_write_4(sc, HDSPE_CONTROL_REG, sc->ctrl_register);
493 else if (speed > 48000)
498 hdspe_write_4(sc, HDSPE_FREQ_REG, period);
500 sc->speed = hr->speed;
506 hdspechan_setblocksize(kobj_t obj, void *data, uint32_t blocksize)
508 struct sc_chinfo *ch = data;
509 struct sc_pcminfo *scp = ch->parent;
510 struct sc_info *sc = scp->sc;
511 struct hdspe_latency *hl = NULL;
516 device_printf(scp->dev, "hdspechan_setblocksize(%d)\n", blocksize);
519 if (hdspe_running(sc) == 1)
522 if (blocksize > HDSPE_LAT_BYTES_MAX)
523 blocksize = HDSPE_LAT_BYTES_MAX;
524 else if (blocksize < HDSPE_LAT_BYTES_MIN)
525 blocksize = HDSPE_LAT_BYTES_MIN;
527 blocksize /= 4 /* samples */;
529 /* First look for equal latency. */
530 for (i = 0; latency_map[i].period != 0; i++) {
531 if (latency_map[i].period == blocksize) {
532 hl = &latency_map[i];
536 /* If no match, just find nearest. */
538 for (i = 0; latency_map[i].period != 0; i++) {
539 hl = &latency_map[i];
540 threshold = hl->period + ((latency_map[i + 1].period != 0) ?
541 ((latency_map[i + 1].period - hl->period) >> 1) : 0);
542 if (blocksize < threshold)
547 snd_mtxlock(sc->lock);
548 sc->ctrl_register &= ~HDSPE_LAT_MASK;
549 sc->ctrl_register |= hdspe_encode_latency(hl->n);
550 hdspe_write_4(sc, HDSPE_CONTROL_REG, sc->ctrl_register);
551 sc->period = hl->period;
552 snd_mtxunlock(sc->lock);
555 device_printf(scp->dev, "New period=%d\n", sc->period);
558 sndbuf_resize(ch->buffer, (HDSPE_CHANBUF_SIZE * 2) / (sc->period * 4),
561 return sndbuf_getblksz(ch->buffer);
564 static uint32_t hdspe_rfmt[] = {
565 SND_FORMAT(AFMT_S32_LE, 2, 0),
569 static struct pcmchan_caps hdspe_rcaps = {32000, 192000, hdspe_rfmt, 0};
571 static uint32_t hdspe_pfmt[] = {
572 SND_FORMAT(AFMT_S32_LE, 2, 0),
576 static struct pcmchan_caps hdspe_pcaps = {32000, 192000, hdspe_pfmt, 0};
578 static struct pcmchan_caps *
579 hdspechan_getcaps(kobj_t obj, void *data)
581 struct sc_chinfo *ch = data;
584 struct sc_pcminfo *scl = ch->parent;
585 device_printf(scp->dev, "hdspechan_getcaps()\n");
588 return (ch->dir == PCMDIR_PLAY) ?
589 &hdspe_pcaps : &hdspe_rcaps;
592 static kobj_method_t hdspechan_methods[] = {
593 KOBJMETHOD(channel_init, hdspechan_init),
594 KOBJMETHOD(channel_free, hdspechan_free),
595 KOBJMETHOD(channel_setformat, hdspechan_setformat),
596 KOBJMETHOD(channel_setspeed, hdspechan_setspeed),
597 KOBJMETHOD(channel_setblocksize, hdspechan_setblocksize),
598 KOBJMETHOD(channel_trigger, hdspechan_trigger),
599 KOBJMETHOD(channel_getptr, hdspechan_getptr),
600 KOBJMETHOD(channel_getcaps, hdspechan_getcaps),
603 CHANNEL_DECLARE(hdspechan);
607 hdspe_pcm_probe(device_t dev)
611 device_printf(dev,"hdspe_pcm_probe()\n");
618 hdspe_pcm_intr(struct sc_pcminfo *scp) {
619 struct sc_chinfo *ch;
620 struct sc_info *sc = scp->sc;
623 for (i = 0; i < scp->chnum; i++) {
625 snd_mtxunlock(sc->lock);
626 chn_intr(ch->channel);
627 snd_mtxlock(sc->lock);
634 hdspe_pcm_attach(device_t dev)
636 struct sc_pcminfo *scp;
637 char status[SND_STATUSLEN];
641 scp = device_get_ivars(dev);
642 scp->ih = &hdspe_pcm_intr;
644 bzero(desc, sizeof(desc));
645 ksnprintf(desc, sizeof(desc), "HDSPe AIO [%s]", scp->hc->descr);
646 device_set_desc_copy(dev, desc);
649 * We don't register interrupt handler with snd_setup_intr
650 * in pcm device. Mark pcm device as MPSAFE manually.
652 pcm_setflags(dev, pcm_getflags(dev) | SD_F_MPSAFE);
654 err = pcm_register(dev, scp, scp->hc->play, scp->hc->rec);
656 device_printf(dev, "Can't register pcm.\n");
661 for (i = 0; i < scp->hc->play; i++) {
662 pcm_addchan(dev, PCMDIR_PLAY, &hdspechan_class, scp);
666 for (i = 0; i < scp->hc->rec; i++) {
667 pcm_addchan(dev, PCMDIR_REC, &hdspechan_class, scp);
671 ksnprintf(status, SND_STATUSLEN, "at io 0x%lx irq %ld %s",
672 rman_get_start(scp->sc->cs),
673 rman_get_start(scp->sc->irq),
674 PCM_KLDSTRING(snd_hdspe));
675 pcm_setstatus(dev, status);
677 mixer_init(dev, &hdspemixer_class, scp);
683 hdspe_pcm_detach(device_t dev)
687 err = pcm_unregister(dev);
689 device_printf(dev, "Can't unregister device.\n");
696 static device_method_t hdspe_pcm_methods[] = {
697 DEVMETHOD(device_probe, hdspe_pcm_probe),
698 DEVMETHOD(device_attach, hdspe_pcm_attach),
699 DEVMETHOD(device_detach, hdspe_pcm_detach),
703 static driver_t hdspe_pcm_driver = {
709 DRIVER_MODULE(snd_hdspe_pcm, hdspe, hdspe_pcm_driver, pcm_devclass, NULL, NULL);
710 MODULE_DEPEND(snd_hdspe, sound, SOUND_MINVER, SOUND_PREFVER, SOUND_MAXVER);
711 MODULE_VERSION(snd_hdspe, 1);