1 /*-
2 * SPDX-License-Identifier: BSD-2-Clause
3 *
4 * Copyright (c) 2005-2009 Ariff Abdullah <ariff@FreeBSD.org>
5 * Portions Copyright (c) Ryan Beasley <ryan.beasley@gmail.com> - GSoC 2006
6 * Copyright (c) 1999 Cameron Grant <cg@FreeBSD.org>
7 * Portions Copyright (c) Luigi Rizzo <luigi@FreeBSD.org> - 1997-99
8 * All rights reserved.
9 * Copyright (c) 2024-2025 The FreeBSD Foundation
10 *
11 * Portions of this software were developed by Christos Margiolis
12 * <christos@FreeBSD.org> under sponsorship from the FreeBSD Foundation.
13 *
14 * Redistribution and use in source and binary forms, with or without
15 * modification, are permitted provided that the following conditions
16 * are met:
17 * 1. Redistributions of source code must retain the above copyright
18 * notice, this list of conditions and the following disclaimer.
19 * 2. Redistributions in binary form must reproduce the above copyright
20 * notice, this list of conditions and the following disclaimer in the
21 * documentation and/or other materials provided with the distribution.
22 *
23 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
24 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
25 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
26 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
27 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
28 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
29 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
30 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
31 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
32 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
33 * SUCH DAMAGE.
34 */
35
36 #ifdef HAVE_KERNEL_OPTION_HEADERS
37 #include "opt_snd.h"
38 #endif
39
40 #include <dev/sound/pcm/sound.h>
41 #include <dev/sound/pcm/vchan.h>
42
43 #include "feeder_if.h"
44
45 int report_soft_formats = 1;
46 SYSCTL_INT(_hw_snd, OID_AUTO, report_soft_formats, CTLFLAG_RW,
47 &report_soft_formats, 0, "report software-emulated formats");
48
49 int report_soft_matrix = 1;
50 SYSCTL_INT(_hw_snd, OID_AUTO, report_soft_matrix, CTLFLAG_RW,
51 &report_soft_matrix, 0, "report software-emulated channel matrixing");
52
53 int chn_latency = CHN_LATENCY_DEFAULT;
54
55 static int
sysctl_hw_snd_latency(SYSCTL_HANDLER_ARGS)56 sysctl_hw_snd_latency(SYSCTL_HANDLER_ARGS)
57 {
58 int err, val;
59
60 val = chn_latency;
61 err = sysctl_handle_int(oidp, &val, 0, req);
62 if (err != 0 || req->newptr == NULL)
63 return err;
64 if (val < CHN_LATENCY_MIN || val > CHN_LATENCY_MAX)
65 err = EINVAL;
66 else
67 chn_latency = val;
68
69 return err;
70 }
71 SYSCTL_PROC(_hw_snd, OID_AUTO, latency,
72 CTLTYPE_INT | CTLFLAG_RWTUN | CTLFLAG_MPSAFE, 0, sizeof(int),
73 sysctl_hw_snd_latency, "I",
74 "buffering latency (0=low ... 10=high)");
75
76 int chn_latency_profile = CHN_LATENCY_PROFILE_DEFAULT;
77
78 static int
sysctl_hw_snd_latency_profile(SYSCTL_HANDLER_ARGS)79 sysctl_hw_snd_latency_profile(SYSCTL_HANDLER_ARGS)
80 {
81 int err, val;
82
83 val = chn_latency_profile;
84 err = sysctl_handle_int(oidp, &val, 0, req);
85 if (err != 0 || req->newptr == NULL)
86 return err;
87 if (val < CHN_LATENCY_PROFILE_MIN || val > CHN_LATENCY_PROFILE_MAX)
88 err = EINVAL;
89 else
90 chn_latency_profile = val;
91
92 return err;
93 }
94 SYSCTL_PROC(_hw_snd, OID_AUTO, latency_profile,
95 CTLTYPE_INT | CTLFLAG_RWTUN | CTLFLAG_MPSAFE, 0, sizeof(int),
96 sysctl_hw_snd_latency_profile, "I",
97 "buffering latency profile (0=aggressive 1=safe)");
98
99 static int chn_timeout = CHN_TIMEOUT;
100
101 static int
sysctl_hw_snd_timeout(SYSCTL_HANDLER_ARGS)102 sysctl_hw_snd_timeout(SYSCTL_HANDLER_ARGS)
103 {
104 int err, val;
105
106 val = chn_timeout;
107 err = sysctl_handle_int(oidp, &val, 0, req);
108 if (err != 0 || req->newptr == NULL)
109 return err;
110 if (val < CHN_TIMEOUT_MIN || val > CHN_TIMEOUT_MAX)
111 err = EINVAL;
112 else
113 chn_timeout = val;
114
115 return err;
116 }
117 SYSCTL_PROC(_hw_snd, OID_AUTO, timeout,
118 CTLTYPE_INT | CTLFLAG_RWTUN | CTLFLAG_MPSAFE, 0, sizeof(int),
119 sysctl_hw_snd_timeout, "I",
120 "interrupt timeout (1 - 10) seconds");
121
122 static int chn_vpc_autoreset = 1;
123 SYSCTL_INT(_hw_snd, OID_AUTO, vpc_autoreset, CTLFLAG_RWTUN,
124 &chn_vpc_autoreset, 0, "automatically reset channels volume to 0db");
125
126 static int chn_vol_0db_pcm = SND_VOL_0DB_PCM;
127
128 static void
chn_vpc_proc(int reset,int db)129 chn_vpc_proc(int reset, int db)
130 {
131 struct snddev_info *d;
132 struct pcm_channel *c;
133 int i;
134
135 bus_topo_lock();
136 for (i = 0; pcm_devclass != NULL &&
137 i < devclass_get_maxunit(pcm_devclass); i++) {
138 d = devclass_get_softc(pcm_devclass, i);
139 if (!PCM_REGISTERED(d))
140 continue;
141 PCM_LOCK(d);
142 PCM_WAIT(d);
143 PCM_ACQUIRE(d);
144 CHN_FOREACH(c, d, channels.pcm) {
145 CHN_LOCK(c);
146 CHN_SETVOLUME(c, SND_VOL_C_PCM, SND_CHN_T_VOL_0DB, db);
147 if (reset != 0)
148 chn_vpc_reset(c, SND_VOL_C_PCM, 1);
149 CHN_UNLOCK(c);
150 }
151 PCM_RELEASE(d);
152 PCM_UNLOCK(d);
153 }
154 bus_topo_unlock();
155 }
156
157 static int
sysctl_hw_snd_vpc_0db(SYSCTL_HANDLER_ARGS)158 sysctl_hw_snd_vpc_0db(SYSCTL_HANDLER_ARGS)
159 {
160 int err, val;
161
162 val = chn_vol_0db_pcm;
163 err = sysctl_handle_int(oidp, &val, 0, req);
164 if (err != 0 || req->newptr == NULL)
165 return (err);
166 if (val < SND_VOL_0DB_MIN || val > SND_VOL_0DB_MAX)
167 return (EINVAL);
168
169 chn_vol_0db_pcm = val;
170 chn_vpc_proc(0, val);
171
172 return (0);
173 }
174 SYSCTL_PROC(_hw_snd, OID_AUTO, vpc_0db,
175 CTLTYPE_INT | CTLFLAG_RWTUN | CTLFLAG_MPSAFE, 0, sizeof(int),
176 sysctl_hw_snd_vpc_0db, "I",
177 "0db relative level");
178
179 static int
sysctl_hw_snd_vpc_reset(SYSCTL_HANDLER_ARGS)180 sysctl_hw_snd_vpc_reset(SYSCTL_HANDLER_ARGS)
181 {
182 int err, val;
183
184 val = 0;
185 err = sysctl_handle_int(oidp, &val, 0, req);
186 if (err != 0 || req->newptr == NULL || val == 0)
187 return (err);
188
189 chn_vol_0db_pcm = SND_VOL_0DB_PCM;
190 chn_vpc_proc(1, SND_VOL_0DB_PCM);
191
192 return (0);
193 }
194 SYSCTL_PROC(_hw_snd, OID_AUTO, vpc_reset,
195 CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_MPSAFE, 0, sizeof(int),
196 sysctl_hw_snd_vpc_reset, "I",
197 "reset volume on all channels");
198
199 static int chn_usefrags = 0;
200 static int chn_syncdelay = -1;
201
202 SYSCTL_INT(_hw_snd, OID_AUTO, usefrags, CTLFLAG_RWTUN,
203 &chn_usefrags, 0, "prefer setfragments() over setblocksize()");
204 SYSCTL_INT(_hw_snd, OID_AUTO, syncdelay, CTLFLAG_RWTUN,
205 &chn_syncdelay, 0,
206 "append (0-1000) millisecond trailing buffer delay on each sync");
207
208 /**
209 * @brief Channel sync group lock
210 *
211 * Clients should acquire this lock @b without holding any channel locks
212 * before touching syncgroups or the main syncgroup list.
213 */
214 struct mtx snd_pcm_syncgroups_mtx;
215 MTX_SYSINIT(pcm_syncgroup, &snd_pcm_syncgroups_mtx, "PCM channel sync group lock", MTX_DEF);
216 /**
217 * @brief syncgroups' master list
218 *
219 * Each time a channel syncgroup is created, it's added to this list. This
220 * list should only be accessed with @sa snd_pcm_syncgroups_mtx held.
221 *
222 * See SNDCTL_DSP_SYNCGROUP for more information.
223 */
224 struct pcm_synclist snd_pcm_syncgroups = SLIST_HEAD_INITIALIZER(snd_pcm_syncgroups);
225
226 static void
chn_lockinit(struct pcm_channel * c,int dir)227 chn_lockinit(struct pcm_channel *c, int dir)
228 {
229 switch (dir) {
230 case PCMDIR_PLAY:
231 c->lock = snd_mtxcreate(c->name, "pcm play channel");
232 cv_init(&c->intr_cv, "pcmwr");
233 break;
234 case PCMDIR_PLAY_VIRTUAL:
235 c->lock = snd_mtxcreate(c->name, "pcm virtual play channel");
236 cv_init(&c->intr_cv, "pcmwrv");
237 break;
238 case PCMDIR_REC:
239 c->lock = snd_mtxcreate(c->name, "pcm record channel");
240 cv_init(&c->intr_cv, "pcmrd");
241 break;
242 case PCMDIR_REC_VIRTUAL:
243 c->lock = snd_mtxcreate(c->name, "pcm virtual record channel");
244 cv_init(&c->intr_cv, "pcmrdv");
245 break;
246 default:
247 panic("%s(): Invalid direction=%d", __func__, dir);
248 break;
249 }
250
251 cv_init(&c->cv, "pcmchn");
252 }
253
254 static void
chn_lockdestroy(struct pcm_channel * c)255 chn_lockdestroy(struct pcm_channel *c)
256 {
257 CHN_LOCKASSERT(c);
258
259 CHN_BROADCAST(&c->cv);
260 CHN_BROADCAST(&c->intr_cv);
261
262 cv_destroy(&c->cv);
263 cv_destroy(&c->intr_cv);
264
265 snd_mtxfree(c->lock);
266 }
267
268 /**
269 * @brief Determine channel is ready for I/O
270 *
271 * @retval 1 = ready for I/O
272 * @retval 0 = not ready for I/O
273 */
274 static int
chn_polltrigger(struct pcm_channel * c)275 chn_polltrigger(struct pcm_channel *c)
276 {
277 struct snd_dbuf *bs = c->bufsoft;
278 u_int delta;
279
280 CHN_LOCKASSERT(c);
281
282 if (c->flags & CHN_F_MMAP) {
283 if (sndbuf_getprevtotal(bs) < c->lw)
284 delta = c->lw;
285 else
286 delta = sndbuf_gettotal(bs) - sndbuf_getprevtotal(bs);
287 } else {
288 if (c->direction == PCMDIR_PLAY)
289 delta = sndbuf_getfree(bs);
290 else
291 delta = sndbuf_getready(bs);
292 }
293
294 return ((delta < c->lw) ? 0 : 1);
295 }
296
297 static void
chn_pollreset(struct pcm_channel * c)298 chn_pollreset(struct pcm_channel *c)
299 {
300
301 CHN_LOCKASSERT(c);
302 sndbuf_updateprevtotal(c->bufsoft);
303 }
304
305 static void
chn_wakeup(struct pcm_channel * c)306 chn_wakeup(struct pcm_channel *c)
307 {
308 struct snd_dbuf *bs;
309 struct pcm_channel *ch;
310
311 CHN_LOCKASSERT(c);
312
313 bs = c->bufsoft;
314
315 if (CHN_EMPTY(c, children.busy)) {
316 if (SEL_WAITING(sndbuf_getsel(bs)) && chn_polltrigger(c))
317 selwakeuppri(sndbuf_getsel(bs), PRIBIO);
318 CHN_BROADCAST(&c->intr_cv);
319 } else {
320 CHN_FOREACH(ch, c, children.busy) {
321 CHN_LOCK(ch);
322 chn_wakeup(ch);
323 CHN_UNLOCK(ch);
324 }
325 }
326 }
327
328 static int
chn_sleep(struct pcm_channel * c,int timeout)329 chn_sleep(struct pcm_channel *c, int timeout)
330 {
331 int ret;
332
333 CHN_LOCKASSERT(c);
334
335 if (c->flags & CHN_F_DEAD)
336 return (EINVAL);
337
338 c->sleeping++;
339 ret = cv_timedwait_sig(&c->intr_cv, c->lock, timeout);
340 c->sleeping--;
341
342 return ((c->flags & CHN_F_DEAD) ? EINVAL : ret);
343 }
344
345 /*
346 * chn_dmaupdate() tracks the status of a dma transfer,
347 * updating pointers.
348 */
349
350 static unsigned int
chn_dmaupdate(struct pcm_channel * c)351 chn_dmaupdate(struct pcm_channel *c)
352 {
353 struct snd_dbuf *b = c->bufhard;
354 unsigned int delta, old, hwptr, amt;
355
356 KASSERT(sndbuf_getsize(b) > 0, ("bufsize == 0"));
357 CHN_LOCKASSERT(c);
358
359 old = sndbuf_gethwptr(b);
360 hwptr = chn_getptr(c);
361 delta = (sndbuf_getsize(b) + hwptr - old) % sndbuf_getsize(b);
362 sndbuf_sethwptr(b, hwptr);
363
364 if (c->direction == PCMDIR_PLAY) {
365 amt = min(delta, sndbuf_getready(b));
366 amt -= amt % sndbuf_getalign(b);
367 if (amt > 0)
368 sndbuf_dispose(b, NULL, amt);
369 } else {
370 amt = min(delta, sndbuf_getfree(b));
371 amt -= amt % sndbuf_getalign(b);
372 if (amt > 0)
373 sndbuf_acquire(b, NULL, amt);
374 }
375 if (snd_verbose > 3 && CHN_STARTED(c) && delta == 0) {
376 device_printf(c->dev, "WARNING: %s DMA completion "
377 "too fast/slow ! hwptr=%u, old=%u "
378 "delta=%u amt=%u ready=%u free=%u\n",
379 CHN_DIRSTR(c), hwptr, old, delta, amt,
380 sndbuf_getready(b), sndbuf_getfree(b));
381 }
382
383 return delta;
384 }
385
386 static void
chn_wrfeed(struct pcm_channel * c)387 chn_wrfeed(struct pcm_channel *c)
388 {
389 struct snd_dbuf *b = c->bufhard;
390 struct snd_dbuf *bs = c->bufsoft;
391 unsigned int amt, want, wasfree;
392
393 CHN_LOCKASSERT(c);
394
395 if ((c->flags & CHN_F_MMAP) && !(c->flags & CHN_F_CLOSING))
396 sndbuf_acquire(bs, NULL, sndbuf_getfree(bs));
397
398 wasfree = sndbuf_getfree(b);
399 want = min(sndbuf_getsize(b),
400 imax(0, sndbuf_xbytes(sndbuf_getsize(bs), bs, b) -
401 sndbuf_getready(b)));
402 amt = min(wasfree, want);
403 if (amt > 0)
404 sndbuf_feed(bs, b, c, c->feeder, amt);
405
406 /*
407 * Possible xruns. There should be no empty space left in buffer.
408 */
409 if (sndbuf_getready(b) < want)
410 c->xruns++;
411
412 if (sndbuf_getfree(b) < wasfree)
413 chn_wakeup(c);
414 }
415
416 static void
chn_wrintr(struct pcm_channel * c)417 chn_wrintr(struct pcm_channel *c)
418 {
419
420 CHN_LOCKASSERT(c);
421 /* update pointers in primary buffer */
422 chn_dmaupdate(c);
423 /* ...and feed from secondary to primary */
424 chn_wrfeed(c);
425 /* tell the driver we've updated the primary buffer */
426 chn_trigger(c, PCMTRIG_EMLDMAWR);
427 }
428
429 /*
430 * user write routine - uiomove data into secondary buffer, trigger if necessary
431 * if blocking, sleep, rinse and repeat.
432 *
433 * called externally, so must handle locking
434 */
435
436 int
chn_write(struct pcm_channel * c,struct uio * buf)437 chn_write(struct pcm_channel *c, struct uio *buf)
438 {
439 struct snd_dbuf *bs = c->bufsoft;
440 void *off;
441 int ret, timeout, sz, t, p;
442
443 CHN_LOCKASSERT(c);
444
445 ret = 0;
446 timeout = chn_timeout * hz;
447
448 while (ret == 0 && buf->uio_resid > 0) {
449 sz = min(buf->uio_resid, sndbuf_getfree(bs));
450 if (sz > 0) {
451 /*
452 * The following assumes that the free space in
453 * the buffer can never be less around the
454 * unlock-uiomove-lock sequence.
455 */
456 while (ret == 0 && sz > 0) {
457 p = sndbuf_getfreeptr(bs);
458 t = min(sz, sndbuf_getsize(bs) - p);
459 off = sndbuf_getbufofs(bs, p);
460 CHN_UNLOCK(c);
461 ret = uiomove(off, t, buf);
462 CHN_LOCK(c);
463 sz -= t;
464 sndbuf_acquire(bs, NULL, t);
465 }
466 ret = 0;
467 if (CHN_STOPPED(c) && !(c->flags & CHN_F_NOTRIGGER)) {
468 ret = chn_start(c, 0);
469 if (ret != 0)
470 c->flags |= CHN_F_DEAD;
471 }
472 } else if (c->flags & (CHN_F_NBIO | CHN_F_NOTRIGGER)) {
473 /**
474 * @todo Evaluate whether EAGAIN is truly desirable.
475 * 4Front drivers behave like this, but I'm
476 * not sure if it at all violates the "write
477 * should be allowed to block" model.
478 *
479 * The idea is that, while set with CHN_F_NOTRIGGER,
480 * a channel isn't playing, *but* without this we
481 * end up with "interrupt timeout / channel dead".
482 */
483 ret = EAGAIN;
484 } else {
485 ret = chn_sleep(c, timeout);
486 if (ret == EAGAIN) {
487 ret = EINVAL;
488 c->flags |= CHN_F_DEAD;
489 device_printf(c->dev, "%s(): %s: "
490 "play interrupt timeout, channel dead\n",
491 __func__, c->name);
492 } else if (ret == ERESTART || ret == EINTR)
493 c->flags |= CHN_F_ABORTING;
494 }
495 }
496
497 return (ret);
498 }
499
500 /*
501 * Feed new data from the read buffer. Can be called in the bottom half.
502 */
503 static void
chn_rdfeed(struct pcm_channel * c)504 chn_rdfeed(struct pcm_channel *c)
505 {
506 struct snd_dbuf *b = c->bufhard;
507 struct snd_dbuf *bs = c->bufsoft;
508 unsigned int amt;
509
510 CHN_LOCKASSERT(c);
511
512 if (c->flags & CHN_F_MMAP)
513 sndbuf_dispose(bs, NULL, sndbuf_getready(bs));
514
515 amt = sndbuf_getfree(bs);
516 if (amt > 0)
517 sndbuf_feed(b, bs, c, c->feeder, amt);
518
519 amt = sndbuf_getready(b);
520 if (amt > 0) {
521 c->xruns++;
522 sndbuf_dispose(b, NULL, amt);
523 }
524
525 if (sndbuf_getready(bs) > 0)
526 chn_wakeup(c);
527 }
528
529 /* read interrupt routine. Must be called with interrupts blocked. */
530 static void
chn_rdintr(struct pcm_channel * c)531 chn_rdintr(struct pcm_channel *c)
532 {
533
534 CHN_LOCKASSERT(c);
535 /* tell the driver to update the primary buffer if non-dma */
536 chn_trigger(c, PCMTRIG_EMLDMARD);
537 /* update pointers in primary buffer */
538 chn_dmaupdate(c);
539 /* ...and feed from primary to secondary */
540 chn_rdfeed(c);
541 }
542
543 /*
544 * user read routine - trigger if necessary, uiomove data from secondary buffer
545 * if blocking, sleep, rinse and repeat.
546 *
547 * called externally, so must handle locking
548 */
549
550 int
chn_read(struct pcm_channel * c,struct uio * buf)551 chn_read(struct pcm_channel *c, struct uio *buf)
552 {
553 struct snd_dbuf *bs = c->bufsoft;
554 void *off;
555 int ret, timeout, sz, t, p;
556
557 CHN_LOCKASSERT(c);
558
559 if (CHN_STOPPED(c) && !(c->flags & CHN_F_NOTRIGGER)) {
560 ret = chn_start(c, 0);
561 if (ret != 0) {
562 c->flags |= CHN_F_DEAD;
563 return (ret);
564 }
565 }
566
567 ret = 0;
568 timeout = chn_timeout * hz;
569
570 while (ret == 0 && buf->uio_resid > 0) {
571 sz = min(buf->uio_resid, sndbuf_getready(bs));
572 if (sz > 0) {
573 /*
574 * The following assumes that the free space in
575 * the buffer can never be less around the
576 * unlock-uiomove-lock sequence.
577 */
578 while (ret == 0 && sz > 0) {
579 p = sndbuf_getreadyptr(bs);
580 t = min(sz, sndbuf_getsize(bs) - p);
581 off = sndbuf_getbufofs(bs, p);
582 CHN_UNLOCK(c);
583 ret = uiomove(off, t, buf);
584 CHN_LOCK(c);
585 sz -= t;
586 sndbuf_dispose(bs, NULL, t);
587 }
588 ret = 0;
589 } else if (c->flags & (CHN_F_NBIO | CHN_F_NOTRIGGER))
590 ret = EAGAIN;
591 else {
592 ret = chn_sleep(c, timeout);
593 if (ret == EAGAIN) {
594 ret = EINVAL;
595 c->flags |= CHN_F_DEAD;
596 device_printf(c->dev, "%s(): %s: "
597 "record interrupt timeout, channel dead\n",
598 __func__, c->name);
599 } else if (ret == ERESTART || ret == EINTR)
600 c->flags |= CHN_F_ABORTING;
601 }
602 }
603
604 return (ret);
605 }
606
607 void
chn_intr_locked(struct pcm_channel * c)608 chn_intr_locked(struct pcm_channel *c)
609 {
610
611 CHN_LOCKASSERT(c);
612
613 c->interrupts++;
614
615 if (c->direction == PCMDIR_PLAY)
616 chn_wrintr(c);
617 else
618 chn_rdintr(c);
619 }
620
621 void
chn_intr(struct pcm_channel * c)622 chn_intr(struct pcm_channel *c)
623 {
624
625 if (CHN_LOCKOWNED(c)) {
626 chn_intr_locked(c);
627 return;
628 }
629
630 CHN_LOCK(c);
631 chn_intr_locked(c);
632 CHN_UNLOCK(c);
633 }
634
635 u_int32_t
chn_start(struct pcm_channel * c,int force)636 chn_start(struct pcm_channel *c, int force)
637 {
638 u_int32_t i, j;
639 struct snd_dbuf *b = c->bufhard;
640 struct snd_dbuf *bs = c->bufsoft;
641 int err;
642
643 CHN_LOCKASSERT(c);
644 /* if we're running, or if we're prevented from triggering, bail */
645 if (CHN_STARTED(c) || ((c->flags & CHN_F_NOTRIGGER) && !force))
646 return (EINVAL);
647
648 err = 0;
649
650 if (force) {
651 i = 1;
652 j = 0;
653 } else {
654 if (c->direction == PCMDIR_REC) {
655 i = sndbuf_getfree(bs);
656 j = (i > 0) ? 1 : sndbuf_getready(b);
657 } else {
658 if (sndbuf_getfree(bs) == 0) {
659 i = 1;
660 j = 0;
661 } else {
662 struct snd_dbuf *pb;
663
664 pb = CHN_BUF_PARENT(c, b);
665 i = sndbuf_xbytes(sndbuf_getready(bs), bs, pb);
666 j = sndbuf_getalign(pb);
667 }
668 }
669 if (snd_verbose > 3 && CHN_EMPTY(c, children))
670 device_printf(c->dev, "%s(): %s (%s) threshold "
671 "i=%d j=%d\n", __func__, CHN_DIRSTR(c),
672 (c->flags & CHN_F_VIRTUAL) ? "virtual" :
673 "hardware", i, j);
674 }
675
676 if (i >= j) {
677 c->flags |= CHN_F_TRIGGERED;
678 sndbuf_setrun(b, 1);
679 if (c->flags & CHN_F_CLOSING)
680 c->feedcount = 2;
681 else {
682 c->feedcount = 0;
683 c->interrupts = 0;
684 c->xruns = 0;
685 }
686 if (c->parentchannel == NULL) {
687 if (c->direction == PCMDIR_PLAY)
688 sndbuf_fillsilence_rl(b,
689 sndbuf_xbytes(sndbuf_getsize(bs), bs, b));
690 if (snd_verbose > 3)
691 device_printf(c->dev,
692 "%s(): %s starting! (%s/%s) "
693 "(ready=%d force=%d i=%d j=%d "
694 "intrtimeout=%u latency=%dms)\n",
695 __func__,
696 (c->flags & CHN_F_HAS_VCHAN) ?
697 "VCHAN PARENT" : "HW", CHN_DIRSTR(c),
698 (c->flags & CHN_F_CLOSING) ? "closing" :
699 "running",
700 sndbuf_getready(b),
701 force, i, j, c->timeout,
702 (sndbuf_getsize(b) * 1000) /
703 (sndbuf_getalign(b) * sndbuf_getspd(b)));
704 }
705 err = chn_trigger(c, PCMTRIG_START);
706 }
707
708 return (err);
709 }
710
711 void
chn_resetbuf(struct pcm_channel * c)712 chn_resetbuf(struct pcm_channel *c)
713 {
714 struct snd_dbuf *b = c->bufhard;
715 struct snd_dbuf *bs = c->bufsoft;
716
717 c->blocks = 0;
718 sndbuf_reset(b);
719 sndbuf_reset(bs);
720 }
721
722 /*
723 * chn_sync waits until the space in the given channel goes above
724 * a threshold. The threshold is checked against fl or rl respectively.
725 * Assume that the condition can become true, do not check here...
726 */
727 int
chn_sync(struct pcm_channel * c,int threshold)728 chn_sync(struct pcm_channel *c, int threshold)
729 {
730 struct snd_dbuf *b, *bs;
731 int ret, count, hcount, minflush, resid, residp, syncdelay, blksz;
732 u_int32_t cflag;
733
734 CHN_LOCKASSERT(c);
735
736 if (c->direction != PCMDIR_PLAY)
737 return (EINVAL);
738
739 bs = c->bufsoft;
740
741 if ((c->flags & (CHN_F_DEAD | CHN_F_ABORTING)) ||
742 (threshold < 1 && sndbuf_getready(bs) < 1))
743 return (0);
744
745 /* if we haven't yet started and nothing is buffered, else start*/
746 if (CHN_STOPPED(c)) {
747 if (threshold > 0 || sndbuf_getready(bs) > 0) {
748 ret = chn_start(c, 1);
749 if (ret != 0)
750 return (ret);
751 } else
752 return (0);
753 }
754
755 b = CHN_BUF_PARENT(c, c->bufhard);
756
757 minflush = threshold + sndbuf_xbytes(sndbuf_getready(b), b, bs);
758
759 syncdelay = chn_syncdelay;
760
761 if (syncdelay < 0 && (threshold > 0 || sndbuf_getready(bs) > 0))
762 minflush += sndbuf_xbytes(sndbuf_getsize(b), b, bs);
763
764 /*
765 * Append (0-1000) millisecond trailing buffer (if needed)
766 * for slower / high latency hardwares (notably USB audio)
767 * to avoid audible truncation.
768 */
769 if (syncdelay > 0)
770 minflush += (sndbuf_getalign(bs) * sndbuf_getspd(bs) *
771 ((syncdelay > 1000) ? 1000 : syncdelay)) / 1000;
772
773 minflush -= minflush % sndbuf_getalign(bs);
774
775 if (minflush > 0) {
776 threshold = min(minflush, sndbuf_getfree(bs));
777 sndbuf_clear(bs, threshold);
778 sndbuf_acquire(bs, NULL, threshold);
779 minflush -= threshold;
780 }
781
782 resid = sndbuf_getready(bs);
783 residp = resid;
784 blksz = sndbuf_getblksz(b);
785 if (blksz < 1) {
786 device_printf(c->dev,
787 "%s(): WARNING: blksz < 1 ! maxsize=%d [%d/%d/%d]\n",
788 __func__, sndbuf_getmaxsize(b), sndbuf_getsize(b),
789 sndbuf_getblksz(b), sndbuf_getblkcnt(b));
790 if (sndbuf_getblkcnt(b) > 0)
791 blksz = sndbuf_getsize(b) / sndbuf_getblkcnt(b);
792 if (blksz < 1)
793 blksz = 1;
794 }
795 count = sndbuf_xbytes(minflush + resid, bs, b) / blksz;
796 hcount = count;
797 ret = 0;
798
799 if (snd_verbose > 3)
800 device_printf(c->dev, "%s(): [begin] timeout=%d count=%d "
801 "minflush=%d resid=%d\n", __func__, c->timeout, count,
802 minflush, resid);
803
804 cflag = c->flags & CHN_F_CLOSING;
805 c->flags |= CHN_F_CLOSING;
806 while (count > 0 && (resid > 0 || minflush > 0)) {
807 ret = chn_sleep(c, c->timeout);
808 if (ret == ERESTART || ret == EINTR) {
809 c->flags |= CHN_F_ABORTING;
810 break;
811 } else if (ret == 0 || ret == EAGAIN) {
812 resid = sndbuf_getready(bs);
813 if (resid == residp) {
814 --count;
815 if (snd_verbose > 3)
816 device_printf(c->dev,
817 "%s(): [stalled] timeout=%d "
818 "count=%d hcount=%d "
819 "resid=%d minflush=%d\n",
820 __func__, c->timeout, count,
821 hcount, resid, minflush);
822 } else if (resid < residp && count < hcount) {
823 ++count;
824 if (snd_verbose > 3)
825 device_printf(c->dev,
826 "%s((): [resume] timeout=%d "
827 "count=%d hcount=%d "
828 "resid=%d minflush=%d\n",
829 __func__, c->timeout, count,
830 hcount, resid, minflush);
831 }
832 if (minflush > 0 && sndbuf_getfree(bs) > 0) {
833 threshold = min(minflush,
834 sndbuf_getfree(bs));
835 sndbuf_clear(bs, threshold);
836 sndbuf_acquire(bs, NULL, threshold);
837 resid = sndbuf_getready(bs);
838 minflush -= threshold;
839 }
840 residp = resid;
841 } else
842 break;
843 }
844 c->flags &= ~CHN_F_CLOSING;
845 c->flags |= cflag;
846
847 if (snd_verbose > 3)
848 device_printf(c->dev,
849 "%s(): timeout=%d count=%d hcount=%d resid=%d residp=%d "
850 "minflush=%d ret=%d\n",
851 __func__, c->timeout, count, hcount, resid, residp,
852 minflush, ret);
853
854 return (0);
855 }
856
857 /* called externally, handle locking */
858 int
chn_poll(struct pcm_channel * c,int ev,struct thread * td)859 chn_poll(struct pcm_channel *c, int ev, struct thread *td)
860 {
861 struct snd_dbuf *bs = c->bufsoft;
862 int ret;
863
864 CHN_LOCKASSERT(c);
865
866 if (!(c->flags & (CHN_F_MMAP | CHN_F_TRIGGERED))) {
867 ret = chn_start(c, 1);
868 if (ret != 0)
869 return (0);
870 }
871
872 ret = 0;
873 if (chn_polltrigger(c)) {
874 chn_pollreset(c);
875 ret = ev;
876 } else
877 selrecord(td, sndbuf_getsel(bs));
878
879 return (ret);
880 }
881
882 /*
883 * chn_abort terminates a running dma transfer. it may sleep up to 200ms.
884 * it returns the number of bytes that have not been transferred.
885 *
886 * called from: dsp_close, dsp_ioctl, with channel locked
887 */
888 int
chn_abort(struct pcm_channel * c)889 chn_abort(struct pcm_channel *c)
890 {
891 int missing = 0;
892 struct snd_dbuf *b = c->bufhard;
893 struct snd_dbuf *bs = c->bufsoft;
894
895 CHN_LOCKASSERT(c);
896 if (CHN_STOPPED(c))
897 return 0;
898 c->flags |= CHN_F_ABORTING;
899
900 c->flags &= ~CHN_F_TRIGGERED;
901 /* kill the channel */
902 chn_trigger(c, PCMTRIG_ABORT);
903 sndbuf_setrun(b, 0);
904 if (!(c->flags & CHN_F_VIRTUAL))
905 chn_dmaupdate(c);
906 missing = sndbuf_getready(bs);
907
908 c->flags &= ~CHN_F_ABORTING;
909 return missing;
910 }
911
912 /*
913 * this routine tries to flush the dma transfer. It is called
914 * on a close of a playback channel.
915 * first, if there is data in the buffer, but the dma has not yet
916 * begun, we need to start it.
917 * next, we wait for the play buffer to drain
918 * finally, we stop the dma.
919 *
920 * called from: dsp_close, not valid for record channels.
921 */
922
923 int
chn_flush(struct pcm_channel * c)924 chn_flush(struct pcm_channel *c)
925 {
926 struct snd_dbuf *b = c->bufhard;
927
928 CHN_LOCKASSERT(c);
929 KASSERT(c->direction == PCMDIR_PLAY, ("chn_flush on bad channel"));
930 DEB(printf("chn_flush: c->flags 0x%08x\n", c->flags));
931
932 c->flags |= CHN_F_CLOSING;
933 chn_sync(c, 0);
934 c->flags &= ~CHN_F_TRIGGERED;
935 /* kill the channel */
936 chn_trigger(c, PCMTRIG_ABORT);
937 sndbuf_setrun(b, 0);
938
939 c->flags &= ~CHN_F_CLOSING;
940 return 0;
941 }
942
943 int
snd_fmtvalid(uint32_t fmt,uint32_t * fmtlist)944 snd_fmtvalid(uint32_t fmt, uint32_t *fmtlist)
945 {
946 int i;
947
948 for (i = 0; fmtlist[i] != 0; i++) {
949 if (fmt == fmtlist[i] ||
950 ((fmt & AFMT_PASSTHROUGH) &&
951 (AFMT_ENCODING(fmt) & fmtlist[i])))
952 return (1);
953 }
954
955 return (0);
956 }
957
958 static const struct {
959 char *name, *alias1, *alias2;
960 uint32_t afmt;
961 } afmt_tab[] = {
962 { "alaw", NULL, NULL, AFMT_A_LAW },
963 { "mulaw", NULL, NULL, AFMT_MU_LAW },
964 { "u8", "8", NULL, AFMT_U8 },
965 { "s8", NULL, NULL, AFMT_S8 },
966 { "ac3", NULL, NULL, AFMT_AC3 },
967 #if BYTE_ORDER == LITTLE_ENDIAN
968 { "s16le", "s16", "16", AFMT_S16_LE },
969 { "s16be", NULL, NULL, AFMT_S16_BE },
970 { "s24le", "s24", "24", AFMT_S24_LE },
971 { "s24be", NULL, NULL, AFMT_S24_BE },
972 { "s32le", "s32", "32", AFMT_S32_LE },
973 { "s32be", NULL, NULL, AFMT_S32_BE },
974 { "f32le", "f32", NULL, AFMT_F32_LE },
975 { "f32be", NULL, NULL, AFMT_F32_BE },
976 { "u16le", "u16", NULL, AFMT_U16_LE },
977 { "u16be", NULL, NULL, AFMT_U16_BE },
978 { "u24le", "u24", NULL, AFMT_U24_LE },
979 { "u24be", NULL, NULL, AFMT_U24_BE },
980 { "u32le", "u32", NULL, AFMT_U32_LE },
981 { "u32be", NULL, NULL, AFMT_U32_BE },
982 #else
983 { "s16le", NULL, NULL, AFMT_S16_LE },
984 { "s16be", "s16", "16", AFMT_S16_BE },
985 { "s24le", NULL, NULL, AFMT_S24_LE },
986 { "s24be", "s24", "24", AFMT_S24_BE },
987 { "s32le", NULL, NULL, AFMT_S32_LE },
988 { "s32be", "s32", "32", AFMT_S32_BE },
989 { "f32le", NULL, NULL, AFMT_F32_LE },
990 { "f32be", "f32", NULL, AFMT_F32_BE },
991 { "u16le", NULL, NULL, AFMT_U16_LE },
992 { "u16be", "u16", NULL, AFMT_U16_BE },
993 { "u24le", NULL, NULL, AFMT_U24_LE },
994 { "u24be", "u24", NULL, AFMT_U24_BE },
995 { "u32le", NULL, NULL, AFMT_U32_LE },
996 { "u32be", "u32", NULL, AFMT_U32_BE },
997 #endif
998 { NULL, NULL, NULL, 0 }
999 };
1000
1001 uint32_t
snd_str2afmt(const char * req)1002 snd_str2afmt(const char *req)
1003 {
1004 int ext;
1005 int ch;
1006 int i;
1007 char b1[8];
1008 char b2[8];
1009
1010 memset(b1, 0, sizeof(b1));
1011 memset(b2, 0, sizeof(b2));
1012
1013 i = sscanf(req, "%5[^:]:%6s", b1, b2);
1014
1015 if (i == 1) {
1016 if (strlen(req) != strlen(b1))
1017 return (0);
1018 strlcpy(b2, "2.0", sizeof(b2));
1019 } else if (i == 2) {
1020 if (strlen(req) != (strlen(b1) + 1 + strlen(b2)))
1021 return (0);
1022 } else
1023 return (0);
1024
1025 i = sscanf(b2, "%d.%d", &ch, &ext);
1026
1027 if (i == 0) {
1028 if (strcasecmp(b2, "mono") == 0) {
1029 ch = 1;
1030 ext = 0;
1031 } else if (strcasecmp(b2, "stereo") == 0) {
1032 ch = 2;
1033 ext = 0;
1034 } else if (strcasecmp(b2, "quad") == 0) {
1035 ch = 4;
1036 ext = 0;
1037 } else
1038 return (0);
1039 } else if (i == 1) {
1040 if (ch < 1 || ch > AFMT_CHANNEL_MAX)
1041 return (0);
1042 ext = 0;
1043 } else if (i == 2) {
1044 if (ext < 0 || ext > AFMT_EXTCHANNEL_MAX)
1045 return (0);
1046 if (ch < 1 || (ch + ext) > AFMT_CHANNEL_MAX)
1047 return (0);
1048 } else
1049 return (0);
1050
1051 for (i = 0; afmt_tab[i].name != NULL; i++) {
1052 if (strcasecmp(afmt_tab[i].name, b1) != 0) {
1053 if (afmt_tab[i].alias1 == NULL)
1054 continue;
1055 if (strcasecmp(afmt_tab[i].alias1, b1) != 0) {
1056 if (afmt_tab[i].alias2 == NULL)
1057 continue;
1058 if (strcasecmp(afmt_tab[i].alias2, b1) != 0)
1059 continue;
1060 }
1061 }
1062 /* found a match */
1063 return (SND_FORMAT(afmt_tab[i].afmt, ch + ext, ext));
1064 }
1065 /* not a valid format */
1066 return (0);
1067 }
1068
1069 uint32_t
snd_afmt2str(uint32_t afmt,char * buf,size_t len)1070 snd_afmt2str(uint32_t afmt, char *buf, size_t len)
1071 {
1072 uint32_t enc;
1073 uint32_t ext;
1074 uint32_t ch;
1075 int i;
1076
1077 if (buf == NULL || len < AFMTSTR_LEN)
1078 return (0);
1079
1080 memset(buf, 0, len);
1081
1082 enc = AFMT_ENCODING(afmt);
1083 ch = AFMT_CHANNEL(afmt);
1084 ext = AFMT_EXTCHANNEL(afmt);
1085 /* check there is at least one channel */
1086 if (ch <= ext)
1087 return (0);
1088 for (i = 0; afmt_tab[i].name != NULL; i++) {
1089 if (enc != afmt_tab[i].afmt)
1090 continue;
1091 /* found a match */
1092 snprintf(buf, len, "%s:%d.%d",
1093 afmt_tab[i].name, ch - ext, ext);
1094 return (SND_FORMAT(enc, ch, ext));
1095 }
1096 return (0);
1097 }
1098
1099 int
chn_reset(struct pcm_channel * c,uint32_t fmt,uint32_t spd)1100 chn_reset(struct pcm_channel *c, uint32_t fmt, uint32_t spd)
1101 {
1102 int r;
1103
1104 CHN_LOCKASSERT(c);
1105 c->feedcount = 0;
1106 c->flags &= CHN_F_RESET;
1107 c->interrupts = 0;
1108 c->timeout = 1;
1109 c->xruns = 0;
1110
1111 c->flags |= (pcm_getflags(c->dev) & SD_F_BITPERFECT) ?
1112 CHN_F_BITPERFECT : 0;
1113
1114 r = CHANNEL_RESET(c->methods, c->devinfo);
1115 if (r == 0 && fmt != 0 && spd != 0) {
1116 r = chn_setparam(c, fmt, spd);
1117 fmt = 0;
1118 spd = 0;
1119 }
1120 if (r == 0 && fmt != 0)
1121 r = chn_setformat(c, fmt);
1122 if (r == 0 && spd != 0)
1123 r = chn_setspeed(c, spd);
1124 if (r == 0)
1125 r = chn_setlatency(c, chn_latency);
1126 if (r == 0) {
1127 chn_resetbuf(c);
1128 r = CHANNEL_RESETDONE(c->methods, c->devinfo);
1129 }
1130 return r;
1131 }
1132
1133 static struct unrhdr *
chn_getunr(struct snddev_info * d,int type)1134 chn_getunr(struct snddev_info *d, int type)
1135 {
1136 switch (type) {
1137 case PCMDIR_PLAY:
1138 return (d->p_unr);
1139 case PCMDIR_PLAY_VIRTUAL:
1140 return (d->vp_unr);
1141 case PCMDIR_REC:
1142 return (d->r_unr);
1143 case PCMDIR_REC_VIRTUAL:
1144 return (d->vr_unr);
1145 default:
1146 __assert_unreachable();
1147 }
1148
1149 }
1150
1151 char *
chn_mkname(char * buf,size_t len,struct pcm_channel * c)1152 chn_mkname(char *buf, size_t len, struct pcm_channel *c)
1153 {
1154 const char *str;
1155
1156 KASSERT(buf != NULL && len != 0,
1157 ("%s(): bogus buf=%p len=%zu", __func__, buf, len));
1158
1159 switch (c->type) {
1160 case PCMDIR_PLAY:
1161 str = "play";
1162 break;
1163 case PCMDIR_PLAY_VIRTUAL:
1164 str = "virtual_play";
1165 break;
1166 case PCMDIR_REC:
1167 str = "record";
1168 break;
1169 case PCMDIR_REC_VIRTUAL:
1170 str = "virtual_record";
1171 break;
1172 default:
1173 __assert_unreachable();
1174 }
1175
1176 snprintf(buf, len, "dsp%d.%s.%d",
1177 device_get_unit(c->dev), str, c->unit);
1178
1179 return (buf);
1180 }
1181
1182 struct pcm_channel *
chn_init(struct snddev_info * d,struct pcm_channel * parent,kobj_class_t cls,int dir,void * devinfo)1183 chn_init(struct snddev_info *d, struct pcm_channel *parent, kobj_class_t cls,
1184 int dir, void *devinfo)
1185 {
1186 struct pcm_channel *c;
1187 struct feeder_class *fc;
1188 struct snd_dbuf *b, *bs;
1189 char buf[CHN_NAMELEN];
1190 int err, i, direction, *vchanrate, *vchanformat;
1191
1192 PCM_BUSYASSERT(d);
1193 PCM_LOCKASSERT(d);
1194
1195 switch (dir) {
1196 case PCMDIR_PLAY:
1197 d->playcount++;
1198 /* FALLTHROUGH */
1199 case PCMDIR_PLAY_VIRTUAL:
1200 if (dir == PCMDIR_PLAY_VIRTUAL)
1201 d->pvchancount++;
1202 direction = PCMDIR_PLAY;
1203 vchanrate = &d->pvchanrate;
1204 vchanformat = &d->pvchanformat;
1205 break;
1206 case PCMDIR_REC:
1207 d->reccount++;
1208 /* FALLTHROUGH */
1209 case PCMDIR_REC_VIRTUAL:
1210 if (dir == PCMDIR_REC_VIRTUAL)
1211 d->rvchancount++;
1212 direction = PCMDIR_REC;
1213 vchanrate = &d->rvchanrate;
1214 vchanformat = &d->rvchanformat;
1215 break;
1216 default:
1217 device_printf(d->dev,
1218 "%s(): invalid channel direction: %d\n",
1219 __func__, dir);
1220 return (NULL);
1221 }
1222
1223 PCM_UNLOCK(d);
1224 b = NULL;
1225 bs = NULL;
1226
1227 c = malloc(sizeof(*c), M_DEVBUF, M_WAITOK | M_ZERO);
1228 c->methods = kobj_create(cls, M_DEVBUF, M_WAITOK | M_ZERO);
1229 chn_lockinit(c, dir);
1230 CHN_INIT(c, children);
1231 CHN_INIT(c, children.busy);
1232 c->direction = direction;
1233 c->type = dir;
1234 c->unit = alloc_unr(chn_getunr(d, c->type));
1235 c->format = SND_FORMAT(AFMT_S16_LE, 2, 0);
1236 c->speed = 48000;
1237 c->pid = -1;
1238 c->latency = -1;
1239 c->timeout = 1;
1240 strlcpy(c->comm, CHN_COMM_UNUSED, sizeof(c->comm));
1241 c->parentsnddev = d;
1242 c->parentchannel = parent;
1243 c->dev = d->dev;
1244 c->trigger = PCMTRIG_STOP;
1245 strlcpy(c->name, chn_mkname(buf, sizeof(buf), c), sizeof(c->name));
1246
1247 c->matrix = *feeder_matrix_id_map(SND_CHN_MATRIX_1_0);
1248 c->matrix.id = SND_CHN_MATRIX_PCMCHANNEL;
1249
1250 for (i = 0; i < SND_CHN_T_MAX; i++)
1251 c->volume[SND_VOL_C_MASTER][i] = SND_VOL_0DB_MASTER;
1252
1253 c->volume[SND_VOL_C_MASTER][SND_CHN_T_VOL_0DB] = SND_VOL_0DB_MASTER;
1254 c->volume[SND_VOL_C_PCM][SND_CHN_T_VOL_0DB] = chn_vol_0db_pcm;
1255
1256 CHN_LOCK(c);
1257 chn_vpc_reset(c, SND_VOL_C_PCM, 1);
1258 CHN_UNLOCK(c);
1259
1260 fc = feeder_getclass(NULL);
1261 if (fc == NULL) {
1262 device_printf(d->dev, "%s(): failed to get feeder class\n",
1263 __func__);
1264 goto fail;
1265 }
1266 if (feeder_add(c, fc, NULL)) {
1267 device_printf(d->dev, "%s(): failed to add feeder\n", __func__);
1268 goto fail;
1269 }
1270
1271 b = sndbuf_create(c->dev, c->name, "primary", c);
1272 bs = sndbuf_create(c->dev, c->name, "secondary", c);
1273 if (b == NULL || bs == NULL) {
1274 device_printf(d->dev, "%s(): failed to create %s buffer\n",
1275 __func__, b == NULL ? "hardware" : "software");
1276 goto fail;
1277 }
1278 c->bufhard = b;
1279 c->bufsoft = bs;
1280
1281 c->devinfo = CHANNEL_INIT(c->methods, devinfo, b, c, direction);
1282 if (c->devinfo == NULL) {
1283 device_printf(d->dev, "%s(): CHANNEL_INIT() failed\n", __func__);
1284 goto fail;
1285 }
1286
1287 if ((sndbuf_getsize(b) == 0) && ((c->flags & CHN_F_VIRTUAL) == 0)) {
1288 device_printf(d->dev, "%s(): hardware buffer's size is 0\n",
1289 __func__);
1290 goto fail;
1291 }
1292
1293 sndbuf_setfmt(b, c->format);
1294 sndbuf_setspd(b, c->speed);
1295 sndbuf_setfmt(bs, c->format);
1296 sndbuf_setspd(bs, c->speed);
1297 sndbuf_setup(bs, NULL, 0);
1298
1299 /**
1300 * @todo Should this be moved somewhere else? The primary buffer
1301 * is allocated by the driver or via DMA map setup, and tmpbuf
1302 * seems to only come into existence in sndbuf_resize().
1303 */
1304 if (c->direction == PCMDIR_PLAY) {
1305 bs->sl = sndbuf_getmaxsize(bs);
1306 bs->shadbuf = malloc(bs->sl, M_DEVBUF, M_WAITOK);
1307 }
1308
1309 if ((c->flags & CHN_F_VIRTUAL) == 0) {
1310 CHN_LOCK(c);
1311 err = chn_reset(c, c->format, c->speed);
1312 CHN_UNLOCK(c);
1313 if (err != 0)
1314 goto fail;
1315 }
1316
1317 PCM_LOCK(d);
1318 CHN_INSERT_SORT_ASCEND(d, c, channels.pcm);
1319 if ((c->flags & CHN_F_VIRTUAL) == 0) {
1320 CHN_INSERT_SORT_ASCEND(d, c, channels.pcm.primary);
1321 /* Initialize the *vchanrate/vchanformat parameters. */
1322 *vchanrate = sndbuf_getspd(c->bufsoft);
1323 *vchanformat = sndbuf_getfmt(c->bufsoft);
1324 }
1325
1326 return (c);
1327
1328 fail:
1329 chn_kill(c);
1330 PCM_LOCK(d);
1331
1332 return (NULL);
1333 }
1334
1335 void
chn_kill(struct pcm_channel * c)1336 chn_kill(struct pcm_channel *c)
1337 {
1338 struct snddev_info *d = c->parentsnddev;
1339 struct snd_dbuf *b = c->bufhard;
1340 struct snd_dbuf *bs = c->bufsoft;
1341
1342 PCM_BUSYASSERT(c->parentsnddev);
1343
1344 PCM_LOCK(d);
1345 CHN_REMOVE(d, c, channels.pcm);
1346 if ((c->flags & CHN_F_VIRTUAL) == 0)
1347 CHN_REMOVE(d, c, channels.pcm.primary);
1348
1349 switch (c->type) {
1350 case PCMDIR_PLAY:
1351 d->playcount--;
1352 break;
1353 case PCMDIR_PLAY_VIRTUAL:
1354 d->pvchancount--;
1355 break;
1356 case PCMDIR_REC:
1357 d->reccount--;
1358 break;
1359 case PCMDIR_REC_VIRTUAL:
1360 d->rvchancount--;
1361 break;
1362 default:
1363 __assert_unreachable();
1364 }
1365 PCM_UNLOCK(d);
1366
1367 if (CHN_STARTED(c)) {
1368 CHN_LOCK(c);
1369 chn_trigger(c, PCMTRIG_ABORT);
1370 CHN_UNLOCK(c);
1371 }
1372 free_unr(chn_getunr(d, c->type), c->unit);
1373 feeder_remove(c);
1374 if (c->devinfo && CHANNEL_FREE(c->methods, c->devinfo))
1375 sndbuf_free(b);
1376 if (bs)
1377 sndbuf_destroy(bs);
1378 if (b)
1379 sndbuf_destroy(b);
1380 CHN_LOCK(c);
1381 c->flags |= CHN_F_DEAD;
1382 chn_lockdestroy(c);
1383 kobj_delete(c->methods, M_DEVBUF);
1384 free(c, M_DEVBUF);
1385 }
1386
1387 void
chn_shutdown(struct pcm_channel * c)1388 chn_shutdown(struct pcm_channel *c)
1389 {
1390 CHN_LOCKASSERT(c);
1391
1392 chn_wakeup(c);
1393 c->flags |= CHN_F_DEAD;
1394 }
1395
1396 /* release a locked channel and unlock it */
1397 int
chn_release(struct pcm_channel * c)1398 chn_release(struct pcm_channel *c)
1399 {
1400 PCM_BUSYASSERT(c->parentsnddev);
1401 CHN_LOCKASSERT(c);
1402
1403 c->flags &= ~CHN_F_BUSY;
1404 c->pid = -1;
1405 strlcpy(c->comm, CHN_COMM_UNUSED, sizeof(c->comm));
1406 CHN_UNLOCK(c);
1407
1408 return (0);
1409 }
1410
1411 int
chn_setvolume_multi(struct pcm_channel * c,int vc,int left,int right,int center)1412 chn_setvolume_multi(struct pcm_channel *c, int vc, int left, int right,
1413 int center)
1414 {
1415 int i, ret;
1416
1417 ret = 0;
1418
1419 for (i = 0; i < SND_CHN_T_MAX; i++) {
1420 if ((1 << i) & SND_CHN_LEFT_MASK)
1421 ret |= chn_setvolume_matrix(c, vc, i, left);
1422 else if ((1 << i) & SND_CHN_RIGHT_MASK)
1423 ret |= chn_setvolume_matrix(c, vc, i, right) << 8;
1424 else
1425 ret |= chn_setvolume_matrix(c, vc, i, center) << 16;
1426 }
1427
1428 return (ret);
1429 }
1430
1431 int
chn_setvolume_matrix(struct pcm_channel * c,int vc,int vt,int val)1432 chn_setvolume_matrix(struct pcm_channel *c, int vc, int vt, int val)
1433 {
1434 int i;
1435
1436 KASSERT(c != NULL && vc >= SND_VOL_C_MASTER && vc < SND_VOL_C_MAX &&
1437 (vc == SND_VOL_C_MASTER || (vc & 1)) &&
1438 (vt == SND_CHN_T_VOL_0DB || (vt >= SND_CHN_T_BEGIN &&
1439 vt <= SND_CHN_T_END)) && (vt != SND_CHN_T_VOL_0DB ||
1440 (val >= SND_VOL_0DB_MIN && val <= SND_VOL_0DB_MAX)),
1441 ("%s(): invalid volume matrix c=%p vc=%d vt=%d val=%d",
1442 __func__, c, vc, vt, val));
1443 CHN_LOCKASSERT(c);
1444
1445 if (val < 0)
1446 val = 0;
1447 if (val > 100)
1448 val = 100;
1449
1450 c->volume[vc][vt] = val;
1451
1452 /*
1453 * Do relative calculation here and store it into class + 1
1454 * to ease the job of feeder_volume.
1455 */
1456 if (vc == SND_VOL_C_MASTER) {
1457 for (vc = SND_VOL_C_BEGIN; vc <= SND_VOL_C_END;
1458 vc += SND_VOL_C_STEP)
1459 c->volume[SND_VOL_C_VAL(vc)][vt] =
1460 SND_VOL_CALC_VAL(c->volume, vc, vt);
1461 } else if (vc & 1) {
1462 if (vt == SND_CHN_T_VOL_0DB)
1463 for (i = SND_CHN_T_BEGIN; i <= SND_CHN_T_END;
1464 i += SND_CHN_T_STEP) {
1465 c->volume[SND_VOL_C_VAL(vc)][i] =
1466 SND_VOL_CALC_VAL(c->volume, vc, i);
1467 }
1468 else
1469 c->volume[SND_VOL_C_VAL(vc)][vt] =
1470 SND_VOL_CALC_VAL(c->volume, vc, vt);
1471 }
1472
1473 return (val);
1474 }
1475
1476 int
chn_getvolume_matrix(struct pcm_channel * c,int vc,int vt)1477 chn_getvolume_matrix(struct pcm_channel *c, int vc, int vt)
1478 {
1479 KASSERT(c != NULL && vc >= SND_VOL_C_MASTER && vc < SND_VOL_C_MAX &&
1480 (vt == SND_CHN_T_VOL_0DB ||
1481 (vt >= SND_CHN_T_BEGIN && vt <= SND_CHN_T_END)),
1482 ("%s(): invalid volume matrix c=%p vc=%d vt=%d",
1483 __func__, c, vc, vt));
1484 CHN_LOCKASSERT(c);
1485
1486 return (c->volume[vc][vt]);
1487 }
1488
1489 int
chn_setmute_multi(struct pcm_channel * c,int vc,int mute)1490 chn_setmute_multi(struct pcm_channel *c, int vc, int mute)
1491 {
1492 int i, ret;
1493
1494 ret = 0;
1495
1496 for (i = 0; i < SND_CHN_T_MAX; i++) {
1497 if ((1 << i) & SND_CHN_LEFT_MASK)
1498 ret |= chn_setmute_matrix(c, vc, i, mute);
1499 else if ((1 << i) & SND_CHN_RIGHT_MASK)
1500 ret |= chn_setmute_matrix(c, vc, i, mute) << 8;
1501 else
1502 ret |= chn_setmute_matrix(c, vc, i, mute) << 16;
1503 }
1504 return (ret);
1505 }
1506
1507 int
chn_setmute_matrix(struct pcm_channel * c,int vc,int vt,int mute)1508 chn_setmute_matrix(struct pcm_channel *c, int vc, int vt, int mute)
1509 {
1510 int i;
1511
1512 KASSERT(c != NULL && vc >= SND_VOL_C_MASTER && vc < SND_VOL_C_MAX &&
1513 (vc == SND_VOL_C_MASTER || (vc & 1)) &&
1514 (vt == SND_CHN_T_VOL_0DB || (vt >= SND_CHN_T_BEGIN && vt <= SND_CHN_T_END)),
1515 ("%s(): invalid mute matrix c=%p vc=%d vt=%d mute=%d",
1516 __func__, c, vc, vt, mute));
1517
1518 CHN_LOCKASSERT(c);
1519
1520 mute = (mute != 0);
1521
1522 c->muted[vc][vt] = mute;
1523
1524 /*
1525 * Do relative calculation here and store it into class + 1
1526 * to ease the job of feeder_volume.
1527 */
1528 if (vc == SND_VOL_C_MASTER) {
1529 for (vc = SND_VOL_C_BEGIN; vc <= SND_VOL_C_END;
1530 vc += SND_VOL_C_STEP)
1531 c->muted[SND_VOL_C_VAL(vc)][vt] = mute;
1532 } else if (vc & 1) {
1533 if (vt == SND_CHN_T_VOL_0DB) {
1534 for (i = SND_CHN_T_BEGIN; i <= SND_CHN_T_END;
1535 i += SND_CHN_T_STEP) {
1536 c->muted[SND_VOL_C_VAL(vc)][i] = mute;
1537 }
1538 } else {
1539 c->muted[SND_VOL_C_VAL(vc)][vt] = mute;
1540 }
1541 }
1542 return (mute);
1543 }
1544
1545 int
chn_getmute_matrix(struct pcm_channel * c,int vc,int vt)1546 chn_getmute_matrix(struct pcm_channel *c, int vc, int vt)
1547 {
1548 KASSERT(c != NULL && vc >= SND_VOL_C_MASTER && vc < SND_VOL_C_MAX &&
1549 (vt == SND_CHN_T_VOL_0DB ||
1550 (vt >= SND_CHN_T_BEGIN && vt <= SND_CHN_T_END)),
1551 ("%s(): invalid mute matrix c=%p vc=%d vt=%d",
1552 __func__, c, vc, vt));
1553 CHN_LOCKASSERT(c);
1554
1555 return (c->muted[vc][vt]);
1556 }
1557
1558 struct pcmchan_matrix *
chn_getmatrix(struct pcm_channel * c)1559 chn_getmatrix(struct pcm_channel *c)
1560 {
1561
1562 KASSERT(c != NULL, ("%s(): NULL channel", __func__));
1563 CHN_LOCKASSERT(c);
1564
1565 if (!(c->format & AFMT_CONVERTIBLE))
1566 return (NULL);
1567
1568 return (&c->matrix);
1569 }
1570
1571 int
chn_setmatrix(struct pcm_channel * c,struct pcmchan_matrix * m)1572 chn_setmatrix(struct pcm_channel *c, struct pcmchan_matrix *m)
1573 {
1574
1575 KASSERT(c != NULL && m != NULL,
1576 ("%s(): NULL channel or matrix", __func__));
1577 CHN_LOCKASSERT(c);
1578
1579 if (!(c->format & AFMT_CONVERTIBLE))
1580 return (EINVAL);
1581
1582 c->matrix = *m;
1583 c->matrix.id = SND_CHN_MATRIX_PCMCHANNEL;
1584
1585 return (chn_setformat(c, SND_FORMAT(c->format, m->channels, m->ext)));
1586 }
1587
1588 /*
1589 * XXX chn_oss_* exists for the sake of compatibility.
1590 */
1591 int
chn_oss_getorder(struct pcm_channel * c,unsigned long long * map)1592 chn_oss_getorder(struct pcm_channel *c, unsigned long long *map)
1593 {
1594
1595 KASSERT(c != NULL && map != NULL,
1596 ("%s(): NULL channel or map", __func__));
1597 CHN_LOCKASSERT(c);
1598
1599 if (!(c->format & AFMT_CONVERTIBLE))
1600 return (EINVAL);
1601
1602 return (feeder_matrix_oss_get_channel_order(&c->matrix, map));
1603 }
1604
1605 int
chn_oss_setorder(struct pcm_channel * c,unsigned long long * map)1606 chn_oss_setorder(struct pcm_channel *c, unsigned long long *map)
1607 {
1608 struct pcmchan_matrix m;
1609 int ret;
1610
1611 KASSERT(c != NULL && map != NULL,
1612 ("%s(): NULL channel or map", __func__));
1613 CHN_LOCKASSERT(c);
1614
1615 if (!(c->format & AFMT_CONVERTIBLE))
1616 return (EINVAL);
1617
1618 m = c->matrix;
1619 ret = feeder_matrix_oss_set_channel_order(&m, map);
1620 if (ret != 0)
1621 return (ret);
1622
1623 return (chn_setmatrix(c, &m));
1624 }
1625
1626 #define SND_CHN_OSS_FRONT (SND_CHN_T_MASK_FL | SND_CHN_T_MASK_FR)
1627 #define SND_CHN_OSS_SURR (SND_CHN_T_MASK_SL | SND_CHN_T_MASK_SR)
1628 #define SND_CHN_OSS_CENTER_LFE (SND_CHN_T_MASK_FC | SND_CHN_T_MASK_LF)
1629 #define SND_CHN_OSS_REAR (SND_CHN_T_MASK_BL | SND_CHN_T_MASK_BR)
1630
1631 int
chn_oss_getmask(struct pcm_channel * c,uint32_t * retmask)1632 chn_oss_getmask(struct pcm_channel *c, uint32_t *retmask)
1633 {
1634 struct pcmchan_matrix *m;
1635 struct pcmchan_caps *caps;
1636 uint32_t i, format;
1637
1638 KASSERT(c != NULL && retmask != NULL,
1639 ("%s(): NULL channel or retmask", __func__));
1640 CHN_LOCKASSERT(c);
1641
1642 caps = chn_getcaps(c);
1643 if (caps == NULL || caps->fmtlist == NULL)
1644 return (ENODEV);
1645
1646 for (i = 0; caps->fmtlist[i] != 0; i++) {
1647 format = caps->fmtlist[i];
1648 if (!(format & AFMT_CONVERTIBLE)) {
1649 *retmask |= DSP_BIND_SPDIF;
1650 continue;
1651 }
1652 m = CHANNEL_GETMATRIX(c->methods, c->devinfo, format);
1653 if (m == NULL)
1654 continue;
1655 if (m->mask & SND_CHN_OSS_FRONT)
1656 *retmask |= DSP_BIND_FRONT;
1657 if (m->mask & SND_CHN_OSS_SURR)
1658 *retmask |= DSP_BIND_SURR;
1659 if (m->mask & SND_CHN_OSS_CENTER_LFE)
1660 *retmask |= DSP_BIND_CENTER_LFE;
1661 if (m->mask & SND_CHN_OSS_REAR)
1662 *retmask |= DSP_BIND_REAR;
1663 }
1664
1665 /* report software-supported binding mask */
1666 if (!CHN_BITPERFECT(c) && report_soft_matrix)
1667 *retmask |= DSP_BIND_FRONT | DSP_BIND_SURR |
1668 DSP_BIND_CENTER_LFE | DSP_BIND_REAR;
1669
1670 return (0);
1671 }
1672
1673 void
chn_vpc_reset(struct pcm_channel * c,int vc,int force)1674 chn_vpc_reset(struct pcm_channel *c, int vc, int force)
1675 {
1676 int i;
1677
1678 KASSERT(c != NULL && vc >= SND_VOL_C_BEGIN && vc <= SND_VOL_C_END,
1679 ("%s(): invalid reset c=%p vc=%d", __func__, c, vc));
1680 CHN_LOCKASSERT(c);
1681
1682 if (force == 0 && chn_vpc_autoreset == 0)
1683 return;
1684
1685 for (i = SND_CHN_T_BEGIN; i <= SND_CHN_T_END; i += SND_CHN_T_STEP)
1686 CHN_SETVOLUME(c, vc, i, c->volume[vc][SND_CHN_T_VOL_0DB]);
1687 }
1688
1689 static u_int32_t
round_pow2(u_int32_t v)1690 round_pow2(u_int32_t v)
1691 {
1692 u_int32_t ret;
1693
1694 if (v < 2)
1695 v = 2;
1696 ret = 0;
1697 while (v >> ret)
1698 ret++;
1699 ret = 1 << (ret - 1);
1700 while (ret < v)
1701 ret <<= 1;
1702 return ret;
1703 }
1704
1705 static u_int32_t
round_blksz(u_int32_t v,int round)1706 round_blksz(u_int32_t v, int round)
1707 {
1708 u_int32_t ret, tmp;
1709
1710 if (round < 1)
1711 round = 1;
1712
1713 ret = min(round_pow2(v), CHN_2NDBUFMAXSIZE >> 1);
1714
1715 if (ret > v && (ret >> 1) > 0 && (ret >> 1) >= ((v * 3) >> 2))
1716 ret >>= 1;
1717
1718 tmp = ret - (ret % round);
1719 while (tmp < 16 || tmp < round) {
1720 ret <<= 1;
1721 tmp = ret - (ret % round);
1722 }
1723
1724 return ret;
1725 }
1726
1727 /*
1728 * 4Front call it DSP Policy, while we call it "Latency Profile". The idea
1729 * is to keep 2nd buffer short so that it doesn't cause long queue during
1730 * buffer transfer.
1731 *
1732 * Latency reference table for 48khz stereo 16bit: (PLAY)
1733 *
1734 * +---------+------------+-----------+------------+
1735 * | Latency | Blockcount | Blocksize | Buffersize |
1736 * +---------+------------+-----------+------------+
1737 * | 0 | 2 | 64 | 128 |
1738 * +---------+------------+-----------+------------+
1739 * | 1 | 4 | 128 | 512 |
1740 * +---------+------------+-----------+------------+
1741 * | 2 | 8 | 512 | 4096 |
1742 * +---------+------------+-----------+------------+
1743 * | 3 | 16 | 512 | 8192 |
1744 * +---------+------------+-----------+------------+
1745 * | 4 | 32 | 512 | 16384 |
1746 * +---------+------------+-----------+------------+
1747 * | 5 | 32 | 1024 | 32768 |
1748 * +---------+------------+-----------+------------+
1749 * | 6 | 16 | 2048 | 32768 |
1750 * +---------+------------+-----------+------------+
1751 * | 7 | 8 | 4096 | 32768 |
1752 * +---------+------------+-----------+------------+
1753 * | 8 | 4 | 8192 | 32768 |
1754 * +---------+------------+-----------+------------+
1755 * | 9 | 2 | 16384 | 32768 |
1756 * +---------+------------+-----------+------------+
1757 * | 10 | 2 | 32768 | 65536 |
1758 * +---------+------------+-----------+------------+
1759 *
1760 * Recording need a different reference table. All we care is
1761 * gobbling up everything within reasonable buffering threshold.
1762 *
1763 * Latency reference table for 48khz stereo 16bit: (REC)
1764 *
1765 * +---------+------------+-----------+------------+
1766 * | Latency | Blockcount | Blocksize | Buffersize |
1767 * +---------+------------+-----------+------------+
1768 * | 0 | 512 | 32 | 16384 |
1769 * +---------+------------+-----------+------------+
1770 * | 1 | 256 | 64 | 16384 |
1771 * +---------+------------+-----------+------------+
1772 * | 2 | 128 | 128 | 16384 |
1773 * +---------+------------+-----------+------------+
1774 * | 3 | 64 | 256 | 16384 |
1775 * +---------+------------+-----------+------------+
1776 * | 4 | 32 | 512 | 16384 |
1777 * +---------+------------+-----------+------------+
1778 * | 5 | 32 | 1024 | 32768 |
1779 * +---------+------------+-----------+------------+
1780 * | 6 | 16 | 2048 | 32768 |
1781 * +---------+------------+-----------+------------+
1782 * | 7 | 8 | 4096 | 32768 |
1783 * +---------+------------+-----------+------------+
1784 * | 8 | 4 | 8192 | 32768 |
1785 * +---------+------------+-----------+------------+
1786 * | 9 | 2 | 16384 | 32768 |
1787 * +---------+------------+-----------+------------+
1788 * | 10 | 2 | 32768 | 65536 |
1789 * +---------+------------+-----------+------------+
1790 *
1791 * Calculations for other data rate are entirely based on these reference
1792 * tables. For normal operation, Latency 5 seems give the best, well
1793 * balanced performance for typical workload. Anything below 5 will
1794 * eat up CPU to keep up with increasing context switches because of
1795 * shorter buffer space and usually require the application to handle it
1796 * aggressively through possibly real time programming technique.
1797 *
1798 */
1799 #define CHN_LATENCY_PBLKCNT_REF \
1800 {{1, 2, 3, 4, 5, 5, 4, 3, 2, 1, 1}, \
1801 {1, 2, 3, 4, 5, 5, 4, 3, 2, 1, 1}}
1802 #define CHN_LATENCY_PBUFSZ_REF \
1803 {{7, 9, 12, 13, 14, 15, 15, 15, 15, 15, 16}, \
1804 {11, 12, 13, 14, 15, 16, 16, 16, 16, 16, 17}}
1805
1806 #define CHN_LATENCY_RBLKCNT_REF \
1807 {{9, 8, 7, 6, 5, 5, 4, 3, 2, 1, 1}, \
1808 {9, 8, 7, 6, 5, 5, 4, 3, 2, 1, 1}}
1809 #define CHN_LATENCY_RBUFSZ_REF \
1810 {{14, 14, 14, 14, 14, 15, 15, 15, 15, 15, 16}, \
1811 {15, 15, 15, 15, 15, 16, 16, 16, 16, 16, 17}}
1812
1813 #define CHN_LATENCY_DATA_REF 192000 /* 48khz stereo 16bit ~ 48000 x 2 x 2 */
1814
1815 static int
chn_calclatency(int dir,int latency,int bps,u_int32_t datarate,u_int32_t max,int * rblksz,int * rblkcnt)1816 chn_calclatency(int dir, int latency, int bps, u_int32_t datarate,
1817 u_int32_t max, int *rblksz, int *rblkcnt)
1818 {
1819 static int pblkcnts[CHN_LATENCY_PROFILE_MAX + 1][CHN_LATENCY_MAX + 1] =
1820 CHN_LATENCY_PBLKCNT_REF;
1821 static int pbufszs[CHN_LATENCY_PROFILE_MAX + 1][CHN_LATENCY_MAX + 1] =
1822 CHN_LATENCY_PBUFSZ_REF;
1823 static int rblkcnts[CHN_LATENCY_PROFILE_MAX + 1][CHN_LATENCY_MAX + 1] =
1824 CHN_LATENCY_RBLKCNT_REF;
1825 static int rbufszs[CHN_LATENCY_PROFILE_MAX + 1][CHN_LATENCY_MAX + 1] =
1826 CHN_LATENCY_RBUFSZ_REF;
1827 u_int32_t bufsz;
1828 int lprofile, blksz, blkcnt;
1829
1830 if (latency < CHN_LATENCY_MIN || latency > CHN_LATENCY_MAX ||
1831 bps < 1 || datarate < 1 ||
1832 !(dir == PCMDIR_PLAY || dir == PCMDIR_REC)) {
1833 if (rblksz != NULL)
1834 *rblksz = CHN_2NDBUFMAXSIZE >> 1;
1835 if (rblkcnt != NULL)
1836 *rblkcnt = 2;
1837 printf("%s(): FAILED dir=%d latency=%d bps=%d "
1838 "datarate=%u max=%u\n",
1839 __func__, dir, latency, bps, datarate, max);
1840 return CHN_2NDBUFMAXSIZE;
1841 }
1842
1843 lprofile = chn_latency_profile;
1844
1845 if (dir == PCMDIR_PLAY) {
1846 blkcnt = pblkcnts[lprofile][latency];
1847 bufsz = pbufszs[lprofile][latency];
1848 } else {
1849 blkcnt = rblkcnts[lprofile][latency];
1850 bufsz = rbufszs[lprofile][latency];
1851 }
1852
1853 bufsz = round_pow2(snd_xbytes(1 << bufsz, CHN_LATENCY_DATA_REF,
1854 datarate));
1855 if (bufsz > max)
1856 bufsz = max;
1857 blksz = round_blksz(bufsz >> blkcnt, bps);
1858
1859 if (rblksz != NULL)
1860 *rblksz = blksz;
1861 if (rblkcnt != NULL)
1862 *rblkcnt = 1 << blkcnt;
1863
1864 return blksz << blkcnt;
1865 }
1866
1867 static int
chn_resizebuf(struct pcm_channel * c,int latency,int blkcnt,int blksz)1868 chn_resizebuf(struct pcm_channel *c, int latency,
1869 int blkcnt, int blksz)
1870 {
1871 struct snd_dbuf *b, *bs, *pb;
1872 int sblksz, sblkcnt, hblksz, hblkcnt, limit = 0, nsblksz, nsblkcnt;
1873 int ret;
1874
1875 CHN_LOCKASSERT(c);
1876
1877 if ((c->flags & (CHN_F_MMAP | CHN_F_TRIGGERED)) ||
1878 !(c->direction == PCMDIR_PLAY || c->direction == PCMDIR_REC))
1879 return EINVAL;
1880
1881 if (latency == -1) {
1882 c->latency = -1;
1883 latency = chn_latency;
1884 } else if (latency == -2) {
1885 latency = c->latency;
1886 if (latency < CHN_LATENCY_MIN || latency > CHN_LATENCY_MAX)
1887 latency = chn_latency;
1888 } else if (latency < CHN_LATENCY_MIN || latency > CHN_LATENCY_MAX)
1889 return EINVAL;
1890 else {
1891 c->latency = latency;
1892 }
1893
1894 bs = c->bufsoft;
1895 b = c->bufhard;
1896
1897 if (!(blksz == 0 || blkcnt == -1) &&
1898 (blksz < 16 || blksz < sndbuf_getalign(bs) || blkcnt < 2 ||
1899 (blksz * blkcnt) > CHN_2NDBUFMAXSIZE))
1900 return EINVAL;
1901
1902 chn_calclatency(c->direction, latency, sndbuf_getalign(bs),
1903 sndbuf_getalign(bs) * sndbuf_getspd(bs), CHN_2NDBUFMAXSIZE,
1904 &sblksz, &sblkcnt);
1905
1906 if (blksz == 0 || blkcnt == -1) {
1907 if (blkcnt == -1)
1908 c->flags &= ~CHN_F_HAS_SIZE;
1909 if (c->flags & CHN_F_HAS_SIZE) {
1910 blksz = sndbuf_getblksz(bs);
1911 blkcnt = sndbuf_getblkcnt(bs);
1912 }
1913 } else
1914 c->flags |= CHN_F_HAS_SIZE;
1915
1916 if (c->flags & CHN_F_HAS_SIZE) {
1917 /*
1918 * The application has requested their own blksz/blkcnt.
1919 * Just obey with it, and let them toast alone. We can
1920 * clamp it to the nearest latency profile, but that would
1921 * defeat the purpose of having custom control. The least
1922 * we can do is round it to the nearest ^2 and align it.
1923 */
1924 sblksz = round_blksz(blksz, sndbuf_getalign(bs));
1925 sblkcnt = round_pow2(blkcnt);
1926 }
1927
1928 if (c->parentchannel != NULL) {
1929 pb = c->parentchannel->bufsoft;
1930 CHN_UNLOCK(c);
1931 CHN_LOCK(c->parentchannel);
1932 chn_notify(c->parentchannel, CHN_N_BLOCKSIZE);
1933 CHN_UNLOCK(c->parentchannel);
1934 CHN_LOCK(c);
1935 if (c->direction == PCMDIR_PLAY) {
1936 limit = (pb != NULL) ?
1937 sndbuf_xbytes(sndbuf_getsize(pb), pb, bs) : 0;
1938 } else {
1939 limit = (pb != NULL) ?
1940 sndbuf_xbytes(sndbuf_getblksz(pb), pb, bs) * 2 : 0;
1941 }
1942 } else {
1943 hblkcnt = 2;
1944 if (c->flags & CHN_F_HAS_SIZE) {
1945 hblksz = round_blksz(sndbuf_xbytes(sblksz, bs, b),
1946 sndbuf_getalign(b));
1947 hblkcnt = round_pow2(sndbuf_getblkcnt(bs));
1948 } else
1949 chn_calclatency(c->direction, latency,
1950 sndbuf_getalign(b),
1951 sndbuf_getalign(b) * sndbuf_getspd(b),
1952 CHN_2NDBUFMAXSIZE, &hblksz, &hblkcnt);
1953
1954 if ((hblksz << 1) > sndbuf_getmaxsize(b))
1955 hblksz = round_blksz(sndbuf_getmaxsize(b) >> 1,
1956 sndbuf_getalign(b));
1957
1958 while ((hblksz * hblkcnt) > sndbuf_getmaxsize(b)) {
1959 if (hblkcnt < 4)
1960 hblksz >>= 1;
1961 else
1962 hblkcnt >>= 1;
1963 }
1964
1965 hblksz -= hblksz % sndbuf_getalign(b);
1966
1967 CHN_UNLOCK(c);
1968 if (chn_usefrags == 0 ||
1969 CHANNEL_SETFRAGMENTS(c->methods, c->devinfo,
1970 hblksz, hblkcnt) != 0)
1971 sndbuf_setblksz(b, CHANNEL_SETBLOCKSIZE(c->methods,
1972 c->devinfo, hblksz));
1973 CHN_LOCK(c);
1974
1975 if (!CHN_EMPTY(c, children)) {
1976 nsblksz = round_blksz(
1977 sndbuf_xbytes(sndbuf_getblksz(b), b, bs),
1978 sndbuf_getalign(bs));
1979 nsblkcnt = sndbuf_getblkcnt(b);
1980 if (c->direction == PCMDIR_PLAY) {
1981 do {
1982 nsblkcnt--;
1983 } while (nsblkcnt >= 2 &&
1984 nsblksz * nsblkcnt >= sblksz * sblkcnt);
1985 nsblkcnt++;
1986 }
1987 sblksz = nsblksz;
1988 sblkcnt = nsblkcnt;
1989 limit = 0;
1990 } else
1991 limit = sndbuf_xbytes(sndbuf_getblksz(b), b, bs) * 2;
1992 }
1993
1994 if (limit > CHN_2NDBUFMAXSIZE)
1995 limit = CHN_2NDBUFMAXSIZE;
1996
1997 while ((sblksz * sblkcnt) < limit)
1998 sblkcnt <<= 1;
1999
2000 while ((sblksz * sblkcnt) > CHN_2NDBUFMAXSIZE) {
2001 if (sblkcnt < 4)
2002 sblksz >>= 1;
2003 else
2004 sblkcnt >>= 1;
2005 }
2006
2007 sblksz -= sblksz % sndbuf_getalign(bs);
2008
2009 if (sndbuf_getblkcnt(bs) != sblkcnt || sndbuf_getblksz(bs) != sblksz ||
2010 sndbuf_getsize(bs) != (sblkcnt * sblksz)) {
2011 ret = sndbuf_remalloc(bs, sblkcnt, sblksz);
2012 if (ret != 0) {
2013 device_printf(c->dev, "%s(): Failed: %d %d\n",
2014 __func__, sblkcnt, sblksz);
2015 return ret;
2016 }
2017 }
2018
2019 /*
2020 * Interrupt timeout
2021 */
2022 c->timeout = ((u_int64_t)hz * sndbuf_getsize(bs)) /
2023 ((u_int64_t)sndbuf_getspd(bs) * sndbuf_getalign(bs));
2024 if (c->parentchannel != NULL)
2025 c->timeout = min(c->timeout, c->parentchannel->timeout);
2026 if (c->timeout < 1)
2027 c->timeout = 1;
2028
2029 /*
2030 * OSSv4 docs: "By default OSS will set the low water level equal
2031 * to the fragment size which is optimal in most cases."
2032 */
2033 c->lw = sndbuf_getblksz(bs);
2034 chn_resetbuf(c);
2035
2036 if (snd_verbose > 3)
2037 device_printf(c->dev, "%s(): %s (%s) timeout=%u "
2038 "b[%d/%d/%d] bs[%d/%d/%d] limit=%d\n",
2039 __func__, CHN_DIRSTR(c),
2040 (c->flags & CHN_F_VIRTUAL) ? "virtual" : "hardware",
2041 c->timeout,
2042 sndbuf_getsize(b), sndbuf_getblksz(b),
2043 sndbuf_getblkcnt(b),
2044 sndbuf_getsize(bs), sndbuf_getblksz(bs),
2045 sndbuf_getblkcnt(bs), limit);
2046
2047 return 0;
2048 }
2049
2050 int
chn_setlatency(struct pcm_channel * c,int latency)2051 chn_setlatency(struct pcm_channel *c, int latency)
2052 {
2053 CHN_LOCKASSERT(c);
2054 /* Destroy blksz/blkcnt, enforce latency profile. */
2055 return chn_resizebuf(c, latency, -1, 0);
2056 }
2057
2058 int
chn_setblocksize(struct pcm_channel * c,int blkcnt,int blksz)2059 chn_setblocksize(struct pcm_channel *c, int blkcnt, int blksz)
2060 {
2061 CHN_LOCKASSERT(c);
2062 /* Destroy latency profile, enforce blksz/blkcnt */
2063 return chn_resizebuf(c, -1, blkcnt, blksz);
2064 }
2065
2066 int
chn_setparam(struct pcm_channel * c,uint32_t format,uint32_t speed)2067 chn_setparam(struct pcm_channel *c, uint32_t format, uint32_t speed)
2068 {
2069 struct pcmchan_caps *caps;
2070 uint32_t hwspeed, delta;
2071 int ret;
2072
2073 CHN_LOCKASSERT(c);
2074
2075 if (speed < 1 || format == 0 || CHN_STARTED(c))
2076 return (EINVAL);
2077
2078 c->format = format;
2079 c->speed = speed;
2080
2081 caps = chn_getcaps(c);
2082
2083 hwspeed = speed;
2084 RANGE(hwspeed, caps->minspeed, caps->maxspeed);
2085
2086 sndbuf_setspd(c->bufhard, CHANNEL_SETSPEED(c->methods, c->devinfo,
2087 hwspeed));
2088 hwspeed = sndbuf_getspd(c->bufhard);
2089
2090 delta = (hwspeed > speed) ? (hwspeed - speed) : (speed - hwspeed);
2091
2092 if (delta <= feeder_rate_round)
2093 c->speed = hwspeed;
2094
2095 ret = feeder_chain(c);
2096
2097 if (ret == 0)
2098 ret = CHANNEL_SETFORMAT(c->methods, c->devinfo,
2099 sndbuf_getfmt(c->bufhard));
2100
2101 if (ret == 0)
2102 ret = chn_resizebuf(c, -2, 0, 0);
2103
2104 return (ret);
2105 }
2106
2107 int
chn_setspeed(struct pcm_channel * c,uint32_t speed)2108 chn_setspeed(struct pcm_channel *c, uint32_t speed)
2109 {
2110 uint32_t oldformat, oldspeed;
2111 int ret;
2112
2113 oldformat = c->format;
2114 oldspeed = c->speed;
2115
2116 if (c->speed == speed)
2117 return (0);
2118
2119 ret = chn_setparam(c, c->format, speed);
2120 if (ret != 0) {
2121 if (snd_verbose > 3)
2122 device_printf(c->dev,
2123 "%s(): Setting speed %d failed, "
2124 "falling back to %d\n",
2125 __func__, speed, oldspeed);
2126 chn_setparam(c, oldformat, oldspeed);
2127 }
2128
2129 return (ret);
2130 }
2131
2132 int
chn_setformat(struct pcm_channel * c,uint32_t format)2133 chn_setformat(struct pcm_channel *c, uint32_t format)
2134 {
2135 uint32_t oldformat, oldspeed;
2136 int ret;
2137
2138 /* XXX force stereo */
2139 if ((format & AFMT_PASSTHROUGH) && AFMT_CHANNEL(format) < 2) {
2140 format = SND_FORMAT(format, AFMT_PASSTHROUGH_CHANNEL,
2141 AFMT_PASSTHROUGH_EXTCHANNEL);
2142 }
2143
2144 oldformat = c->format;
2145 oldspeed = c->speed;
2146
2147 if (c->format == format)
2148 return (0);
2149
2150 ret = chn_setparam(c, format, c->speed);
2151 if (ret != 0) {
2152 if (snd_verbose > 3)
2153 device_printf(c->dev,
2154 "%s(): Format change 0x%08x failed, "
2155 "falling back to 0x%08x\n",
2156 __func__, format, oldformat);
2157 chn_setparam(c, oldformat, oldspeed);
2158 }
2159
2160 return (ret);
2161 }
2162
2163 void
chn_syncstate(struct pcm_channel * c)2164 chn_syncstate(struct pcm_channel *c)
2165 {
2166 struct snddev_info *d;
2167 struct snd_mixer *m;
2168
2169 d = (c != NULL) ? c->parentsnddev : NULL;
2170 m = (d != NULL && d->mixer_dev != NULL) ? d->mixer_dev->si_drv1 :
2171 NULL;
2172
2173 if (d == NULL || m == NULL)
2174 return;
2175
2176 CHN_LOCKASSERT(c);
2177
2178 if (c->feederflags & (1 << FEEDER_VOLUME)) {
2179 uint32_t parent;
2180 int vol, pvol, left, right, center;
2181
2182 if (c->direction == PCMDIR_PLAY &&
2183 (d->flags & SD_F_SOFTPCMVOL)) {
2184 /* CHN_UNLOCK(c); */
2185 vol = mix_get(m, SOUND_MIXER_PCM);
2186 parent = mix_getparent(m, SOUND_MIXER_PCM);
2187 if (parent != SOUND_MIXER_NONE)
2188 pvol = mix_get(m, parent);
2189 else
2190 pvol = 100 | (100 << 8);
2191 /* CHN_LOCK(c); */
2192 } else {
2193 vol = 100 | (100 << 8);
2194 pvol = vol;
2195 }
2196
2197 if (vol == -1) {
2198 device_printf(c->dev,
2199 "Soft PCM Volume: Failed to read pcm "
2200 "default value\n");
2201 vol = 100 | (100 << 8);
2202 }
2203
2204 if (pvol == -1) {
2205 device_printf(c->dev,
2206 "Soft PCM Volume: Failed to read parent "
2207 "default value\n");
2208 pvol = 100 | (100 << 8);
2209 }
2210
2211 left = ((vol & 0x7f) * (pvol & 0x7f)) / 100;
2212 right = (((vol >> 8) & 0x7f) * ((pvol >> 8) & 0x7f)) / 100;
2213 center = (left + right) >> 1;
2214
2215 chn_setvolume_multi(c, SND_VOL_C_MASTER, left, right, center);
2216 }
2217
2218 if (c->feederflags & (1 << FEEDER_EQ)) {
2219 struct pcm_feeder *f;
2220 int treble, bass, state;
2221
2222 /* CHN_UNLOCK(c); */
2223 treble = mix_get(m, SOUND_MIXER_TREBLE);
2224 bass = mix_get(m, SOUND_MIXER_BASS);
2225 /* CHN_LOCK(c); */
2226
2227 if (treble == -1)
2228 treble = 50;
2229 else
2230 treble = ((treble & 0x7f) +
2231 ((treble >> 8) & 0x7f)) >> 1;
2232
2233 if (bass == -1)
2234 bass = 50;
2235 else
2236 bass = ((bass & 0x7f) + ((bass >> 8) & 0x7f)) >> 1;
2237
2238 f = feeder_find(c, FEEDER_EQ);
2239 if (f != NULL) {
2240 if (FEEDER_SET(f, FEEDEQ_TREBLE, treble) != 0)
2241 device_printf(c->dev,
2242 "EQ: Failed to set treble -- %d\n",
2243 treble);
2244 if (FEEDER_SET(f, FEEDEQ_BASS, bass) != 0)
2245 device_printf(c->dev,
2246 "EQ: Failed to set bass -- %d\n",
2247 bass);
2248 if (FEEDER_SET(f, FEEDEQ_PREAMP, d->eqpreamp) != 0)
2249 device_printf(c->dev,
2250 "EQ: Failed to set preamp -- %d\n",
2251 d->eqpreamp);
2252 if (d->flags & SD_F_EQ_BYPASSED)
2253 state = FEEDEQ_BYPASS;
2254 else if (d->flags & SD_F_EQ_ENABLED)
2255 state = FEEDEQ_ENABLE;
2256 else
2257 state = FEEDEQ_DISABLE;
2258 if (FEEDER_SET(f, FEEDEQ_STATE, state) != 0)
2259 device_printf(c->dev,
2260 "EQ: Failed to set state -- %d\n", state);
2261 }
2262 }
2263 }
2264
2265 int
chn_trigger(struct pcm_channel * c,int go)2266 chn_trigger(struct pcm_channel *c, int go)
2267 {
2268 struct snddev_info *d = c->parentsnddev;
2269 int ret;
2270
2271 CHN_LOCKASSERT(c);
2272 if (!PCMTRIG_COMMON(go))
2273 return (CHANNEL_TRIGGER(c->methods, c->devinfo, go));
2274
2275 if (go == c->trigger)
2276 return (0);
2277
2278 if (snd_verbose > 3) {
2279 device_printf(c->dev, "%s() %s: calling go=0x%08x , "
2280 "prev=0x%08x\n", __func__, c->name, go, c->trigger);
2281 }
2282
2283 c->trigger = go;
2284 ret = CHANNEL_TRIGGER(c->methods, c->devinfo, go);
2285 if (ret != 0)
2286 return (ret);
2287
2288 CHN_UNLOCK(c);
2289 PCM_LOCK(d);
2290 CHN_LOCK(c);
2291
2292 /*
2293 * Do nothing if another thread set a different trigger while we had
2294 * dropped the mutex.
2295 */
2296 if (go != c->trigger) {
2297 PCM_UNLOCK(d);
2298 return (0);
2299 }
2300
2301 /*
2302 * Use the SAFE variants to prevent inserting/removing an already
2303 * existing/missing element.
2304 */
2305 switch (go) {
2306 case PCMTRIG_START:
2307 CHN_INSERT_HEAD_SAFE(d, c, channels.pcm.busy);
2308 PCM_UNLOCK(d);
2309 chn_syncstate(c);
2310 break;
2311 case PCMTRIG_STOP:
2312 case PCMTRIG_ABORT:
2313 CHN_REMOVE(d, c, channels.pcm.busy);
2314 PCM_UNLOCK(d);
2315 break;
2316 default:
2317 PCM_UNLOCK(d);
2318 break;
2319 }
2320
2321 return (0);
2322 }
2323
2324 /**
2325 * @brief Queries sound driver for sample-aligned hardware buffer pointer index
2326 *
2327 * This function obtains the hardware pointer location, then aligns it to
2328 * the current bytes-per-sample value before returning. (E.g., a channel
2329 * running in 16 bit stereo mode would require 4 bytes per sample, so a
2330 * hwptr value ranging from 32-35 would be returned as 32.)
2331 *
2332 * @param c PCM channel context
2333 * @returns sample-aligned hardware buffer pointer index
2334 */
2335 int
chn_getptr(struct pcm_channel * c)2336 chn_getptr(struct pcm_channel *c)
2337 {
2338 int hwptr;
2339
2340 CHN_LOCKASSERT(c);
2341 hwptr = (CHN_STARTED(c)) ? CHANNEL_GETPTR(c->methods, c->devinfo) : 0;
2342 return (hwptr - (hwptr % sndbuf_getalign(c->bufhard)));
2343 }
2344
2345 struct pcmchan_caps *
chn_getcaps(struct pcm_channel * c)2346 chn_getcaps(struct pcm_channel *c)
2347 {
2348 CHN_LOCKASSERT(c);
2349 return CHANNEL_GETCAPS(c->methods, c->devinfo);
2350 }
2351
2352 u_int32_t
chn_getformats(struct pcm_channel * c)2353 chn_getformats(struct pcm_channel *c)
2354 {
2355 u_int32_t *fmtlist, fmts;
2356 int i;
2357
2358 fmtlist = chn_getcaps(c)->fmtlist;
2359 fmts = 0;
2360 for (i = 0; fmtlist[i]; i++)
2361 fmts |= fmtlist[i];
2362
2363 /* report software-supported formats */
2364 if (!CHN_BITPERFECT(c) && report_soft_formats)
2365 fmts |= AFMT_CONVERTIBLE;
2366
2367 return (AFMT_ENCODING(fmts));
2368 }
2369
2370 int
chn_notify(struct pcm_channel * c,u_int32_t flags)2371 chn_notify(struct pcm_channel *c, u_int32_t flags)
2372 {
2373 struct pcm_channel *ch;
2374 struct pcmchan_caps *caps;
2375 uint32_t bestformat, bestspeed, besthwformat, *vchanformat, *vchanrate;
2376 uint32_t vpflags;
2377 int dirty, err, run, nrun;
2378
2379 CHN_LOCKASSERT(c);
2380
2381 if (CHN_EMPTY(c, children))
2382 return (0);
2383
2384 err = 0;
2385
2386 /*
2387 * If the hwchan is running, we can't change its rate, format or
2388 * blocksize
2389 */
2390 run = (CHN_STARTED(c)) ? 1 : 0;
2391 if (run)
2392 flags &= CHN_N_VOLUME | CHN_N_TRIGGER;
2393
2394 if (flags & CHN_N_RATE) {
2395 /*
2396 * XXX I'll make good use of this someday.
2397 * However this is currently being superseded by
2398 * the availability of CHN_F_VCHAN_DYNAMIC.
2399 */
2400 }
2401
2402 if (flags & CHN_N_FORMAT) {
2403 /*
2404 * XXX I'll make good use of this someday.
2405 * However this is currently being superseded by
2406 * the availability of CHN_F_VCHAN_DYNAMIC.
2407 */
2408 }
2409
2410 if (flags & CHN_N_VOLUME) {
2411 /*
2412 * XXX I'll make good use of this someday, though
2413 * soft volume control is currently pretty much
2414 * integrated.
2415 */
2416 }
2417
2418 if (flags & CHN_N_BLOCKSIZE) {
2419 /*
2420 * Set to default latency profile
2421 */
2422 chn_setlatency(c, chn_latency);
2423 }
2424
2425 if ((flags & CHN_N_TRIGGER) && !(c->flags & CHN_F_VCHAN_DYNAMIC)) {
2426 nrun = CHN_EMPTY(c, children.busy) ? 0 : 1;
2427 if (nrun && !run)
2428 err = chn_start(c, 1);
2429 if (!nrun && run)
2430 chn_abort(c);
2431 flags &= ~CHN_N_TRIGGER;
2432 }
2433
2434 if (flags & CHN_N_TRIGGER) {
2435 if (c->direction == PCMDIR_PLAY) {
2436 vchanformat = &c->parentsnddev->pvchanformat;
2437 vchanrate = &c->parentsnddev->pvchanrate;
2438 } else {
2439 vchanformat = &c->parentsnddev->rvchanformat;
2440 vchanrate = &c->parentsnddev->rvchanrate;
2441 }
2442
2443 /* Dynamic Virtual Channel */
2444 if (!(c->flags & CHN_F_VCHAN_ADAPTIVE)) {
2445 bestformat = *vchanformat;
2446 bestspeed = *vchanrate;
2447 } else {
2448 bestformat = 0;
2449 bestspeed = 0;
2450 }
2451
2452 besthwformat = 0;
2453 nrun = 0;
2454 caps = chn_getcaps(c);
2455 dirty = 0;
2456 vpflags = 0;
2457
2458 CHN_FOREACH(ch, c, children.busy) {
2459 CHN_LOCK(ch);
2460 if ((ch->format & AFMT_PASSTHROUGH) &&
2461 snd_fmtvalid(ch->format, caps->fmtlist)) {
2462 bestformat = ch->format;
2463 bestspeed = ch->speed;
2464 CHN_UNLOCK(ch);
2465 vpflags = CHN_F_PASSTHROUGH;
2466 nrun++;
2467 break;
2468 }
2469 if ((ch->flags & CHN_F_EXCLUSIVE) && vpflags == 0) {
2470 if (c->flags & CHN_F_VCHAN_ADAPTIVE) {
2471 bestspeed = ch->speed;
2472 RANGE(bestspeed, caps->minspeed,
2473 caps->maxspeed);
2474 besthwformat = snd_fmtbest(ch->format,
2475 caps->fmtlist);
2476 if (besthwformat != 0)
2477 bestformat = besthwformat;
2478 }
2479 CHN_UNLOCK(ch);
2480 vpflags = CHN_F_EXCLUSIVE;
2481 nrun++;
2482 continue;
2483 }
2484 if (!(c->flags & CHN_F_VCHAN_ADAPTIVE) ||
2485 vpflags != 0) {
2486 CHN_UNLOCK(ch);
2487 nrun++;
2488 continue;
2489 }
2490 if (ch->speed > bestspeed) {
2491 bestspeed = ch->speed;
2492 RANGE(bestspeed, caps->minspeed,
2493 caps->maxspeed);
2494 }
2495 besthwformat = snd_fmtbest(ch->format, caps->fmtlist);
2496 if (!(besthwformat & AFMT_VCHAN)) {
2497 CHN_UNLOCK(ch);
2498 nrun++;
2499 continue;
2500 }
2501 if (AFMT_CHANNEL(besthwformat) >
2502 AFMT_CHANNEL(bestformat))
2503 bestformat = besthwformat;
2504 else if (AFMT_CHANNEL(besthwformat) ==
2505 AFMT_CHANNEL(bestformat) &&
2506 AFMT_BIT(besthwformat) > AFMT_BIT(bestformat))
2507 bestformat = besthwformat;
2508 CHN_UNLOCK(ch);
2509 nrun++;
2510 }
2511
2512 if (bestformat == 0)
2513 bestformat = c->format;
2514 if (bestspeed == 0)
2515 bestspeed = c->speed;
2516
2517 if (bestformat != c->format || bestspeed != c->speed)
2518 dirty = 1;
2519
2520 c->flags &= ~(CHN_F_PASSTHROUGH | CHN_F_EXCLUSIVE);
2521 c->flags |= vpflags;
2522
2523 if (nrun && !run) {
2524 if (dirty) {
2525 bestspeed = CHANNEL_SETSPEED(c->methods,
2526 c->devinfo, bestspeed);
2527 err = chn_reset(c, bestformat, bestspeed);
2528 }
2529 if (err == 0 && dirty) {
2530 CHN_FOREACH(ch, c, children.busy) {
2531 CHN_LOCK(ch);
2532 if (VCHAN_SYNC_REQUIRED(ch))
2533 vchan_sync(ch);
2534 CHN_UNLOCK(ch);
2535 }
2536 }
2537 if (err == 0) {
2538 if (dirty)
2539 c->flags |= CHN_F_DIRTY;
2540 err = chn_start(c, 1);
2541 }
2542 }
2543
2544 if (nrun && run && dirty) {
2545 chn_abort(c);
2546 bestspeed = CHANNEL_SETSPEED(c->methods, c->devinfo,
2547 bestspeed);
2548 err = chn_reset(c, bestformat, bestspeed);
2549 if (err == 0) {
2550 CHN_FOREACH(ch, c, children.busy) {
2551 CHN_LOCK(ch);
2552 if (VCHAN_SYNC_REQUIRED(ch))
2553 vchan_sync(ch);
2554 CHN_UNLOCK(ch);
2555 }
2556 }
2557 if (err == 0) {
2558 c->flags |= CHN_F_DIRTY;
2559 err = chn_start(c, 1);
2560 }
2561 }
2562
2563 if (err == 0 && !(bestformat & AFMT_PASSTHROUGH) &&
2564 (bestformat & AFMT_VCHAN)) {
2565 *vchanformat = bestformat;
2566 *vchanrate = bestspeed;
2567 }
2568
2569 if (!nrun && run) {
2570 c->flags &= ~(CHN_F_PASSTHROUGH | CHN_F_EXCLUSIVE);
2571 bestformat = *vchanformat;
2572 bestspeed = *vchanrate;
2573 chn_abort(c);
2574 if (c->format != bestformat || c->speed != bestspeed)
2575 chn_reset(c, bestformat, bestspeed);
2576 }
2577 }
2578
2579 return (err);
2580 }
2581
2582 /**
2583 * @brief Fetch array of supported discrete sample rates
2584 *
2585 * Wrapper for CHANNEL_GETRATES. Please see channel_if.m:getrates() for
2586 * detailed information.
2587 *
2588 * @note If the operation isn't supported, this function will just return 0
2589 * (no rates in the array), and *rates will be set to NULL. Callers
2590 * should examine rates @b only if this function returns non-zero.
2591 *
2592 * @param c pcm channel to examine
2593 * @param rates pointer to array of integers; rate table will be recorded here
2594 *
2595 * @return number of rates in the array pointed to be @c rates
2596 */
2597 int
chn_getrates(struct pcm_channel * c,int ** rates)2598 chn_getrates(struct pcm_channel *c, int **rates)
2599 {
2600 KASSERT(rates != NULL, ("rates is null"));
2601 CHN_LOCKASSERT(c);
2602 return CHANNEL_GETRATES(c->methods, c->devinfo, rates);
2603 }
2604
2605 /**
2606 * @brief Remove channel from a sync group, if there is one.
2607 *
2608 * This function is initially intended for the following conditions:
2609 * - Starting a syncgroup (@c SNDCTL_DSP_SYNCSTART ioctl)
2610 * - Closing a device. (A channel can't be destroyed if it's still in use.)
2611 *
2612 * @note Before calling this function, the syncgroup list mutex must be
2613 * held. (Consider pcm_channel::sm protected by the SG list mutex
2614 * whether @c c is locked or not.)
2615 *
2616 * @param c channel device to be started or closed
2617 * @returns If this channel was the only member of a group, the group ID
2618 * is returned to the caller so that the caller can release it
2619 * via free_unr() after giving up the syncgroup lock. Else it
2620 * returns 0.
2621 */
2622 int
chn_syncdestroy(struct pcm_channel * c)2623 chn_syncdestroy(struct pcm_channel *c)
2624 {
2625 struct pcmchan_syncmember *sm;
2626 struct pcmchan_syncgroup *sg;
2627 int sg_id;
2628
2629 sg_id = 0;
2630
2631 PCM_SG_LOCKASSERT(MA_OWNED);
2632
2633 if (c->sm != NULL) {
2634 sm = c->sm;
2635 sg = sm->parent;
2636 c->sm = NULL;
2637
2638 KASSERT(sg != NULL, ("syncmember has null parent"));
2639
2640 SLIST_REMOVE(&sg->members, sm, pcmchan_syncmember, link);
2641 free(sm, M_DEVBUF);
2642
2643 if (SLIST_EMPTY(&sg->members)) {
2644 SLIST_REMOVE(&snd_pcm_syncgroups, sg, pcmchan_syncgroup, link);
2645 sg_id = sg->id;
2646 free(sg, M_DEVBUF);
2647 }
2648 }
2649
2650 return sg_id;
2651 }
2652
2653 #ifdef OSSV4_EXPERIMENT
2654 int
chn_getpeaks(struct pcm_channel * c,int * lpeak,int * rpeak)2655 chn_getpeaks(struct pcm_channel *c, int *lpeak, int *rpeak)
2656 {
2657 CHN_LOCKASSERT(c);
2658 return CHANNEL_GETPEAKS(c->methods, c->devinfo, lpeak, rpeak);
2659 }
2660 #endif
2661