190da2b28SAriff Abdullah /*-
24d846d26SWarner Losh * SPDX-License-Identifier: BSD-2-Clause
3718cf2ccSPedro F. Giffuni *
490da2b28SAriff Abdullah * Copyright (c) 2008-2009 Ariff Abdullah <ariff@FreeBSD.org>
590da2b28SAriff Abdullah * All rights reserved.
690da2b28SAriff Abdullah *
790da2b28SAriff Abdullah * Redistribution and use in source and binary forms, with or without
890da2b28SAriff Abdullah * modification, are permitted provided that the following conditions
990da2b28SAriff Abdullah * are met:
1090da2b28SAriff Abdullah * 1. Redistributions of source code must retain the above copyright
1190da2b28SAriff Abdullah * notice, this list of conditions and the following disclaimer.
1290da2b28SAriff Abdullah * 2. Redistributions in binary form must reproduce the above copyright
1390da2b28SAriff Abdullah * notice, this list of conditions and the following disclaimer in the
1490da2b28SAriff Abdullah * documentation and/or other materials provided with the distribution.
1590da2b28SAriff Abdullah *
1690da2b28SAriff Abdullah * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
1790da2b28SAriff Abdullah * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
1890da2b28SAriff Abdullah * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
1990da2b28SAriff Abdullah * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
2090da2b28SAriff Abdullah * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
2190da2b28SAriff Abdullah * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
2290da2b28SAriff Abdullah * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2390da2b28SAriff Abdullah * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
2490da2b28SAriff Abdullah * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
2590da2b28SAriff Abdullah * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
2690da2b28SAriff Abdullah * SUCH DAMAGE.
2790da2b28SAriff Abdullah */
2890da2b28SAriff Abdullah
2990da2b28SAriff Abdullah #ifdef HAVE_KERNEL_OPTION_HEADERS
3090da2b28SAriff Abdullah #include "opt_snd.h"
3190da2b28SAriff Abdullah #endif
3290da2b28SAriff Abdullah
3390da2b28SAriff Abdullah #include <dev/sound/pcm/sound.h>
3490da2b28SAriff Abdullah
3590da2b28SAriff Abdullah #include "feeder_if.h"
3690da2b28SAriff Abdullah
3790da2b28SAriff Abdullah /* chain state */
3890da2b28SAriff Abdullah struct feeder_chain_state {
3990da2b28SAriff Abdullah uint32_t afmt; /* audio format */
4090da2b28SAriff Abdullah uint32_t rate; /* sampling rate */
4190da2b28SAriff Abdullah struct pcmchan_matrix *matrix; /* matrix map */
4290da2b28SAriff Abdullah };
4390da2b28SAriff Abdullah
4490da2b28SAriff Abdullah /*
4590da2b28SAriff Abdullah * chain descriptor that will be passed around from the beginning until the
4690da2b28SAriff Abdullah * end of chain process.
4790da2b28SAriff Abdullah */
4890da2b28SAriff Abdullah struct feeder_chain_desc {
4990da2b28SAriff Abdullah struct feeder_chain_state origin; /* original state */
5090da2b28SAriff Abdullah struct feeder_chain_state current; /* current state */
5190da2b28SAriff Abdullah struct feeder_chain_state target; /* target state */
5290da2b28SAriff Abdullah struct pcm_feederdesc desc; /* feeder descriptor */
53513ee901SGordon Bergling uint32_t afmt_ne; /* preferred native endian */
5490da2b28SAriff Abdullah int mode; /* chain mode */
5590da2b28SAriff Abdullah int use_eq; /* need EQ? */
5690da2b28SAriff Abdullah int use_matrix; /* need channel matrixing? */
5790da2b28SAriff Abdullah int use_volume; /* need softpcmvol? */
5890da2b28SAriff Abdullah int dummy; /* dummy passthrough */
5990da2b28SAriff Abdullah int expensive; /* possibly expensive */
6090da2b28SAriff Abdullah };
6190da2b28SAriff Abdullah
6290da2b28SAriff Abdullah #define FEEDER_CHAIN_LEAN 0
6390da2b28SAriff Abdullah #define FEEDER_CHAIN_16 1
6490da2b28SAriff Abdullah #define FEEDER_CHAIN_32 2
6590da2b28SAriff Abdullah #define FEEDER_CHAIN_MULTI 3
6690da2b28SAriff Abdullah #define FEEDER_CHAIN_FULLMULTI 4
6790da2b28SAriff Abdullah #define FEEDER_CHAIN_LAST 5
6890da2b28SAriff Abdullah
6990da2b28SAriff Abdullah #if defined(SND_FEEDER_FULL_MULTIFORMAT)
7090da2b28SAriff Abdullah #define FEEDER_CHAIN_DEFAULT FEEDER_CHAIN_FULLMULTI
7190da2b28SAriff Abdullah #elif defined(SND_FEEDER_MULTIFORMAT)
7290da2b28SAriff Abdullah #define FEEDER_CHAIN_DEFAULT FEEDER_CHAIN_MULTI
7390da2b28SAriff Abdullah #else
7490da2b28SAriff Abdullah #define FEEDER_CHAIN_DEFAULT FEEDER_CHAIN_LEAN
7590da2b28SAriff Abdullah #endif
7690da2b28SAriff Abdullah
7790da2b28SAriff Abdullah /*
78513ee901SGordon Bergling * List of preferred formats that might be required during
7990da2b28SAriff Abdullah * processing. It will be decided through snd_fmtbest().
8090da2b28SAriff Abdullah */
8190da2b28SAriff Abdullah
8290da2b28SAriff Abdullah /* 'Lean' mode, signed 16 or 32 bit native endian. */
8390da2b28SAriff Abdullah static uint32_t feeder_chain_formats_lean[] = {
8490da2b28SAriff Abdullah AFMT_S16_NE, AFMT_S32_NE,
8590da2b28SAriff Abdullah 0
8690da2b28SAriff Abdullah };
8790da2b28SAriff Abdullah
8890da2b28SAriff Abdullah /* Force everything to signed 16 bit native endian. */
8990da2b28SAriff Abdullah static uint32_t feeder_chain_formats_16[] = {
9090da2b28SAriff Abdullah AFMT_S16_NE,
9190da2b28SAriff Abdullah 0
9290da2b28SAriff Abdullah };
9390da2b28SAriff Abdullah
9490da2b28SAriff Abdullah /* Force everything to signed 32 bit native endian. */
9590da2b28SAriff Abdullah static uint32_t feeder_chain_formats_32[] = {
9690da2b28SAriff Abdullah AFMT_S32_NE,
9790da2b28SAriff Abdullah 0
9890da2b28SAriff Abdullah };
9990da2b28SAriff Abdullah
10090da2b28SAriff Abdullah /* Multiple choices, all except 8 bit. */
10190da2b28SAriff Abdullah static uint32_t feeder_chain_formats_multi[] = {
10290da2b28SAriff Abdullah AFMT_S16_LE, AFMT_S16_BE, AFMT_U16_LE, AFMT_U16_BE,
10390da2b28SAriff Abdullah AFMT_S24_LE, AFMT_S24_BE, AFMT_U24_LE, AFMT_U24_BE,
10490da2b28SAriff Abdullah AFMT_S32_LE, AFMT_S32_BE, AFMT_U32_LE, AFMT_U32_BE,
105*e1bbaa71SChristos Margiolis AFMT_F32_LE, AFMT_F32_BE,
10690da2b28SAriff Abdullah 0
10790da2b28SAriff Abdullah };
10890da2b28SAriff Abdullah
10990da2b28SAriff Abdullah /* Everything that is convertible. */
11090da2b28SAriff Abdullah static uint32_t feeder_chain_formats_fullmulti[] = {
11190da2b28SAriff Abdullah AFMT_S8, AFMT_U8,
11290da2b28SAriff Abdullah AFMT_S16_LE, AFMT_S16_BE, AFMT_U16_LE, AFMT_U16_BE,
11390da2b28SAriff Abdullah AFMT_S24_LE, AFMT_S24_BE, AFMT_U24_LE, AFMT_U24_BE,
11490da2b28SAriff Abdullah AFMT_S32_LE, AFMT_S32_BE, AFMT_U32_LE, AFMT_U32_BE,
115*e1bbaa71SChristos Margiolis AFMT_F32_LE, AFMT_F32_BE,
11690da2b28SAriff Abdullah 0
11790da2b28SAriff Abdullah };
11890da2b28SAriff Abdullah
11990da2b28SAriff Abdullah static uint32_t *feeder_chain_formats[FEEDER_CHAIN_LAST] = {
12090da2b28SAriff Abdullah [FEEDER_CHAIN_LEAN] = feeder_chain_formats_lean,
12190da2b28SAriff Abdullah [FEEDER_CHAIN_16] = feeder_chain_formats_16,
12290da2b28SAriff Abdullah [FEEDER_CHAIN_32] = feeder_chain_formats_32,
12390da2b28SAriff Abdullah [FEEDER_CHAIN_MULTI] = feeder_chain_formats_multi,
12490da2b28SAriff Abdullah [FEEDER_CHAIN_FULLMULTI] = feeder_chain_formats_fullmulti
12590da2b28SAriff Abdullah };
12690da2b28SAriff Abdullah
12790da2b28SAriff Abdullah static int feeder_chain_mode = FEEDER_CHAIN_DEFAULT;
12890da2b28SAriff Abdullah
12990da2b28SAriff Abdullah #if defined(_KERNEL) && defined(SND_DEBUG) && defined(SND_FEEDER_FULL_MULTIFORMAT)
130af3b2549SHans Petter Selasky SYSCTL_INT(_hw_snd, OID_AUTO, feeder_chain_mode, CTLFLAG_RWTUN,
13190da2b28SAriff Abdullah &feeder_chain_mode, 0,
13290da2b28SAriff Abdullah "feeder chain mode "
13390da2b28SAriff Abdullah "(0=lean, 1=16bit, 2=32bit, 3=multiformat, 4=fullmultiformat)");
13490da2b28SAriff Abdullah #endif
13590da2b28SAriff Abdullah
13690da2b28SAriff Abdullah /*
13790da2b28SAriff Abdullah * feeder_build_format(): Chain any format converter.
13890da2b28SAriff Abdullah */
13990da2b28SAriff Abdullah static int
feeder_build_format(struct pcm_channel * c,struct feeder_chain_desc * cdesc)14090da2b28SAriff Abdullah feeder_build_format(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
14190da2b28SAriff Abdullah {
14290da2b28SAriff Abdullah struct feeder_class *fc;
14390da2b28SAriff Abdullah struct pcm_feederdesc *desc;
14490da2b28SAriff Abdullah int ret;
14590da2b28SAriff Abdullah
14690da2b28SAriff Abdullah desc = &(cdesc->desc);
14790da2b28SAriff Abdullah desc->type = FEEDER_FORMAT;
14890da2b28SAriff Abdullah desc->in = 0;
14990da2b28SAriff Abdullah desc->out = 0;
15090da2b28SAriff Abdullah desc->flags = 0;
15190da2b28SAriff Abdullah
15290da2b28SAriff Abdullah fc = feeder_getclass(desc);
15390da2b28SAriff Abdullah if (fc == NULL) {
15490da2b28SAriff Abdullah device_printf(c->dev,
15590da2b28SAriff Abdullah "%s(): can't find feeder_format\n", __func__);
15690da2b28SAriff Abdullah return (ENOTSUP);
15790da2b28SAriff Abdullah }
15890da2b28SAriff Abdullah
15990da2b28SAriff Abdullah desc->in = cdesc->current.afmt;
16090da2b28SAriff Abdullah desc->out = cdesc->target.afmt;
16190da2b28SAriff Abdullah
16229ff7b08SChristos Margiolis ret = feeder_add(c, fc, desc);
16390da2b28SAriff Abdullah if (ret != 0) {
16490da2b28SAriff Abdullah device_printf(c->dev,
16590da2b28SAriff Abdullah "%s(): can't add feeder_format\n", __func__);
16690da2b28SAriff Abdullah return (ret);
16790da2b28SAriff Abdullah }
16890da2b28SAriff Abdullah
16990da2b28SAriff Abdullah c->feederflags |= 1 << FEEDER_FORMAT;
17090da2b28SAriff Abdullah
17190da2b28SAriff Abdullah cdesc->current.afmt = cdesc->target.afmt;
17290da2b28SAriff Abdullah
17390da2b28SAriff Abdullah return (0);
17490da2b28SAriff Abdullah }
17590da2b28SAriff Abdullah
17690da2b28SAriff Abdullah /*
17790da2b28SAriff Abdullah * feeder_build_formatne(): Chain format converter that suite best for native
17890da2b28SAriff Abdullah * endian format.
17990da2b28SAriff Abdullah */
18090da2b28SAriff Abdullah static int
feeder_build_formatne(struct pcm_channel * c,struct feeder_chain_desc * cdesc)18190da2b28SAriff Abdullah feeder_build_formatne(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
18290da2b28SAriff Abdullah {
18390da2b28SAriff Abdullah struct feeder_chain_state otarget;
18490da2b28SAriff Abdullah int ret;
18590da2b28SAriff Abdullah
18690da2b28SAriff Abdullah if (cdesc->afmt_ne == 0 ||
18790da2b28SAriff Abdullah AFMT_ENCODING(cdesc->current.afmt) == cdesc->afmt_ne)
18890da2b28SAriff Abdullah return (0);
18990da2b28SAriff Abdullah
19090da2b28SAriff Abdullah otarget = cdesc->target;
19190da2b28SAriff Abdullah cdesc->target = cdesc->current;
19290da2b28SAriff Abdullah cdesc->target.afmt = SND_FORMAT(cdesc->afmt_ne,
19390da2b28SAriff Abdullah cdesc->current.matrix->channels, cdesc->current.matrix->ext);
19490da2b28SAriff Abdullah
19590da2b28SAriff Abdullah ret = feeder_build_format(c, cdesc);
19690da2b28SAriff Abdullah if (ret != 0)
19790da2b28SAriff Abdullah return (ret);
19890da2b28SAriff Abdullah
19990da2b28SAriff Abdullah cdesc->target = otarget;
20090da2b28SAriff Abdullah
20190da2b28SAriff Abdullah return (0);
20290da2b28SAriff Abdullah }
20390da2b28SAriff Abdullah
20490da2b28SAriff Abdullah /*
20590da2b28SAriff Abdullah * feeder_build_rate(): Chain sample rate converter.
20690da2b28SAriff Abdullah */
20790da2b28SAriff Abdullah static int
feeder_build_rate(struct pcm_channel * c,struct feeder_chain_desc * cdesc)20890da2b28SAriff Abdullah feeder_build_rate(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
20990da2b28SAriff Abdullah {
21090da2b28SAriff Abdullah struct feeder_class *fc;
21190da2b28SAriff Abdullah struct pcm_feeder *f;
21290da2b28SAriff Abdullah struct pcm_feederdesc *desc;
21390da2b28SAriff Abdullah int ret;
21490da2b28SAriff Abdullah
21590da2b28SAriff Abdullah ret = feeder_build_formatne(c, cdesc);
21690da2b28SAriff Abdullah if (ret != 0)
21790da2b28SAriff Abdullah return (ret);
21890da2b28SAriff Abdullah
21990da2b28SAriff Abdullah desc = &(cdesc->desc);
22090da2b28SAriff Abdullah desc->type = FEEDER_RATE;
22190da2b28SAriff Abdullah desc->in = 0;
22290da2b28SAriff Abdullah desc->out = 0;
22390da2b28SAriff Abdullah desc->flags = 0;
22490da2b28SAriff Abdullah
22590da2b28SAriff Abdullah fc = feeder_getclass(desc);
22690da2b28SAriff Abdullah if (fc == NULL) {
22790da2b28SAriff Abdullah device_printf(c->dev,
22890da2b28SAriff Abdullah "%s(): can't find feeder_rate\n", __func__);
22990da2b28SAriff Abdullah return (ENOTSUP);
23090da2b28SAriff Abdullah }
23190da2b28SAriff Abdullah
23290da2b28SAriff Abdullah desc->in = cdesc->current.afmt;
23390da2b28SAriff Abdullah desc->out = desc->in;
23490da2b28SAriff Abdullah
23529ff7b08SChristos Margiolis ret = feeder_add(c, fc, desc);
23690da2b28SAriff Abdullah if (ret != 0) {
23790da2b28SAriff Abdullah device_printf(c->dev,
23890da2b28SAriff Abdullah "%s(): can't add feeder_rate\n", __func__);
23990da2b28SAriff Abdullah return (ret);
24090da2b28SAriff Abdullah }
24190da2b28SAriff Abdullah
24290da2b28SAriff Abdullah f = c->feeder;
24390da2b28SAriff Abdullah
24490da2b28SAriff Abdullah /*
24590da2b28SAriff Abdullah * If in 'dummy' mode (possibly due to passthrough mode), set the
24690da2b28SAriff Abdullah * conversion quality to the lowest possible (should be fastest) since
24790da2b28SAriff Abdullah * listener won't be hearing anything. Theoretically we can just
24890da2b28SAriff Abdullah * disable it, but that will cause weird runtime behaviour:
24990da2b28SAriff Abdullah * application appear to play something that is either too fast or too
25090da2b28SAriff Abdullah * slow.
25190da2b28SAriff Abdullah */
25290da2b28SAriff Abdullah if (cdesc->dummy != 0) {
25390da2b28SAriff Abdullah ret = FEEDER_SET(f, FEEDRATE_QUALITY, 0);
25490da2b28SAriff Abdullah if (ret != 0) {
25590da2b28SAriff Abdullah device_printf(c->dev,
25690da2b28SAriff Abdullah "%s(): can't set resampling quality\n", __func__);
25790da2b28SAriff Abdullah return (ret);
25890da2b28SAriff Abdullah }
25990da2b28SAriff Abdullah }
26090da2b28SAriff Abdullah
26190da2b28SAriff Abdullah ret = FEEDER_SET(f, FEEDRATE_SRC, cdesc->current.rate);
26290da2b28SAriff Abdullah if (ret != 0) {
26390da2b28SAriff Abdullah device_printf(c->dev,
26490da2b28SAriff Abdullah "%s(): can't set source rate\n", __func__);
26590da2b28SAriff Abdullah return (ret);
26690da2b28SAriff Abdullah }
26790da2b28SAriff Abdullah
26890da2b28SAriff Abdullah ret = FEEDER_SET(f, FEEDRATE_DST, cdesc->target.rate);
26990da2b28SAriff Abdullah if (ret != 0) {
27090da2b28SAriff Abdullah device_printf(c->dev,
27190da2b28SAriff Abdullah "%s(): can't set destination rate\n", __func__);
27290da2b28SAriff Abdullah return (ret);
27390da2b28SAriff Abdullah }
27490da2b28SAriff Abdullah
27590da2b28SAriff Abdullah c->feederflags |= 1 << FEEDER_RATE;
27690da2b28SAriff Abdullah
27790da2b28SAriff Abdullah cdesc->current.rate = cdesc->target.rate;
27890da2b28SAriff Abdullah
27990da2b28SAriff Abdullah return (0);
28090da2b28SAriff Abdullah }
28190da2b28SAriff Abdullah
28290da2b28SAriff Abdullah /*
28390da2b28SAriff Abdullah * feeder_build_matrix(): Chain channel matrixing converter.
28490da2b28SAriff Abdullah */
28590da2b28SAriff Abdullah static int
feeder_build_matrix(struct pcm_channel * c,struct feeder_chain_desc * cdesc)28690da2b28SAriff Abdullah feeder_build_matrix(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
28790da2b28SAriff Abdullah {
28890da2b28SAriff Abdullah struct feeder_class *fc;
28990da2b28SAriff Abdullah struct pcm_feeder *f;
29090da2b28SAriff Abdullah struct pcm_feederdesc *desc;
29190da2b28SAriff Abdullah int ret;
29290da2b28SAriff Abdullah
29390da2b28SAriff Abdullah ret = feeder_build_formatne(c, cdesc);
29490da2b28SAriff Abdullah if (ret != 0)
29590da2b28SAriff Abdullah return (ret);
29690da2b28SAriff Abdullah
29790da2b28SAriff Abdullah desc = &(cdesc->desc);
29890da2b28SAriff Abdullah desc->type = FEEDER_MATRIX;
29990da2b28SAriff Abdullah desc->in = 0;
30090da2b28SAriff Abdullah desc->out = 0;
30190da2b28SAriff Abdullah desc->flags = 0;
30290da2b28SAriff Abdullah
30390da2b28SAriff Abdullah fc = feeder_getclass(desc);
30490da2b28SAriff Abdullah if (fc == NULL) {
30590da2b28SAriff Abdullah device_printf(c->dev,
30690da2b28SAriff Abdullah "%s(): can't find feeder_matrix\n", __func__);
30790da2b28SAriff Abdullah return (ENOTSUP);
30890da2b28SAriff Abdullah }
30990da2b28SAriff Abdullah
31090da2b28SAriff Abdullah desc->in = cdesc->current.afmt;
31190da2b28SAriff Abdullah desc->out = SND_FORMAT(cdesc->current.afmt,
31290da2b28SAriff Abdullah cdesc->target.matrix->channels, cdesc->target.matrix->ext);
31390da2b28SAriff Abdullah
31429ff7b08SChristos Margiolis ret = feeder_add(c, fc, desc);
31590da2b28SAriff Abdullah if (ret != 0) {
31690da2b28SAriff Abdullah device_printf(c->dev,
31790da2b28SAriff Abdullah "%s(): can't add feeder_matrix\n", __func__);
31890da2b28SAriff Abdullah return (ret);
31990da2b28SAriff Abdullah }
32090da2b28SAriff Abdullah
32190da2b28SAriff Abdullah f = c->feeder;
32290da2b28SAriff Abdullah ret = feeder_matrix_setup(f, cdesc->current.matrix,
32390da2b28SAriff Abdullah cdesc->target.matrix);
32490da2b28SAriff Abdullah if (ret != 0) {
32590da2b28SAriff Abdullah device_printf(c->dev,
32690da2b28SAriff Abdullah "%s(): feeder_matrix_setup() failed\n", __func__);
32790da2b28SAriff Abdullah return (ret);
32890da2b28SAriff Abdullah }
32990da2b28SAriff Abdullah
33090da2b28SAriff Abdullah c->feederflags |= 1 << FEEDER_MATRIX;
33190da2b28SAriff Abdullah
33290da2b28SAriff Abdullah cdesc->current.afmt = desc->out;
33390da2b28SAriff Abdullah cdesc->current.matrix = cdesc->target.matrix;
33490da2b28SAriff Abdullah cdesc->use_matrix = 0;
33590da2b28SAriff Abdullah
33690da2b28SAriff Abdullah return (0);
33790da2b28SAriff Abdullah }
33890da2b28SAriff Abdullah
33990da2b28SAriff Abdullah /*
34090da2b28SAriff Abdullah * feeder_build_volume(): Chain soft volume.
34190da2b28SAriff Abdullah */
34290da2b28SAriff Abdullah static int
feeder_build_volume(struct pcm_channel * c,struct feeder_chain_desc * cdesc)34390da2b28SAriff Abdullah feeder_build_volume(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
34490da2b28SAriff Abdullah {
34590da2b28SAriff Abdullah struct feeder_class *fc;
34690da2b28SAriff Abdullah struct pcm_feeder *f;
34790da2b28SAriff Abdullah struct pcm_feederdesc *desc;
34890da2b28SAriff Abdullah int ret;
34990da2b28SAriff Abdullah
35090da2b28SAriff Abdullah ret = feeder_build_formatne(c, cdesc);
35190da2b28SAriff Abdullah if (ret != 0)
35290da2b28SAriff Abdullah return (ret);
35390da2b28SAriff Abdullah
35490da2b28SAriff Abdullah desc = &(cdesc->desc);
35590da2b28SAriff Abdullah desc->type = FEEDER_VOLUME;
35690da2b28SAriff Abdullah desc->in = 0;
35790da2b28SAriff Abdullah desc->out = 0;
35890da2b28SAriff Abdullah desc->flags = 0;
35990da2b28SAriff Abdullah
36090da2b28SAriff Abdullah fc = feeder_getclass(desc);
36190da2b28SAriff Abdullah if (fc == NULL) {
36290da2b28SAriff Abdullah device_printf(c->dev,
36390da2b28SAriff Abdullah "%s(): can't find feeder_volume\n", __func__);
36490da2b28SAriff Abdullah return (ENOTSUP);
36590da2b28SAriff Abdullah }
36690da2b28SAriff Abdullah
36790da2b28SAriff Abdullah desc->in = cdesc->current.afmt;
36890da2b28SAriff Abdullah desc->out = desc->in;
36990da2b28SAriff Abdullah
37029ff7b08SChristos Margiolis ret = feeder_add(c, fc, desc);
37190da2b28SAriff Abdullah if (ret != 0) {
37290da2b28SAriff Abdullah device_printf(c->dev,
37390da2b28SAriff Abdullah "%s(): can't add feeder_volume\n", __func__);
37490da2b28SAriff Abdullah return (ret);
37590da2b28SAriff Abdullah }
37690da2b28SAriff Abdullah
37790da2b28SAriff Abdullah f = c->feeder;
37890da2b28SAriff Abdullah
37990da2b28SAriff Abdullah /*
38090da2b28SAriff Abdullah * If in 'dummy' mode (possibly due to passthrough mode), set BYPASS
38190da2b28SAriff Abdullah * mode since listener won't be hearing anything. Theoretically we can
38290da2b28SAriff Abdullah * just disable it, but that will confuse volume per channel mixer.
38390da2b28SAriff Abdullah */
38490da2b28SAriff Abdullah if (cdesc->dummy != 0) {
38590da2b28SAriff Abdullah ret = FEEDER_SET(f, FEEDVOLUME_STATE, FEEDVOLUME_BYPASS);
38690da2b28SAriff Abdullah if (ret != 0) {
38790da2b28SAriff Abdullah device_printf(c->dev,
38890da2b28SAriff Abdullah "%s(): can't set volume bypass\n", __func__);
38990da2b28SAriff Abdullah return (ret);
39090da2b28SAriff Abdullah }
39190da2b28SAriff Abdullah }
39290da2b28SAriff Abdullah
39390da2b28SAriff Abdullah ret = feeder_volume_apply_matrix(f, cdesc->current.matrix);
39490da2b28SAriff Abdullah if (ret != 0) {
39590da2b28SAriff Abdullah device_printf(c->dev,
39690da2b28SAriff Abdullah "%s(): feeder_volume_apply_matrix() failed\n", __func__);
39790da2b28SAriff Abdullah return (ret);
39890da2b28SAriff Abdullah }
39990da2b28SAriff Abdullah
40090da2b28SAriff Abdullah c->feederflags |= 1 << FEEDER_VOLUME;
40190da2b28SAriff Abdullah
40290da2b28SAriff Abdullah cdesc->use_volume = 0;
40390da2b28SAriff Abdullah
40490da2b28SAriff Abdullah return (0);
40590da2b28SAriff Abdullah }
40690da2b28SAriff Abdullah
40790da2b28SAriff Abdullah /*
40890da2b28SAriff Abdullah * feeder_build_eq(): Chain parametric software equalizer.
40990da2b28SAriff Abdullah */
41090da2b28SAriff Abdullah static int
feeder_build_eq(struct pcm_channel * c,struct feeder_chain_desc * cdesc)41190da2b28SAriff Abdullah feeder_build_eq(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
41290da2b28SAriff Abdullah {
41390da2b28SAriff Abdullah struct feeder_class *fc;
41490da2b28SAriff Abdullah struct pcm_feeder *f;
41590da2b28SAriff Abdullah struct pcm_feederdesc *desc;
41690da2b28SAriff Abdullah int ret;
41790da2b28SAriff Abdullah
41890da2b28SAriff Abdullah ret = feeder_build_formatne(c, cdesc);
41990da2b28SAriff Abdullah if (ret != 0)
42090da2b28SAriff Abdullah return (ret);
42190da2b28SAriff Abdullah
42290da2b28SAriff Abdullah desc = &(cdesc->desc);
42390da2b28SAriff Abdullah desc->type = FEEDER_EQ;
42490da2b28SAriff Abdullah desc->in = 0;
42590da2b28SAriff Abdullah desc->out = 0;
42690da2b28SAriff Abdullah desc->flags = 0;
42790da2b28SAriff Abdullah
42890da2b28SAriff Abdullah fc = feeder_getclass(desc);
42990da2b28SAriff Abdullah if (fc == NULL) {
43090da2b28SAriff Abdullah device_printf(c->dev,
43190da2b28SAriff Abdullah "%s(): can't find feeder_eq\n", __func__);
43290da2b28SAriff Abdullah return (ENOTSUP);
43390da2b28SAriff Abdullah }
43490da2b28SAriff Abdullah
43590da2b28SAriff Abdullah desc->in = cdesc->current.afmt;
43690da2b28SAriff Abdullah desc->out = desc->in;
43790da2b28SAriff Abdullah
43829ff7b08SChristos Margiolis ret = feeder_add(c, fc, desc);
43990da2b28SAriff Abdullah if (ret != 0) {
44090da2b28SAriff Abdullah device_printf(c->dev,
44190da2b28SAriff Abdullah "%s(): can't add feeder_eq\n", __func__);
44290da2b28SAriff Abdullah return (ret);
44390da2b28SAriff Abdullah }
44490da2b28SAriff Abdullah
44590da2b28SAriff Abdullah f = c->feeder;
44690da2b28SAriff Abdullah
44790da2b28SAriff Abdullah ret = FEEDER_SET(f, FEEDEQ_RATE, cdesc->current.rate);
44890da2b28SAriff Abdullah if (ret != 0) {
44990da2b28SAriff Abdullah device_printf(c->dev,
45090da2b28SAriff Abdullah "%s(): can't set rate on feeder_eq\n", __func__);
45190da2b28SAriff Abdullah return (ret);
45290da2b28SAriff Abdullah }
45390da2b28SAriff Abdullah
45490da2b28SAriff Abdullah c->feederflags |= 1 << FEEDER_EQ;
45590da2b28SAriff Abdullah
45690da2b28SAriff Abdullah cdesc->use_eq = 0;
45790da2b28SAriff Abdullah
45890da2b28SAriff Abdullah return (0);
45990da2b28SAriff Abdullah }
46090da2b28SAriff Abdullah
46190da2b28SAriff Abdullah /*
46290da2b28SAriff Abdullah * feeder_build_root(): Chain root feeder, the top, father of all.
46390da2b28SAriff Abdullah */
46490da2b28SAriff Abdullah static int
feeder_build_root(struct pcm_channel * c,struct feeder_chain_desc * cdesc)46590da2b28SAriff Abdullah feeder_build_root(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
46690da2b28SAriff Abdullah {
46790da2b28SAriff Abdullah struct feeder_class *fc;
46890da2b28SAriff Abdullah int ret;
46990da2b28SAriff Abdullah
47090da2b28SAriff Abdullah fc = feeder_getclass(NULL);
47190da2b28SAriff Abdullah if (fc == NULL) {
47290da2b28SAriff Abdullah device_printf(c->dev,
47390da2b28SAriff Abdullah "%s(): can't find feeder_root\n", __func__);
47490da2b28SAriff Abdullah return (ENOTSUP);
47590da2b28SAriff Abdullah }
47690da2b28SAriff Abdullah
47729ff7b08SChristos Margiolis ret = feeder_add(c, fc, NULL);
47890da2b28SAriff Abdullah if (ret != 0) {
47990da2b28SAriff Abdullah device_printf(c->dev,
48090da2b28SAriff Abdullah "%s(): can't add feeder_root\n", __func__);
48190da2b28SAriff Abdullah return (ret);
48290da2b28SAriff Abdullah }
48390da2b28SAriff Abdullah
48490da2b28SAriff Abdullah c->feederflags |= 1 << FEEDER_ROOT;
48590da2b28SAriff Abdullah
48690da2b28SAriff Abdullah c->feeder->desc->in = cdesc->current.afmt;
48790da2b28SAriff Abdullah c->feeder->desc->out = cdesc->current.afmt;
48890da2b28SAriff Abdullah
48990da2b28SAriff Abdullah return (0);
49090da2b28SAriff Abdullah }
49190da2b28SAriff Abdullah
49290da2b28SAriff Abdullah /*
49390da2b28SAriff Abdullah * feeder_build_mixer(): Chain software mixer for virtual channels.
49490da2b28SAriff Abdullah */
49590da2b28SAriff Abdullah static int
feeder_build_mixer(struct pcm_channel * c,struct feeder_chain_desc * cdesc)49690da2b28SAriff Abdullah feeder_build_mixer(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
49790da2b28SAriff Abdullah {
49890da2b28SAriff Abdullah struct feeder_class *fc;
49990da2b28SAriff Abdullah struct pcm_feederdesc *desc;
50090da2b28SAriff Abdullah int ret;
50190da2b28SAriff Abdullah
50290da2b28SAriff Abdullah desc = &(cdesc->desc);
50390da2b28SAriff Abdullah desc->type = FEEDER_MIXER;
50490da2b28SAriff Abdullah desc->in = 0;
50590da2b28SAriff Abdullah desc->out = 0;
50690da2b28SAriff Abdullah desc->flags = 0;
50790da2b28SAriff Abdullah
50890da2b28SAriff Abdullah fc = feeder_getclass(desc);
50990da2b28SAriff Abdullah if (fc == NULL) {
51090da2b28SAriff Abdullah device_printf(c->dev,
51190da2b28SAriff Abdullah "%s(): can't find feeder_mixer\n", __func__);
51290da2b28SAriff Abdullah return (ENOTSUP);
51390da2b28SAriff Abdullah }
51490da2b28SAriff Abdullah
51590da2b28SAriff Abdullah desc->in = cdesc->current.afmt;
51690da2b28SAriff Abdullah desc->out = desc->in;
51790da2b28SAriff Abdullah
51829ff7b08SChristos Margiolis ret = feeder_add(c, fc, desc);
51990da2b28SAriff Abdullah if (ret != 0) {
52090da2b28SAriff Abdullah device_printf(c->dev,
52190da2b28SAriff Abdullah "%s(): can't add feeder_mixer\n", __func__);
52290da2b28SAriff Abdullah return (ret);
52390da2b28SAriff Abdullah }
52490da2b28SAriff Abdullah
52590da2b28SAriff Abdullah c->feederflags |= 1 << FEEDER_MIXER;
52690da2b28SAriff Abdullah
52790da2b28SAriff Abdullah return (0);
52890da2b28SAriff Abdullah }
52990da2b28SAriff Abdullah
53090da2b28SAriff Abdullah /* Macrosses to ease our job doing stuffs later. */
53190da2b28SAriff Abdullah #define FEEDER_BW(c, t) ((c)->t.matrix->channels * (c)->t.rate)
53290da2b28SAriff Abdullah
53390da2b28SAriff Abdullah #define FEEDRATE_UP(c) ((c)->target.rate > (c)->current.rate)
53490da2b28SAriff Abdullah #define FEEDRATE_DOWN(c) ((c)->target.rate < (c)->current.rate)
53590da2b28SAriff Abdullah #define FEEDRATE_REQUIRED(c) (FEEDRATE_UP(c) || FEEDRATE_DOWN(c))
53690da2b28SAriff Abdullah
53790da2b28SAriff Abdullah #define FEEDMATRIX_UP(c) ((c)->target.matrix->channels > \
53890da2b28SAriff Abdullah (c)->current.matrix->channels)
53990da2b28SAriff Abdullah #define FEEDMATRIX_DOWN(c) ((c)->target.matrix->channels < \
54090da2b28SAriff Abdullah (c)->current.matrix->channels)
54190da2b28SAriff Abdullah #define FEEDMATRIX_REQUIRED(c) (FEEDMATRIX_UP(c) || \
54290da2b28SAriff Abdullah FEEDMATRIX_DOWN(c) || (c)->use_matrix != 0)
54390da2b28SAriff Abdullah
54490da2b28SAriff Abdullah #define FEEDFORMAT_REQUIRED(c) (AFMT_ENCODING((c)->current.afmt) != \
54590da2b28SAriff Abdullah AFMT_ENCODING((c)->target.afmt))
54690da2b28SAriff Abdullah
54790da2b28SAriff Abdullah #define FEEDVOLUME_REQUIRED(c) ((c)->use_volume != 0)
54890da2b28SAriff Abdullah
54990da2b28SAriff Abdullah #define FEEDEQ_VALIDRATE(c, t) (feeder_eq_validrate((c)->t.rate) != 0)
55090da2b28SAriff Abdullah #define FEEDEQ_ECONOMY(c) (FEEDER_BW(c, current) < FEEDER_BW(c, target))
55190da2b28SAriff Abdullah #define FEEDEQ_REQUIRED(c) ((c)->use_eq != 0 && \
55290da2b28SAriff Abdullah FEEDEQ_VALIDRATE(c, current))
55390da2b28SAriff Abdullah
55490da2b28SAriff Abdullah #define FEEDFORMAT_NE_REQUIRED(c) \
55590da2b28SAriff Abdullah ((c)->afmt_ne != AFMT_S32_NE && \
55690da2b28SAriff Abdullah (((c)->mode == FEEDER_CHAIN_16 && \
55790da2b28SAriff Abdullah AFMT_ENCODING((c)->current.afmt) != AFMT_S16_NE) || \
55890da2b28SAriff Abdullah ((c)->mode == FEEDER_CHAIN_32 && \
55990da2b28SAriff Abdullah AFMT_ENCODING((c)->current.afmt) != AFMT_S32_NE) || \
56090da2b28SAriff Abdullah (c)->mode == FEEDER_CHAIN_FULLMULTI || \
56190da2b28SAriff Abdullah ((c)->mode == FEEDER_CHAIN_MULTI && \
56290da2b28SAriff Abdullah ((c)->current.afmt & AFMT_8BIT)) || \
56390da2b28SAriff Abdullah ((c)->mode == FEEDER_CHAIN_LEAN && \
56490da2b28SAriff Abdullah !((c)->current.afmt & (AFMT_S16_NE | AFMT_S32_NE)))))
56590da2b28SAriff Abdullah
5664ece1a88SHans Petter Selasky static void
feeder_default_matrix(struct pcmchan_matrix * m,uint32_t fmt,int id)5674ece1a88SHans Petter Selasky feeder_default_matrix(struct pcmchan_matrix *m, uint32_t fmt, int id)
5684ece1a88SHans Petter Selasky {
5694ece1a88SHans Petter Selasky int x;
5704ece1a88SHans Petter Selasky
5714ece1a88SHans Petter Selasky memset(m, 0, sizeof(*m));
5724ece1a88SHans Petter Selasky
5734ece1a88SHans Petter Selasky m->id = id;
5744ece1a88SHans Petter Selasky m->channels = AFMT_CHANNEL(fmt);
5754ece1a88SHans Petter Selasky m->ext = AFMT_EXTCHANNEL(fmt);
5764ece1a88SHans Petter Selasky for (x = 0; x != SND_CHN_T_MAX; x++)
5774ece1a88SHans Petter Selasky m->offset[x] = -1;
5784ece1a88SHans Petter Selasky }
5794ece1a88SHans Petter Selasky
58090da2b28SAriff Abdullah int
feeder_chain(struct pcm_channel * c)58190da2b28SAriff Abdullah feeder_chain(struct pcm_channel *c)
58290da2b28SAriff Abdullah {
58390da2b28SAriff Abdullah struct snddev_info *d;
58490da2b28SAriff Abdullah struct pcmchan_caps *caps;
58590da2b28SAriff Abdullah struct feeder_chain_desc cdesc;
58690da2b28SAriff Abdullah struct pcmchan_matrix *hwmatrix, *softmatrix;
58790da2b28SAriff Abdullah uint32_t hwfmt, softfmt;
58890da2b28SAriff Abdullah int ret;
58990da2b28SAriff Abdullah
59090da2b28SAriff Abdullah CHN_LOCKASSERT(c);
59190da2b28SAriff Abdullah
59290da2b28SAriff Abdullah /* Remove everything first. */
59300172d20SChristos Margiolis feeder_remove(c);
59490da2b28SAriff Abdullah
59590da2b28SAriff Abdullah KASSERT(c->feeder == NULL, ("feeder chain not empty"));
59690da2b28SAriff Abdullah
59790da2b28SAriff Abdullah /* clear and populate chain descriptor. */
59890da2b28SAriff Abdullah bzero(&cdesc, sizeof(cdesc));
59990da2b28SAriff Abdullah
60090da2b28SAriff Abdullah switch (feeder_chain_mode) {
60190da2b28SAriff Abdullah case FEEDER_CHAIN_LEAN:
60290da2b28SAriff Abdullah case FEEDER_CHAIN_16:
60390da2b28SAriff Abdullah case FEEDER_CHAIN_32:
60490da2b28SAriff Abdullah #if defined(SND_FEEDER_MULTIFORMAT) || defined(SND_FEEDER_FULL_MULTIFORMAT)
60590da2b28SAriff Abdullah case FEEDER_CHAIN_MULTI:
60690da2b28SAriff Abdullah #endif
60790da2b28SAriff Abdullah #if defined(SND_FEEDER_FULL_MULTIFORMAT)
60890da2b28SAriff Abdullah case FEEDER_CHAIN_FULLMULTI:
60990da2b28SAriff Abdullah #endif
61090da2b28SAriff Abdullah break;
61190da2b28SAriff Abdullah default:
61290da2b28SAriff Abdullah feeder_chain_mode = FEEDER_CHAIN_DEFAULT;
61390da2b28SAriff Abdullah break;
61490da2b28SAriff Abdullah }
61590da2b28SAriff Abdullah
61690da2b28SAriff Abdullah cdesc.mode = feeder_chain_mode;
61790da2b28SAriff Abdullah cdesc.expensive = 1; /* XXX faster.. */
61890da2b28SAriff Abdullah
61990da2b28SAriff Abdullah #define VCHAN_PASSTHROUGH(c) (((c)->flags & (CHN_F_VIRTUAL | \
62090da2b28SAriff Abdullah CHN_F_PASSTHROUGH)) == \
62190da2b28SAriff Abdullah (CHN_F_VIRTUAL | CHN_F_PASSTHROUGH))
62290da2b28SAriff Abdullah
62390da2b28SAriff Abdullah /* Get the best possible hardware format. */
62490da2b28SAriff Abdullah if (VCHAN_PASSTHROUGH(c))
62590da2b28SAriff Abdullah hwfmt = c->parentchannel->format;
62690da2b28SAriff Abdullah else {
62790da2b28SAriff Abdullah caps = chn_getcaps(c);
62890da2b28SAriff Abdullah if (caps == NULL || caps->fmtlist == NULL) {
62990da2b28SAriff Abdullah device_printf(c->dev,
63090da2b28SAriff Abdullah "%s(): failed to get channel caps\n", __func__);
63190da2b28SAriff Abdullah return (ENODEV);
63290da2b28SAriff Abdullah }
63390da2b28SAriff Abdullah
63490da2b28SAriff Abdullah if ((c->format & AFMT_PASSTHROUGH) &&
63590da2b28SAriff Abdullah !snd_fmtvalid(c->format, caps->fmtlist))
63690da2b28SAriff Abdullah return (ENODEV);
63790da2b28SAriff Abdullah
63890da2b28SAriff Abdullah hwfmt = snd_fmtbest(c->format, caps->fmtlist);
63990da2b28SAriff Abdullah if (hwfmt == 0 || !snd_fmtvalid(hwfmt, caps->fmtlist)) {
64090da2b28SAriff Abdullah device_printf(c->dev,
64190da2b28SAriff Abdullah "%s(): invalid hardware format 0x%08x\n",
64290da2b28SAriff Abdullah __func__, hwfmt);
64390da2b28SAriff Abdullah {
64490da2b28SAriff Abdullah int i;
64590da2b28SAriff Abdullah for (i = 0; caps->fmtlist[i] != 0; i++)
64690da2b28SAriff Abdullah printf("0x%08x\n", caps->fmtlist[i]);
64790da2b28SAriff Abdullah printf("Req: 0x%08x\n", c->format);
64890da2b28SAriff Abdullah }
64990da2b28SAriff Abdullah return (ENODEV);
65090da2b28SAriff Abdullah }
65190da2b28SAriff Abdullah }
65290da2b28SAriff Abdullah
65390da2b28SAriff Abdullah /*
65458d868c8SGordon Bergling * The 'hardware' possibly have different interpretation of channel
65590da2b28SAriff Abdullah * matrixing, so get it first .....
65690da2b28SAriff Abdullah */
65790da2b28SAriff Abdullah hwmatrix = CHANNEL_GETMATRIX(c->methods, c->devinfo, hwfmt);
65890da2b28SAriff Abdullah if (hwmatrix == NULL) {
6594ece1a88SHans Petter Selasky /* setup a default matrix */
6604ece1a88SHans Petter Selasky hwmatrix = &c->matrix_scratch;
6614ece1a88SHans Petter Selasky feeder_default_matrix(hwmatrix, hwfmt,
6624ece1a88SHans Petter Selasky SND_CHN_MATRIX_UNKNOWN);
66390da2b28SAriff Abdullah }
66490da2b28SAriff Abdullah /* ..... and rebuild hwfmt. */
66590da2b28SAriff Abdullah hwfmt = SND_FORMAT(hwfmt, hwmatrix->channels, hwmatrix->ext);
66690da2b28SAriff Abdullah
66790da2b28SAriff Abdullah /* Reset and rebuild default channel format/matrix map. */
66890da2b28SAriff Abdullah softfmt = c->format;
66990da2b28SAriff Abdullah softmatrix = &c->matrix;
67090da2b28SAriff Abdullah if (softmatrix->channels != AFMT_CHANNEL(softfmt) ||
67190da2b28SAriff Abdullah softmatrix->ext != AFMT_EXTCHANNEL(softfmt)) {
67290da2b28SAriff Abdullah softmatrix = feeder_matrix_format_map(softfmt);
67390da2b28SAriff Abdullah if (softmatrix == NULL) {
6744ece1a88SHans Petter Selasky /* setup a default matrix */
6754ece1a88SHans Petter Selasky softmatrix = &c->matrix;
6764ece1a88SHans Petter Selasky feeder_default_matrix(softmatrix, softfmt,
6774ece1a88SHans Petter Selasky SND_CHN_MATRIX_PCMCHANNEL);
6784ece1a88SHans Petter Selasky } else {
67990da2b28SAriff Abdullah c->matrix = *softmatrix;
68090da2b28SAriff Abdullah c->matrix.id = SND_CHN_MATRIX_PCMCHANNEL;
68190da2b28SAriff Abdullah }
6824ece1a88SHans Petter Selasky }
68390da2b28SAriff Abdullah softfmt = SND_FORMAT(softfmt, softmatrix->channels, softmatrix->ext);
68490da2b28SAriff Abdullah if (softfmt != c->format)
68590da2b28SAriff Abdullah device_printf(c->dev,
68690da2b28SAriff Abdullah "%s(): WARNING: %s Soft format 0x%08x -> 0x%08x\n",
68790da2b28SAriff Abdullah __func__, CHN_DIRSTR(c), c->format, softfmt);
68890da2b28SAriff Abdullah
68990da2b28SAriff Abdullah /*
69090da2b28SAriff Abdullah * PLAY and REC are opposite.
69190da2b28SAriff Abdullah */
69290da2b28SAriff Abdullah if (c->direction == PCMDIR_PLAY) {
69390da2b28SAriff Abdullah cdesc.origin.afmt = softfmt;
69490da2b28SAriff Abdullah cdesc.origin.matrix = softmatrix;
69590da2b28SAriff Abdullah cdesc.origin.rate = c->speed;
69690da2b28SAriff Abdullah cdesc.target.afmt = hwfmt;
69790da2b28SAriff Abdullah cdesc.target.matrix = hwmatrix;
69890da2b28SAriff Abdullah cdesc.target.rate = sndbuf_getspd(c->bufhard);
69990da2b28SAriff Abdullah } else {
70090da2b28SAriff Abdullah cdesc.origin.afmt = hwfmt;
70190da2b28SAriff Abdullah cdesc.origin.matrix = hwmatrix;
70290da2b28SAriff Abdullah cdesc.origin.rate = sndbuf_getspd(c->bufhard);
70390da2b28SAriff Abdullah cdesc.target.afmt = softfmt;
70490da2b28SAriff Abdullah cdesc.target.matrix = softmatrix;
70590da2b28SAriff Abdullah cdesc.target.rate = c->speed;
70690da2b28SAriff Abdullah }
70790da2b28SAriff Abdullah
70890da2b28SAriff Abdullah d = c->parentsnddev;
70990da2b28SAriff Abdullah
71090da2b28SAriff Abdullah /*
71190da2b28SAriff Abdullah * If channel is in bitperfect or passthrough mode, make it appear
71290da2b28SAriff Abdullah * that 'origin' and 'target' identical, skipping mostly chain
71390da2b28SAriff Abdullah * procedures.
71490da2b28SAriff Abdullah */
71590da2b28SAriff Abdullah if (CHN_BITPERFECT(c) || (c->format & AFMT_PASSTHROUGH)) {
71690da2b28SAriff Abdullah if (c->direction == PCMDIR_PLAY)
71790da2b28SAriff Abdullah cdesc.origin = cdesc.target;
71890da2b28SAriff Abdullah else
71990da2b28SAriff Abdullah cdesc.target = cdesc.origin;
72090da2b28SAriff Abdullah c->format = cdesc.target.afmt;
72190da2b28SAriff Abdullah c->speed = cdesc.target.rate;
72290da2b28SAriff Abdullah } else {
72318457e7eSChristos Margiolis /*
72418457e7eSChristos Margiolis * Bail out early if we do not support either of those formats.
72518457e7eSChristos Margiolis */
72618457e7eSChristos Margiolis if ((cdesc.origin.afmt & AFMT_CONVERTIBLE) == 0 ||
72718457e7eSChristos Margiolis (cdesc.target.afmt & AFMT_CONVERTIBLE) == 0) {
72818457e7eSChristos Margiolis device_printf(c->dev,
72918457e7eSChristos Margiolis "%s(): unsupported formats: in=0x%08x, out=0x%08x\n",
73018457e7eSChristos Margiolis __func__, cdesc.origin.afmt, cdesc.target.afmt);
73118457e7eSChristos Margiolis return (ENODEV);
73218457e7eSChristos Margiolis }
73318457e7eSChristos Margiolis
73490da2b28SAriff Abdullah /* hwfmt is not convertible, so 'dummy' it. */
73590da2b28SAriff Abdullah if (hwfmt & AFMT_PASSTHROUGH)
73690da2b28SAriff Abdullah cdesc.dummy = 1;
73790da2b28SAriff Abdullah
73890da2b28SAriff Abdullah if ((softfmt & AFMT_CONVERTIBLE) &&
73990da2b28SAriff Abdullah (((d->flags & SD_F_VPC) && !(c->flags & CHN_F_HAS_VCHAN)) ||
74090da2b28SAriff Abdullah (!(d->flags & SD_F_VPC) && (d->flags & SD_F_SOFTPCMVOL) &&
74190da2b28SAriff Abdullah !(c->flags & CHN_F_VIRTUAL))))
74290da2b28SAriff Abdullah cdesc.use_volume = 1;
74390da2b28SAriff Abdullah
74490da2b28SAriff Abdullah if (feeder_matrix_compare(cdesc.origin.matrix,
74590da2b28SAriff Abdullah cdesc.target.matrix) != 0)
74690da2b28SAriff Abdullah cdesc.use_matrix = 1;
74790da2b28SAriff Abdullah
74890da2b28SAriff Abdullah /* Soft EQ only applicable for PLAY. */
74990da2b28SAriff Abdullah if (cdesc.dummy == 0 &&
75090da2b28SAriff Abdullah c->direction == PCMDIR_PLAY && (d->flags & SD_F_EQ) &&
75190da2b28SAriff Abdullah (((d->flags & SD_F_EQ_PC) &&
75290da2b28SAriff Abdullah !(c->flags & CHN_F_HAS_VCHAN)) ||
75390da2b28SAriff Abdullah (!(d->flags & SD_F_EQ_PC) && !(c->flags & CHN_F_VIRTUAL))))
75490da2b28SAriff Abdullah cdesc.use_eq = 1;
75590da2b28SAriff Abdullah
75690da2b28SAriff Abdullah if (FEEDFORMAT_NE_REQUIRED(&cdesc)) {
75790da2b28SAriff Abdullah cdesc.afmt_ne =
75890da2b28SAriff Abdullah (cdesc.dummy != 0) ?
75990da2b28SAriff Abdullah snd_fmtbest(AFMT_ENCODING(softfmt),
76090da2b28SAriff Abdullah feeder_chain_formats[cdesc.mode]) :
76190da2b28SAriff Abdullah snd_fmtbest(AFMT_ENCODING(cdesc.target.afmt),
76290da2b28SAriff Abdullah feeder_chain_formats[cdesc.mode]);
76390da2b28SAriff Abdullah if (cdesc.afmt_ne == 0) {
76490da2b28SAriff Abdullah device_printf(c->dev,
76590da2b28SAriff Abdullah "%s(): snd_fmtbest failed!\n", __func__);
76690da2b28SAriff Abdullah cdesc.afmt_ne =
76790da2b28SAriff Abdullah (((cdesc.dummy != 0) ? softfmt :
76890da2b28SAriff Abdullah cdesc.target.afmt) &
76990da2b28SAriff Abdullah (AFMT_24BIT | AFMT_32BIT)) ?
77090da2b28SAriff Abdullah AFMT_S32_NE : AFMT_S16_NE;
77190da2b28SAriff Abdullah }
77290da2b28SAriff Abdullah }
77390da2b28SAriff Abdullah }
77490da2b28SAriff Abdullah
77590da2b28SAriff Abdullah cdesc.current = cdesc.origin;
77690da2b28SAriff Abdullah
77790da2b28SAriff Abdullah /* Build everything. */
77890da2b28SAriff Abdullah
77990da2b28SAriff Abdullah c->feederflags = 0;
78090da2b28SAriff Abdullah
78190da2b28SAriff Abdullah #define FEEDER_BUILD(t) do { \
78290da2b28SAriff Abdullah ret = feeder_build_##t(c, &cdesc); \
78390da2b28SAriff Abdullah if (ret != 0) \
78490da2b28SAriff Abdullah return (ret); \
78590da2b28SAriff Abdullah } while (0)
78690da2b28SAriff Abdullah
78790da2b28SAriff Abdullah if (!(c->flags & CHN_F_HAS_VCHAN) || c->direction == PCMDIR_REC)
78890da2b28SAriff Abdullah FEEDER_BUILD(root);
78990da2b28SAriff Abdullah else if (c->direction == PCMDIR_PLAY && (c->flags & CHN_F_HAS_VCHAN))
79090da2b28SAriff Abdullah FEEDER_BUILD(mixer);
79190da2b28SAriff Abdullah else
79290da2b28SAriff Abdullah return (ENOTSUP);
79390da2b28SAriff Abdullah
79490da2b28SAriff Abdullah /*
79590da2b28SAriff Abdullah * The basic idea is: The smaller the bandwidth, the cheaper the
79690da2b28SAriff Abdullah * conversion process, with following constraints:-
79790da2b28SAriff Abdullah *
79890da2b28SAriff Abdullah * 1) Almost all feeders work best in 16/32 native endian.
79990da2b28SAriff Abdullah * 2) Try to avoid 8bit feeders due to poor dynamic range.
80090da2b28SAriff Abdullah * 3) Avoid volume, format, matrix and rate in BITPERFECT or
80190da2b28SAriff Abdullah * PASSTHROUGH mode.
80290da2b28SAriff Abdullah * 4) Try putting volume before EQ or rate. Should help to
80390da2b28SAriff Abdullah * avoid/reduce possible clipping.
80490da2b28SAriff Abdullah * 5) EQ require specific, valid rate, unless it allow sloppy
80590da2b28SAriff Abdullah * conversion.
80690da2b28SAriff Abdullah */
80790da2b28SAriff Abdullah if (FEEDMATRIX_UP(&cdesc)) {
80890da2b28SAriff Abdullah if (FEEDEQ_REQUIRED(&cdesc) &&
80990da2b28SAriff Abdullah (!FEEDEQ_VALIDRATE(&cdesc, target) ||
81090da2b28SAriff Abdullah (cdesc.expensive == 0 && FEEDEQ_ECONOMY(&cdesc))))
81190da2b28SAriff Abdullah FEEDER_BUILD(eq);
81290da2b28SAriff Abdullah if (FEEDRATE_REQUIRED(&cdesc))
81390da2b28SAriff Abdullah FEEDER_BUILD(rate);
81490da2b28SAriff Abdullah FEEDER_BUILD(matrix);
81590da2b28SAriff Abdullah if (FEEDVOLUME_REQUIRED(&cdesc))
81690da2b28SAriff Abdullah FEEDER_BUILD(volume);
81790da2b28SAriff Abdullah if (FEEDEQ_REQUIRED(&cdesc))
81890da2b28SAriff Abdullah FEEDER_BUILD(eq);
81990da2b28SAriff Abdullah } else if (FEEDMATRIX_DOWN(&cdesc)) {
82090da2b28SAriff Abdullah FEEDER_BUILD(matrix);
82190da2b28SAriff Abdullah if (FEEDVOLUME_REQUIRED(&cdesc))
82290da2b28SAriff Abdullah FEEDER_BUILD(volume);
82390da2b28SAriff Abdullah if (FEEDEQ_REQUIRED(&cdesc) &&
82490da2b28SAriff Abdullah (!FEEDEQ_VALIDRATE(&cdesc, target) ||
82590da2b28SAriff Abdullah FEEDEQ_ECONOMY(&cdesc)))
82690da2b28SAriff Abdullah FEEDER_BUILD(eq);
82790da2b28SAriff Abdullah if (FEEDRATE_REQUIRED(&cdesc))
82890da2b28SAriff Abdullah FEEDER_BUILD(rate);
82990da2b28SAriff Abdullah if (FEEDEQ_REQUIRED(&cdesc))
83090da2b28SAriff Abdullah FEEDER_BUILD(eq);
83190da2b28SAriff Abdullah } else {
83290da2b28SAriff Abdullah if (FEEDRATE_DOWN(&cdesc)) {
83390da2b28SAriff Abdullah if (FEEDEQ_REQUIRED(&cdesc) &&
83490da2b28SAriff Abdullah !FEEDEQ_VALIDRATE(&cdesc, target)) {
83590da2b28SAriff Abdullah if (FEEDVOLUME_REQUIRED(&cdesc))
83690da2b28SAriff Abdullah FEEDER_BUILD(volume);
83790da2b28SAriff Abdullah FEEDER_BUILD(eq);
83890da2b28SAriff Abdullah }
83990da2b28SAriff Abdullah FEEDER_BUILD(rate);
84090da2b28SAriff Abdullah }
84190da2b28SAriff Abdullah if (FEEDMATRIX_REQUIRED(&cdesc))
84290da2b28SAriff Abdullah FEEDER_BUILD(matrix);
84390da2b28SAriff Abdullah if (FEEDVOLUME_REQUIRED(&cdesc))
84490da2b28SAriff Abdullah FEEDER_BUILD(volume);
84590da2b28SAriff Abdullah if (FEEDRATE_UP(&cdesc)) {
84690da2b28SAriff Abdullah if (FEEDEQ_REQUIRED(&cdesc) &&
84790da2b28SAriff Abdullah !FEEDEQ_VALIDRATE(&cdesc, target))
84890da2b28SAriff Abdullah FEEDER_BUILD(eq);
84990da2b28SAriff Abdullah FEEDER_BUILD(rate);
85090da2b28SAriff Abdullah }
85190da2b28SAriff Abdullah if (FEEDEQ_REQUIRED(&cdesc))
85290da2b28SAriff Abdullah FEEDER_BUILD(eq);
85390da2b28SAriff Abdullah }
85490da2b28SAriff Abdullah
85590da2b28SAriff Abdullah if (FEEDFORMAT_REQUIRED(&cdesc))
85690da2b28SAriff Abdullah FEEDER_BUILD(format);
85790da2b28SAriff Abdullah
85890da2b28SAriff Abdullah if (c->direction == PCMDIR_REC && (c->flags & CHN_F_HAS_VCHAN))
85990da2b28SAriff Abdullah FEEDER_BUILD(mixer);
86090da2b28SAriff Abdullah
86190da2b28SAriff Abdullah sndbuf_setfmt(c->bufsoft, c->format);
86290da2b28SAriff Abdullah sndbuf_setspd(c->bufsoft, c->speed);
86390da2b28SAriff Abdullah
86490da2b28SAriff Abdullah sndbuf_setfmt(c->bufhard, hwfmt);
86590da2b28SAriff Abdullah
86690da2b28SAriff Abdullah chn_syncstate(c);
86790da2b28SAriff Abdullah
86890da2b28SAriff Abdullah return (0);
86990da2b28SAriff Abdullah }
870