2 * Copyright (c) 2001 Cameron Grant <gandalf@vilnya.demon.co.uk>
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
27 #include <dev/sound/pcm/sound.h>
28 #include <dev/sound/pcm/vchan.h>
29 #include "feeder_if.h"
31 SND_DECLARE_FILE("$FreeBSD: src/sys/dev/sound/pcm/vchan.c,v 1.5.2.4 2003/02/11 15:54:16 orion Exp $");
34 u_int32_t spd, fmt, blksz, bps, run;
35 struct pcm_channel *channel, *parent;
36 struct pcmchan_caps caps;
39 static u_int32_t vchan_fmt[] = {
40 AFMT_STEREO | AFMT_S16_LE,
45 vchan_mix_s16(int16_t *to, int16_t *tmp, unsigned int count)
48 * to is the output buffer, tmp is the input buffer
49 * count is the number of 16bit samples to mix
54 for(i = 0; i < count; i++) {
58 /* printf("%d + %d = %d (u)\n", to[i], tmp[i], x); */
62 /* printf("%d + %d = %d (o)\n", to[i], tmp[i], x); */
65 to[i] = x & 0x0000ffff;
71 feed_vchan_s16(struct pcm_feeder *f, struct pcm_channel *c, u_int8_t *b, u_int32_t count, void *source)
73 /* we're going to abuse things a bit */
74 struct snd_dbuf *src = source;
75 struct pcmchan_children *cce;
76 struct pcm_channel *ch;
80 KASSERT(sndbuf_getsize(src) >= count, ("bad bufsize"));
85 * we are going to use our source as a temporary buffer since it's
86 * got no other purpose. we obtain our data by traversing the channel
87 * list of children and calling vchan_mix_* to mix count bytes from each
88 * into our destination buffer, b
91 tmp = (int16_t *)sndbuf_getbuf(src);
93 SLIST_FOREACH(cce, &c->children, link) {
95 if (ch->flags & CHN_F_TRIGGERED) {
96 if (ch->flags & CHN_F_MAPPED)
97 sndbuf_acquire(ch->bufsoft, NULL, sndbuf_getfree(ch->bufsoft));
98 cnt = FEEDER_FEED(ch->feeder, ch, (u_int8_t *)tmp, count, ch->bufsoft);
99 vchan_mix_s16(dst, tmp, cnt / 2);
106 static struct pcm_feederdesc feeder_vchan_s16_desc[] = {
107 {FEEDER_MIXER, AFMT_S16_LE | AFMT_STEREO, AFMT_S16_LE | AFMT_STEREO, 0},
110 static kobj_method_t feeder_vchan_s16_methods[] = {
111 KOBJMETHOD(feeder_feed, feed_vchan_s16),
114 FEEDER_DECLARE(feeder_vchan_s16, 2, NULL);
116 /************************************************************/
119 vchan_init(kobj_t obj, void *devinfo, struct snd_dbuf *b, struct pcm_channel *c, int dir)
122 struct pcm_channel *parent = devinfo;
124 KASSERT(dir == PCMDIR_PLAY, ("vchan_init: bad direction"));
125 ch = malloc(sizeof(*ch), M_DEVBUF, M_WAITOK | M_ZERO);
129 ch->spd = DSP_DEFAULT_SPEED;
132 c->flags |= CHN_F_VIRTUAL;
138 vchan_free(kobj_t obj, void *data)
144 vchan_setformat(kobj_t obj, void *data, u_int32_t format)
146 struct vchinfo *ch = data;
147 struct pcm_channel *parent = ch->parent;
151 ch->bps <<= (ch->fmt & AFMT_STEREO)? 1 : 0;
152 ch->bps <<= (ch->fmt & AFMT_16BIT)? 1 : 0;
153 ch->bps <<= (ch->fmt & AFMT_32BIT)? 2 : 0;
154 chn_notify(parent, CHN_N_FORMAT);
159 vchan_setspeed(kobj_t obj, void *data, u_int32_t speed)
161 struct vchinfo *ch = data;
162 struct pcm_channel *parent = ch->parent;
165 chn_notify(parent, CHN_N_RATE);
170 vchan_setblocksize(kobj_t obj, void *data, u_int32_t blocksize)
172 struct vchinfo *ch = data;
173 struct pcm_channel *parent = ch->parent;
176 ch->blksz = blocksize;
177 chn_notify(parent, CHN_N_BLOCKSIZE);
179 crate = ch->spd * ch->bps;
180 prate = sndbuf_getspd(parent->bufhard) * sndbuf_getbps(parent->bufhard);
181 blocksize = sndbuf_getblksz(parent->bufhard);
189 vchan_trigger(kobj_t obj, void *data, int go)
191 struct vchinfo *ch = data;
192 struct pcm_channel *parent = ch->parent;
194 if (go == PCMTRIG_EMLDMAWR || go == PCMTRIG_EMLDMARD)
197 ch->run = (go == PCMTRIG_START)? 1 : 0;
198 chn_notify(parent, CHN_N_TRIGGER);
203 static struct pcmchan_caps *
204 vchan_getcaps(kobj_t obj, void *data)
206 struct vchinfo *ch = data;
208 ch->caps.minspeed = sndbuf_getspd(ch->parent->bufhard);
209 ch->caps.maxspeed = ch->caps.minspeed;
210 ch->caps.fmtlist = vchan_fmt;
216 static kobj_method_t vchan_methods[] = {
217 KOBJMETHOD(channel_init, vchan_init),
218 KOBJMETHOD(channel_free, vchan_free),
219 KOBJMETHOD(channel_setformat, vchan_setformat),
220 KOBJMETHOD(channel_setspeed, vchan_setspeed),
221 KOBJMETHOD(channel_setblocksize, vchan_setblocksize),
222 KOBJMETHOD(channel_trigger, vchan_trigger),
223 KOBJMETHOD(channel_getcaps, vchan_getcaps),
226 CHANNEL_DECLARE(vchan);
228 /* virtual channel interface */
231 vchan_create(struct pcm_channel *parent)
233 struct snddev_info *d = parent->parentsnddev;
234 struct pcmchan_children *pce;
235 struct pcm_channel *child;
239 if (!(parent->flags & CHN_F_BUSY)) {
244 pce = malloc(sizeof(*pce), M_DEVBUF, M_WAITOK | M_ZERO);
250 /* create a new playback channel */
251 child = pcm_chn_create(d, parent, &vchan_class, PCMDIR_VIRTUAL, parent);
258 first = SLIST_EMPTY(&parent->children);
259 /* add us to our parent channel's children */
260 pce->channel = child;
261 SLIST_INSERT_HEAD(&parent->children, pce, link);
264 /* add us to our grandparent's channel list */
265 err = pcm_chn_add(d, child, !first);
267 pcm_chn_destroy(child);
271 /* XXX gross ugly hack, kill murder death */
273 err = chn_reset(parent, AFMT_STEREO | AFMT_S16_LE);
275 printf("chn_reset: %d\n", err);
276 err = chn_setspeed(parent, 44100);
278 printf("chn_setspeed: %d\n", err);
285 vchan_destroy(struct pcm_channel *c)
287 struct pcm_channel *parent = c->parentchannel;
288 struct snddev_info *d = parent->parentsnddev;
289 struct pcmchan_children *pce;
293 if (!(parent->flags & CHN_F_BUSY)) {
297 if (SLIST_EMPTY(&parent->children)) {
302 /* remove us from our parent's children list */
303 SLIST_FOREACH(pce, &parent->children, link) {
304 if (pce->channel == c)
310 SLIST_REMOVE(&parent->children, pce, pcmchan_children, link);
313 last = SLIST_EMPTY(&parent->children);
315 parent->flags &= ~CHN_F_BUSY;
317 /* remove us from our grantparent's channel list */
318 err = pcm_chn_remove(d, c, !last);
323 /* destroy ourselves */
324 err = pcm_chn_destroy(c);
330 vchan_initsys(device_t dev)
333 struct snddev_info *d;
335 d = device_get_softc(dev);
336 SYSCTL_ADD_PROC(snd_sysctl_tree(dev), SYSCTL_CHILDREN(snd_sysctl_tree_top(dev)),
337 OID_AUTO, "vchans", CTLTYPE_INT | CTLFLAG_RW, d, sizeof(d),
338 sysctl_hw_snd_vchans, "I", "")