xref: /freebsd-src/sys/dev/sound/pcm/feeder_chain.c (revision 00172d20070a544e0514cce9f94475c5525fd15e)
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,
10590da2b28SAriff Abdullah 	0
10690da2b28SAriff Abdullah };
10790da2b28SAriff Abdullah 
10890da2b28SAriff Abdullah /* Everything that is convertible. */
10990da2b28SAriff Abdullah static uint32_t feeder_chain_formats_fullmulti[] = {
11090da2b28SAriff Abdullah 	AFMT_S8, AFMT_U8,
11190da2b28SAriff Abdullah 	AFMT_S16_LE, AFMT_S16_BE, AFMT_U16_LE, AFMT_U16_BE,
11290da2b28SAriff Abdullah 	AFMT_S24_LE, AFMT_S24_BE, AFMT_U24_LE, AFMT_U24_BE,
11390da2b28SAriff Abdullah 	AFMT_S32_LE, AFMT_S32_BE, AFMT_U32_LE, AFMT_U32_BE,
11490da2b28SAriff Abdullah 	0
11590da2b28SAriff Abdullah };
11690da2b28SAriff Abdullah 
11790da2b28SAriff Abdullah static uint32_t *feeder_chain_formats[FEEDER_CHAIN_LAST] = {
11890da2b28SAriff Abdullah 	[FEEDER_CHAIN_LEAN]      = feeder_chain_formats_lean,
11990da2b28SAriff Abdullah 	[FEEDER_CHAIN_16]        = feeder_chain_formats_16,
12090da2b28SAriff Abdullah 	[FEEDER_CHAIN_32]        = feeder_chain_formats_32,
12190da2b28SAriff Abdullah 	[FEEDER_CHAIN_MULTI]     = feeder_chain_formats_multi,
12290da2b28SAriff Abdullah 	[FEEDER_CHAIN_FULLMULTI] = feeder_chain_formats_fullmulti
12390da2b28SAriff Abdullah };
12490da2b28SAriff Abdullah 
12590da2b28SAriff Abdullah static int feeder_chain_mode = FEEDER_CHAIN_DEFAULT;
12690da2b28SAriff Abdullah 
12790da2b28SAriff Abdullah #if defined(_KERNEL) && defined(SND_DEBUG) && defined(SND_FEEDER_FULL_MULTIFORMAT)
128af3b2549SHans Petter Selasky SYSCTL_INT(_hw_snd, OID_AUTO, feeder_chain_mode, CTLFLAG_RWTUN,
12990da2b28SAriff Abdullah     &feeder_chain_mode, 0,
13090da2b28SAriff Abdullah     "feeder chain mode "
13190da2b28SAriff Abdullah     "(0=lean, 1=16bit, 2=32bit, 3=multiformat, 4=fullmultiformat)");
13290da2b28SAriff Abdullah #endif
13390da2b28SAriff Abdullah 
13490da2b28SAriff Abdullah /*
13590da2b28SAriff Abdullah  * feeder_build_format(): Chain any format converter.
13690da2b28SAriff Abdullah  */
13790da2b28SAriff Abdullah static int
13890da2b28SAriff Abdullah feeder_build_format(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
13990da2b28SAriff Abdullah {
14090da2b28SAriff Abdullah 	struct feeder_class *fc;
14190da2b28SAriff Abdullah 	struct pcm_feederdesc *desc;
14290da2b28SAriff Abdullah 	int ret;
14390da2b28SAriff Abdullah 
14490da2b28SAriff Abdullah 	desc = &(cdesc->desc);
14590da2b28SAriff Abdullah 	desc->type = FEEDER_FORMAT;
14690da2b28SAriff Abdullah 	desc->in = 0;
14790da2b28SAriff Abdullah 	desc->out = 0;
14890da2b28SAriff Abdullah 	desc->flags = 0;
14990da2b28SAriff Abdullah 
15090da2b28SAriff Abdullah 	fc = feeder_getclass(desc);
15190da2b28SAriff Abdullah 	if (fc == NULL) {
15290da2b28SAriff Abdullah 		device_printf(c->dev,
15390da2b28SAriff Abdullah 		    "%s(): can't find feeder_format\n", __func__);
15490da2b28SAriff Abdullah 		return (ENOTSUP);
15590da2b28SAriff Abdullah 	}
15690da2b28SAriff Abdullah 
15790da2b28SAriff Abdullah 	desc->in = cdesc->current.afmt;
15890da2b28SAriff Abdullah 	desc->out = cdesc->target.afmt;
15990da2b28SAriff Abdullah 
16029ff7b08SChristos Margiolis 	ret = feeder_add(c, fc, desc);
16190da2b28SAriff Abdullah 	if (ret != 0) {
16290da2b28SAriff Abdullah 		device_printf(c->dev,
16390da2b28SAriff Abdullah 		    "%s(): can't add feeder_format\n", __func__);
16490da2b28SAriff Abdullah 		return (ret);
16590da2b28SAriff Abdullah 	}
16690da2b28SAriff Abdullah 
16790da2b28SAriff Abdullah 	c->feederflags |= 1 << FEEDER_FORMAT;
16890da2b28SAriff Abdullah 
16990da2b28SAriff Abdullah 	cdesc->current.afmt = cdesc->target.afmt;
17090da2b28SAriff Abdullah 
17190da2b28SAriff Abdullah 	return (0);
17290da2b28SAriff Abdullah }
17390da2b28SAriff Abdullah 
17490da2b28SAriff Abdullah /*
17590da2b28SAriff Abdullah  * feeder_build_formatne(): Chain format converter that suite best for native
17690da2b28SAriff Abdullah  *                          endian format.
17790da2b28SAriff Abdullah  */
17890da2b28SAriff Abdullah static int
17990da2b28SAriff Abdullah feeder_build_formatne(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
18090da2b28SAriff Abdullah {
18190da2b28SAriff Abdullah 	struct feeder_chain_state otarget;
18290da2b28SAriff Abdullah 	int ret;
18390da2b28SAriff Abdullah 
18490da2b28SAriff Abdullah 	if (cdesc->afmt_ne == 0 ||
18590da2b28SAriff Abdullah 	    AFMT_ENCODING(cdesc->current.afmt) == cdesc->afmt_ne)
18690da2b28SAriff Abdullah 		return (0);
18790da2b28SAriff Abdullah 
18890da2b28SAriff Abdullah 	otarget = cdesc->target;
18990da2b28SAriff Abdullah 	cdesc->target = cdesc->current;
19090da2b28SAriff Abdullah 	cdesc->target.afmt = SND_FORMAT(cdesc->afmt_ne,
19190da2b28SAriff Abdullah 	    cdesc->current.matrix->channels, cdesc->current.matrix->ext);
19290da2b28SAriff Abdullah 
19390da2b28SAriff Abdullah 	ret = feeder_build_format(c, cdesc);
19490da2b28SAriff Abdullah 	if (ret != 0)
19590da2b28SAriff Abdullah 		return (ret);
19690da2b28SAriff Abdullah 
19790da2b28SAriff Abdullah 	cdesc->target = otarget;
19890da2b28SAriff Abdullah 
19990da2b28SAriff Abdullah 	return (0);
20090da2b28SAriff Abdullah }
20190da2b28SAriff Abdullah 
20290da2b28SAriff Abdullah /*
20390da2b28SAriff Abdullah  * feeder_build_rate(): Chain sample rate converter.
20490da2b28SAriff Abdullah  */
20590da2b28SAriff Abdullah static int
20690da2b28SAriff Abdullah feeder_build_rate(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
20790da2b28SAriff Abdullah {
20890da2b28SAriff Abdullah 	struct feeder_class *fc;
20990da2b28SAriff Abdullah 	struct pcm_feeder *f;
21090da2b28SAriff Abdullah 	struct pcm_feederdesc *desc;
21190da2b28SAriff Abdullah 	int ret;
21290da2b28SAriff Abdullah 
21390da2b28SAriff Abdullah 	ret = feeder_build_formatne(c, cdesc);
21490da2b28SAriff Abdullah 	if (ret != 0)
21590da2b28SAriff Abdullah 		return (ret);
21690da2b28SAriff Abdullah 
21790da2b28SAriff Abdullah 	desc = &(cdesc->desc);
21890da2b28SAriff Abdullah 	desc->type = FEEDER_RATE;
21990da2b28SAriff Abdullah 	desc->in = 0;
22090da2b28SAriff Abdullah 	desc->out = 0;
22190da2b28SAriff Abdullah 	desc->flags = 0;
22290da2b28SAriff Abdullah 
22390da2b28SAriff Abdullah 	fc = feeder_getclass(desc);
22490da2b28SAriff Abdullah 	if (fc == NULL) {
22590da2b28SAriff Abdullah 		device_printf(c->dev,
22690da2b28SAriff Abdullah 		    "%s(): can't find feeder_rate\n", __func__);
22790da2b28SAriff Abdullah 		return (ENOTSUP);
22890da2b28SAriff Abdullah 	}
22990da2b28SAriff Abdullah 
23090da2b28SAriff Abdullah 	desc->in = cdesc->current.afmt;
23190da2b28SAriff Abdullah 	desc->out = desc->in;
23290da2b28SAriff Abdullah 
23329ff7b08SChristos Margiolis 	ret = feeder_add(c, fc, desc);
23490da2b28SAriff Abdullah 	if (ret != 0) {
23590da2b28SAriff Abdullah 		device_printf(c->dev,
23690da2b28SAriff Abdullah 		    "%s(): can't add feeder_rate\n", __func__);
23790da2b28SAriff Abdullah 		return (ret);
23890da2b28SAriff Abdullah 	}
23990da2b28SAriff Abdullah 
24090da2b28SAriff Abdullah 	f = c->feeder;
24190da2b28SAriff Abdullah 
24290da2b28SAriff Abdullah 	/*
24390da2b28SAriff Abdullah 	 * If in 'dummy' mode (possibly due to passthrough mode), set the
24490da2b28SAriff Abdullah 	 * conversion quality to the lowest possible (should be fastest) since
24590da2b28SAriff Abdullah 	 * listener won't be hearing anything. Theoretically we can just
24690da2b28SAriff Abdullah 	 * disable it, but that will cause weird runtime behaviour:
24790da2b28SAriff Abdullah 	 * application appear to play something that is either too fast or too
24890da2b28SAriff Abdullah 	 * slow.
24990da2b28SAriff Abdullah 	 */
25090da2b28SAriff Abdullah 	if (cdesc->dummy != 0) {
25190da2b28SAriff Abdullah 		ret = FEEDER_SET(f, FEEDRATE_QUALITY, 0);
25290da2b28SAriff Abdullah 		if (ret != 0) {
25390da2b28SAriff Abdullah 			device_printf(c->dev,
25490da2b28SAriff Abdullah 			    "%s(): can't set resampling quality\n", __func__);
25590da2b28SAriff Abdullah 			return (ret);
25690da2b28SAriff Abdullah 		}
25790da2b28SAriff Abdullah 	}
25890da2b28SAriff Abdullah 
25990da2b28SAriff Abdullah 	ret = FEEDER_SET(f, FEEDRATE_SRC, cdesc->current.rate);
26090da2b28SAriff Abdullah 	if (ret != 0) {
26190da2b28SAriff Abdullah 		device_printf(c->dev,
26290da2b28SAriff Abdullah 		    "%s(): can't set source rate\n", __func__);
26390da2b28SAriff Abdullah 		return (ret);
26490da2b28SAriff Abdullah 	}
26590da2b28SAriff Abdullah 
26690da2b28SAriff Abdullah 	ret = FEEDER_SET(f, FEEDRATE_DST, cdesc->target.rate);
26790da2b28SAriff Abdullah 	if (ret != 0) {
26890da2b28SAriff Abdullah 		device_printf(c->dev,
26990da2b28SAriff Abdullah 		    "%s(): can't set destination rate\n", __func__);
27090da2b28SAriff Abdullah 		return (ret);
27190da2b28SAriff Abdullah 	}
27290da2b28SAriff Abdullah 
27390da2b28SAriff Abdullah 	c->feederflags |= 1 << FEEDER_RATE;
27490da2b28SAriff Abdullah 
27590da2b28SAriff Abdullah 	cdesc->current.rate = cdesc->target.rate;
27690da2b28SAriff Abdullah 
27790da2b28SAriff Abdullah 	return (0);
27890da2b28SAriff Abdullah }
27990da2b28SAriff Abdullah 
28090da2b28SAriff Abdullah /*
28190da2b28SAriff Abdullah  * feeder_build_matrix(): Chain channel matrixing converter.
28290da2b28SAriff Abdullah  */
28390da2b28SAriff Abdullah static int
28490da2b28SAriff Abdullah feeder_build_matrix(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
28590da2b28SAriff Abdullah {
28690da2b28SAriff Abdullah 	struct feeder_class *fc;
28790da2b28SAriff Abdullah 	struct pcm_feeder *f;
28890da2b28SAriff Abdullah 	struct pcm_feederdesc *desc;
28990da2b28SAriff Abdullah 	int ret;
29090da2b28SAriff Abdullah 
29190da2b28SAriff Abdullah 	ret = feeder_build_formatne(c, cdesc);
29290da2b28SAriff Abdullah 	if (ret != 0)
29390da2b28SAriff Abdullah 		return (ret);
29490da2b28SAriff Abdullah 
29590da2b28SAriff Abdullah 	desc = &(cdesc->desc);
29690da2b28SAriff Abdullah 	desc->type = FEEDER_MATRIX;
29790da2b28SAriff Abdullah 	desc->in = 0;
29890da2b28SAriff Abdullah 	desc->out = 0;
29990da2b28SAriff Abdullah 	desc->flags = 0;
30090da2b28SAriff Abdullah 
30190da2b28SAriff Abdullah 	fc = feeder_getclass(desc);
30290da2b28SAriff Abdullah 	if (fc == NULL) {
30390da2b28SAriff Abdullah 		device_printf(c->dev,
30490da2b28SAriff Abdullah 		    "%s(): can't find feeder_matrix\n", __func__);
30590da2b28SAriff Abdullah 		return (ENOTSUP);
30690da2b28SAriff Abdullah 	}
30790da2b28SAriff Abdullah 
30890da2b28SAriff Abdullah 	desc->in = cdesc->current.afmt;
30990da2b28SAriff Abdullah 	desc->out = SND_FORMAT(cdesc->current.afmt,
31090da2b28SAriff Abdullah 	    cdesc->target.matrix->channels, cdesc->target.matrix->ext);
31190da2b28SAriff Abdullah 
31229ff7b08SChristos Margiolis 	ret = feeder_add(c, fc, desc);
31390da2b28SAriff Abdullah 	if (ret != 0) {
31490da2b28SAriff Abdullah 		device_printf(c->dev,
31590da2b28SAriff Abdullah 		    "%s(): can't add feeder_matrix\n", __func__);
31690da2b28SAriff Abdullah 		return (ret);
31790da2b28SAriff Abdullah 	}
31890da2b28SAriff Abdullah 
31990da2b28SAriff Abdullah 	f = c->feeder;
32090da2b28SAriff Abdullah 	ret = feeder_matrix_setup(f, cdesc->current.matrix,
32190da2b28SAriff Abdullah 	    cdesc->target.matrix);
32290da2b28SAriff Abdullah 	if (ret != 0) {
32390da2b28SAriff Abdullah 		device_printf(c->dev,
32490da2b28SAriff Abdullah 		    "%s(): feeder_matrix_setup() failed\n", __func__);
32590da2b28SAriff Abdullah 		return (ret);
32690da2b28SAriff Abdullah 	}
32790da2b28SAriff Abdullah 
32890da2b28SAriff Abdullah 	c->feederflags |= 1 << FEEDER_MATRIX;
32990da2b28SAriff Abdullah 
33090da2b28SAriff Abdullah 	cdesc->current.afmt = desc->out;
33190da2b28SAriff Abdullah 	cdesc->current.matrix = cdesc->target.matrix;
33290da2b28SAriff Abdullah 	cdesc->use_matrix = 0;
33390da2b28SAriff Abdullah 
33490da2b28SAriff Abdullah 	return (0);
33590da2b28SAriff Abdullah }
33690da2b28SAriff Abdullah 
33790da2b28SAriff Abdullah /*
33890da2b28SAriff Abdullah  * feeder_build_volume(): Chain soft volume.
33990da2b28SAriff Abdullah  */
34090da2b28SAriff Abdullah static int
34190da2b28SAriff Abdullah feeder_build_volume(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
34290da2b28SAriff Abdullah {
34390da2b28SAriff Abdullah 	struct feeder_class *fc;
34490da2b28SAriff Abdullah 	struct pcm_feeder *f;
34590da2b28SAriff Abdullah 	struct pcm_feederdesc *desc;
34690da2b28SAriff Abdullah 	int ret;
34790da2b28SAriff Abdullah 
34890da2b28SAriff Abdullah 	ret = feeder_build_formatne(c, cdesc);
34990da2b28SAriff Abdullah 	if (ret != 0)
35090da2b28SAriff Abdullah 		return (ret);
35190da2b28SAriff Abdullah 
35290da2b28SAriff Abdullah 	desc = &(cdesc->desc);
35390da2b28SAriff Abdullah 	desc->type = FEEDER_VOLUME;
35490da2b28SAriff Abdullah 	desc->in = 0;
35590da2b28SAriff Abdullah 	desc->out = 0;
35690da2b28SAriff Abdullah 	desc->flags = 0;
35790da2b28SAriff Abdullah 
35890da2b28SAriff Abdullah 	fc = feeder_getclass(desc);
35990da2b28SAriff Abdullah 	if (fc == NULL) {
36090da2b28SAriff Abdullah 		device_printf(c->dev,
36190da2b28SAriff Abdullah 		    "%s(): can't find feeder_volume\n", __func__);
36290da2b28SAriff Abdullah 		return (ENOTSUP);
36390da2b28SAriff Abdullah 	}
36490da2b28SAriff Abdullah 
36590da2b28SAriff Abdullah 	desc->in = cdesc->current.afmt;
36690da2b28SAriff Abdullah 	desc->out = desc->in;
36790da2b28SAriff Abdullah 
36829ff7b08SChristos Margiolis 	ret = feeder_add(c, fc, desc);
36990da2b28SAriff Abdullah 	if (ret != 0) {
37090da2b28SAriff Abdullah 		device_printf(c->dev,
37190da2b28SAriff Abdullah 		    "%s(): can't add feeder_volume\n", __func__);
37290da2b28SAriff Abdullah 		return (ret);
37390da2b28SAriff Abdullah 	}
37490da2b28SAriff Abdullah 
37590da2b28SAriff Abdullah 	f = c->feeder;
37690da2b28SAriff Abdullah 
37790da2b28SAriff Abdullah 	/*
37890da2b28SAriff Abdullah 	 * If in 'dummy' mode (possibly due to passthrough mode), set BYPASS
37990da2b28SAriff Abdullah 	 * mode since listener won't be hearing anything. Theoretically we can
38090da2b28SAriff Abdullah 	 * just disable it, but that will confuse volume per channel mixer.
38190da2b28SAriff Abdullah 	 */
38290da2b28SAriff Abdullah 	if (cdesc->dummy != 0) {
38390da2b28SAriff Abdullah 		ret = FEEDER_SET(f, FEEDVOLUME_STATE, FEEDVOLUME_BYPASS);
38490da2b28SAriff Abdullah 		if (ret != 0) {
38590da2b28SAriff Abdullah 			device_printf(c->dev,
38690da2b28SAriff Abdullah 			    "%s(): can't set volume bypass\n", __func__);
38790da2b28SAriff Abdullah 			return (ret);
38890da2b28SAriff Abdullah 		}
38990da2b28SAriff Abdullah 	}
39090da2b28SAriff Abdullah 
39190da2b28SAriff Abdullah 	ret = feeder_volume_apply_matrix(f, cdesc->current.matrix);
39290da2b28SAriff Abdullah 	if (ret != 0) {
39390da2b28SAriff Abdullah 		device_printf(c->dev,
39490da2b28SAriff Abdullah 		    "%s(): feeder_volume_apply_matrix() failed\n", __func__);
39590da2b28SAriff Abdullah 		return (ret);
39690da2b28SAriff Abdullah 	}
39790da2b28SAriff Abdullah 
39890da2b28SAriff Abdullah 	c->feederflags |= 1 << FEEDER_VOLUME;
39990da2b28SAriff Abdullah 
40090da2b28SAriff Abdullah 	cdesc->use_volume = 0;
40190da2b28SAriff Abdullah 
40290da2b28SAriff Abdullah 	return (0);
40390da2b28SAriff Abdullah }
40490da2b28SAriff Abdullah 
40590da2b28SAriff Abdullah /*
40690da2b28SAriff Abdullah  * feeder_build_eq(): Chain parametric software equalizer.
40790da2b28SAriff Abdullah  */
40890da2b28SAriff Abdullah static int
40990da2b28SAriff Abdullah feeder_build_eq(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
41090da2b28SAriff Abdullah {
41190da2b28SAriff Abdullah 	struct feeder_class *fc;
41290da2b28SAriff Abdullah 	struct pcm_feeder *f;
41390da2b28SAriff Abdullah 	struct pcm_feederdesc *desc;
41490da2b28SAriff Abdullah 	int ret;
41590da2b28SAriff Abdullah 
41690da2b28SAriff Abdullah 	ret = feeder_build_formatne(c, cdesc);
41790da2b28SAriff Abdullah 	if (ret != 0)
41890da2b28SAriff Abdullah 		return (ret);
41990da2b28SAriff Abdullah 
42090da2b28SAriff Abdullah 	desc = &(cdesc->desc);
42190da2b28SAriff Abdullah 	desc->type = FEEDER_EQ;
42290da2b28SAriff Abdullah 	desc->in = 0;
42390da2b28SAriff Abdullah 	desc->out = 0;
42490da2b28SAriff Abdullah 	desc->flags = 0;
42590da2b28SAriff Abdullah 
42690da2b28SAriff Abdullah 	fc = feeder_getclass(desc);
42790da2b28SAriff Abdullah 	if (fc == NULL) {
42890da2b28SAriff Abdullah 		device_printf(c->dev,
42990da2b28SAriff Abdullah 		    "%s(): can't find feeder_eq\n", __func__);
43090da2b28SAriff Abdullah 		return (ENOTSUP);
43190da2b28SAriff Abdullah 	}
43290da2b28SAriff Abdullah 
43390da2b28SAriff Abdullah 	desc->in = cdesc->current.afmt;
43490da2b28SAriff Abdullah 	desc->out = desc->in;
43590da2b28SAriff Abdullah 
43629ff7b08SChristos Margiolis 	ret = feeder_add(c, fc, desc);
43790da2b28SAriff Abdullah 	if (ret != 0) {
43890da2b28SAriff Abdullah 		device_printf(c->dev,
43990da2b28SAriff Abdullah 		    "%s(): can't add feeder_eq\n", __func__);
44090da2b28SAriff Abdullah 		return (ret);
44190da2b28SAriff Abdullah 	}
44290da2b28SAriff Abdullah 
44390da2b28SAriff Abdullah 	f = c->feeder;
44490da2b28SAriff Abdullah 
44590da2b28SAriff Abdullah 	ret = FEEDER_SET(f, FEEDEQ_RATE, cdesc->current.rate);
44690da2b28SAriff Abdullah 	if (ret != 0) {
44790da2b28SAriff Abdullah 		device_printf(c->dev,
44890da2b28SAriff Abdullah 		    "%s(): can't set rate on feeder_eq\n", __func__);
44990da2b28SAriff Abdullah 		return (ret);
45090da2b28SAriff Abdullah 	}
45190da2b28SAriff Abdullah 
45290da2b28SAriff Abdullah 	c->feederflags |= 1 << FEEDER_EQ;
45390da2b28SAriff Abdullah 
45490da2b28SAriff Abdullah 	cdesc->use_eq = 0;
45590da2b28SAriff Abdullah 
45690da2b28SAriff Abdullah 	return (0);
45790da2b28SAriff Abdullah }
45890da2b28SAriff Abdullah 
45990da2b28SAriff Abdullah /*
46090da2b28SAriff Abdullah  * feeder_build_root(): Chain root feeder, the top, father of all.
46190da2b28SAriff Abdullah  */
46290da2b28SAriff Abdullah static int
46390da2b28SAriff Abdullah feeder_build_root(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
46490da2b28SAriff Abdullah {
46590da2b28SAriff Abdullah 	struct feeder_class *fc;
46690da2b28SAriff Abdullah 	int ret;
46790da2b28SAriff Abdullah 
46890da2b28SAriff Abdullah 	fc = feeder_getclass(NULL);
46990da2b28SAriff Abdullah 	if (fc == NULL) {
47090da2b28SAriff Abdullah 		device_printf(c->dev,
47190da2b28SAriff Abdullah 		    "%s(): can't find feeder_root\n", __func__);
47290da2b28SAriff Abdullah 		return (ENOTSUP);
47390da2b28SAriff Abdullah 	}
47490da2b28SAriff Abdullah 
47529ff7b08SChristos Margiolis 	ret = feeder_add(c, fc, NULL);
47690da2b28SAriff Abdullah 	if (ret != 0) {
47790da2b28SAriff Abdullah 		device_printf(c->dev,
47890da2b28SAriff Abdullah 		    "%s(): can't add feeder_root\n", __func__);
47990da2b28SAriff Abdullah 		return (ret);
48090da2b28SAriff Abdullah 	}
48190da2b28SAriff Abdullah 
48290da2b28SAriff Abdullah 	c->feederflags |= 1 << FEEDER_ROOT;
48390da2b28SAriff Abdullah 
48490da2b28SAriff Abdullah 	c->feeder->desc->in = cdesc->current.afmt;
48590da2b28SAriff Abdullah 	c->feeder->desc->out = cdesc->current.afmt;
48690da2b28SAriff Abdullah 
48790da2b28SAriff Abdullah 	return (0);
48890da2b28SAriff Abdullah }
48990da2b28SAriff Abdullah 
49090da2b28SAriff Abdullah /*
49190da2b28SAriff Abdullah  * feeder_build_mixer(): Chain software mixer for virtual channels.
49290da2b28SAriff Abdullah  */
49390da2b28SAriff Abdullah static int
49490da2b28SAriff Abdullah feeder_build_mixer(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
49590da2b28SAriff Abdullah {
49690da2b28SAriff Abdullah 	struct feeder_class *fc;
49790da2b28SAriff Abdullah 	struct pcm_feederdesc *desc;
49890da2b28SAriff Abdullah 	int ret;
49990da2b28SAriff Abdullah 
50090da2b28SAriff Abdullah 	desc = &(cdesc->desc);
50190da2b28SAriff Abdullah 	desc->type = FEEDER_MIXER;
50290da2b28SAriff Abdullah 	desc->in = 0;
50390da2b28SAriff Abdullah 	desc->out = 0;
50490da2b28SAriff Abdullah 	desc->flags = 0;
50590da2b28SAriff Abdullah 
50690da2b28SAriff Abdullah 	fc = feeder_getclass(desc);
50790da2b28SAriff Abdullah 	if (fc == NULL) {
50890da2b28SAriff Abdullah 		device_printf(c->dev,
50990da2b28SAriff Abdullah 		    "%s(): can't find feeder_mixer\n", __func__);
51090da2b28SAriff Abdullah 		return (ENOTSUP);
51190da2b28SAriff Abdullah 	}
51290da2b28SAriff Abdullah 
51390da2b28SAriff Abdullah 	desc->in = cdesc->current.afmt;
51490da2b28SAriff Abdullah 	desc->out = desc->in;
51590da2b28SAriff Abdullah 
51629ff7b08SChristos Margiolis 	ret = feeder_add(c, fc, desc);
51790da2b28SAriff Abdullah 	if (ret != 0) {
51890da2b28SAriff Abdullah 		device_printf(c->dev,
51990da2b28SAriff Abdullah 		    "%s(): can't add feeder_mixer\n", __func__);
52090da2b28SAriff Abdullah 		return (ret);
52190da2b28SAriff Abdullah 	}
52290da2b28SAriff Abdullah 
52390da2b28SAriff Abdullah 	c->feederflags |= 1 << FEEDER_MIXER;
52490da2b28SAriff Abdullah 
52590da2b28SAriff Abdullah 	return (0);
52690da2b28SAriff Abdullah }
52790da2b28SAriff Abdullah 
52890da2b28SAriff Abdullah /* Macrosses to ease our job doing stuffs later. */
52990da2b28SAriff Abdullah #define FEEDER_BW(c, t)		((c)->t.matrix->channels * (c)->t.rate)
53090da2b28SAriff Abdullah 
53190da2b28SAriff Abdullah #define FEEDRATE_UP(c)		((c)->target.rate > (c)->current.rate)
53290da2b28SAriff Abdullah #define FEEDRATE_DOWN(c)	((c)->target.rate < (c)->current.rate)
53390da2b28SAriff Abdullah #define FEEDRATE_REQUIRED(c)	(FEEDRATE_UP(c) || FEEDRATE_DOWN(c))
53490da2b28SAriff Abdullah 
53590da2b28SAriff Abdullah #define FEEDMATRIX_UP(c)	((c)->target.matrix->channels >		\
53690da2b28SAriff Abdullah 				 (c)->current.matrix->channels)
53790da2b28SAriff Abdullah #define FEEDMATRIX_DOWN(c)	((c)->target.matrix->channels <		\
53890da2b28SAriff Abdullah 				 (c)->current.matrix->channels)
53990da2b28SAriff Abdullah #define FEEDMATRIX_REQUIRED(c)	(FEEDMATRIX_UP(c) ||			\
54090da2b28SAriff Abdullah 				 FEEDMATRIX_DOWN(c) || (c)->use_matrix != 0)
54190da2b28SAriff Abdullah 
54290da2b28SAriff Abdullah #define FEEDFORMAT_REQUIRED(c)	(AFMT_ENCODING((c)->current.afmt) !=	\
54390da2b28SAriff Abdullah 				 AFMT_ENCODING((c)->target.afmt))
54490da2b28SAriff Abdullah 
54590da2b28SAriff Abdullah #define FEEDVOLUME_REQUIRED(c)	((c)->use_volume != 0)
54690da2b28SAriff Abdullah 
54790da2b28SAriff Abdullah #define FEEDEQ_VALIDRATE(c, t)	(feeder_eq_validrate((c)->t.rate) != 0)
54890da2b28SAriff Abdullah #define FEEDEQ_ECONOMY(c)	(FEEDER_BW(c, current) < FEEDER_BW(c, target))
54990da2b28SAriff Abdullah #define FEEDEQ_REQUIRED(c)	((c)->use_eq != 0 &&			\
55090da2b28SAriff Abdullah 				 FEEDEQ_VALIDRATE(c, current))
55190da2b28SAriff Abdullah 
55290da2b28SAriff Abdullah #define FEEDFORMAT_NE_REQUIRED(c)					\
55390da2b28SAriff Abdullah 	((c)->afmt_ne != AFMT_S32_NE &&					\
55490da2b28SAriff Abdullah 	(((c)->mode == FEEDER_CHAIN_16 &&				\
55590da2b28SAriff Abdullah 	AFMT_ENCODING((c)->current.afmt) != AFMT_S16_NE) ||		\
55690da2b28SAriff Abdullah 	((c)->mode == FEEDER_CHAIN_32 &&				\
55790da2b28SAriff Abdullah 	AFMT_ENCODING((c)->current.afmt) != AFMT_S32_NE) ||		\
55890da2b28SAriff Abdullah 	(c)->mode == FEEDER_CHAIN_FULLMULTI ||				\
55990da2b28SAriff Abdullah 	((c)->mode == FEEDER_CHAIN_MULTI &&				\
56090da2b28SAriff Abdullah 	((c)->current.afmt & AFMT_8BIT)) ||				\
56190da2b28SAriff Abdullah 	((c)->mode == FEEDER_CHAIN_LEAN &&				\
56290da2b28SAriff Abdullah 	!((c)->current.afmt & (AFMT_S16_NE | AFMT_S32_NE)))))
56390da2b28SAriff Abdullah 
5644ece1a88SHans Petter Selasky static void
5654ece1a88SHans Petter Selasky feeder_default_matrix(struct pcmchan_matrix *m, uint32_t fmt, int id)
5664ece1a88SHans Petter Selasky {
5674ece1a88SHans Petter Selasky 	int x;
5684ece1a88SHans Petter Selasky 
5694ece1a88SHans Petter Selasky 	memset(m, 0, sizeof(*m));
5704ece1a88SHans Petter Selasky 
5714ece1a88SHans Petter Selasky 	m->id = id;
5724ece1a88SHans Petter Selasky 	m->channels = AFMT_CHANNEL(fmt);
5734ece1a88SHans Petter Selasky 	m->ext = AFMT_EXTCHANNEL(fmt);
5744ece1a88SHans Petter Selasky 	for (x = 0; x != SND_CHN_T_MAX; x++)
5754ece1a88SHans Petter Selasky 		m->offset[x] = -1;
5764ece1a88SHans Petter Selasky }
5774ece1a88SHans Petter Selasky 
57890da2b28SAriff Abdullah int
57990da2b28SAriff Abdullah feeder_chain(struct pcm_channel *c)
58090da2b28SAriff Abdullah {
58190da2b28SAriff Abdullah 	struct snddev_info *d;
58290da2b28SAriff Abdullah 	struct pcmchan_caps *caps;
58390da2b28SAriff Abdullah 	struct feeder_chain_desc cdesc;
58490da2b28SAriff Abdullah 	struct pcmchan_matrix *hwmatrix, *softmatrix;
58590da2b28SAriff Abdullah 	uint32_t hwfmt, softfmt;
58690da2b28SAriff Abdullah 	int ret;
58790da2b28SAriff Abdullah 
58890da2b28SAriff Abdullah 	CHN_LOCKASSERT(c);
58990da2b28SAriff Abdullah 
59090da2b28SAriff Abdullah 	/* Remove everything first. */
591*00172d20SChristos Margiolis 	feeder_remove(c);
59290da2b28SAriff Abdullah 
59390da2b28SAriff Abdullah 	KASSERT(c->feeder == NULL, ("feeder chain not empty"));
59490da2b28SAriff Abdullah 
59590da2b28SAriff Abdullah 	/* clear and populate chain descriptor. */
59690da2b28SAriff Abdullah 	bzero(&cdesc, sizeof(cdesc));
59790da2b28SAriff Abdullah 
59890da2b28SAriff Abdullah 	switch (feeder_chain_mode) {
59990da2b28SAriff Abdullah 	case FEEDER_CHAIN_LEAN:
60090da2b28SAriff Abdullah 	case FEEDER_CHAIN_16:
60190da2b28SAriff Abdullah 	case FEEDER_CHAIN_32:
60290da2b28SAriff Abdullah #if defined(SND_FEEDER_MULTIFORMAT) || defined(SND_FEEDER_FULL_MULTIFORMAT)
60390da2b28SAriff Abdullah 	case FEEDER_CHAIN_MULTI:
60490da2b28SAriff Abdullah #endif
60590da2b28SAriff Abdullah #if defined(SND_FEEDER_FULL_MULTIFORMAT)
60690da2b28SAriff Abdullah 	case FEEDER_CHAIN_FULLMULTI:
60790da2b28SAriff Abdullah #endif
60890da2b28SAriff Abdullah 		break;
60990da2b28SAriff Abdullah 	default:
61090da2b28SAriff Abdullah 		feeder_chain_mode = FEEDER_CHAIN_DEFAULT;
61190da2b28SAriff Abdullah 		break;
61290da2b28SAriff Abdullah 	}
61390da2b28SAriff Abdullah 
61490da2b28SAriff Abdullah 	cdesc.mode = feeder_chain_mode;
61590da2b28SAriff Abdullah 	cdesc.expensive = 1;	/* XXX faster.. */
61690da2b28SAriff Abdullah 
61790da2b28SAriff Abdullah #define VCHAN_PASSTHROUGH(c)	(((c)->flags & (CHN_F_VIRTUAL |		\
61890da2b28SAriff Abdullah 				 CHN_F_PASSTHROUGH)) ==			\
61990da2b28SAriff Abdullah 				 (CHN_F_VIRTUAL | CHN_F_PASSTHROUGH))
62090da2b28SAriff Abdullah 
62190da2b28SAriff Abdullah 	/* Get the best possible hardware format. */
62290da2b28SAriff Abdullah 	if (VCHAN_PASSTHROUGH(c))
62390da2b28SAriff Abdullah 		hwfmt = c->parentchannel->format;
62490da2b28SAriff Abdullah 	else {
62590da2b28SAriff Abdullah 		caps = chn_getcaps(c);
62690da2b28SAriff Abdullah 		if (caps == NULL || caps->fmtlist == NULL) {
62790da2b28SAriff Abdullah 			device_printf(c->dev,
62890da2b28SAriff Abdullah 			    "%s(): failed to get channel caps\n", __func__);
62990da2b28SAriff Abdullah 			return (ENODEV);
63090da2b28SAriff Abdullah 		}
63190da2b28SAriff Abdullah 
63290da2b28SAriff Abdullah 		if ((c->format & AFMT_PASSTHROUGH) &&
63390da2b28SAriff Abdullah 		    !snd_fmtvalid(c->format, caps->fmtlist))
63490da2b28SAriff Abdullah 			return (ENODEV);
63590da2b28SAriff Abdullah 
63690da2b28SAriff Abdullah 		hwfmt = snd_fmtbest(c->format, caps->fmtlist);
63790da2b28SAriff Abdullah 		if (hwfmt == 0 || !snd_fmtvalid(hwfmt, caps->fmtlist)) {
63890da2b28SAriff Abdullah 			device_printf(c->dev,
63990da2b28SAriff Abdullah 			    "%s(): invalid hardware format 0x%08x\n",
64090da2b28SAriff Abdullah 			    __func__, hwfmt);
64190da2b28SAriff Abdullah 			{
64290da2b28SAriff Abdullah 				int i;
64390da2b28SAriff Abdullah 				for (i = 0; caps->fmtlist[i] != 0; i++)
64490da2b28SAriff Abdullah 					printf("0x%08x\n", caps->fmtlist[i]);
64590da2b28SAriff Abdullah 				printf("Req: 0x%08x\n", c->format);
64690da2b28SAriff Abdullah 			}
64790da2b28SAriff Abdullah 			return (ENODEV);
64890da2b28SAriff Abdullah 		}
64990da2b28SAriff Abdullah 	}
65090da2b28SAriff Abdullah 
65190da2b28SAriff Abdullah 	/*
65258d868c8SGordon Bergling 	 * The 'hardware' possibly have different interpretation of channel
65390da2b28SAriff Abdullah 	 * matrixing, so get it first .....
65490da2b28SAriff Abdullah 	 */
65590da2b28SAriff Abdullah 	hwmatrix = CHANNEL_GETMATRIX(c->methods, c->devinfo, hwfmt);
65690da2b28SAriff Abdullah 	if (hwmatrix == NULL) {
6574ece1a88SHans Petter Selasky 		/* setup a default matrix */
6584ece1a88SHans Petter Selasky 		hwmatrix = &c->matrix_scratch;
6594ece1a88SHans Petter Selasky 		feeder_default_matrix(hwmatrix, hwfmt,
6604ece1a88SHans Petter Selasky 		    SND_CHN_MATRIX_UNKNOWN);
66190da2b28SAriff Abdullah 	}
66290da2b28SAriff Abdullah 	/* ..... and rebuild hwfmt. */
66390da2b28SAriff Abdullah 	hwfmt = SND_FORMAT(hwfmt, hwmatrix->channels, hwmatrix->ext);
66490da2b28SAriff Abdullah 
66590da2b28SAriff Abdullah 	/* Reset and rebuild default channel format/matrix map. */
66690da2b28SAriff Abdullah 	softfmt = c->format;
66790da2b28SAriff Abdullah 	softmatrix = &c->matrix;
66890da2b28SAriff Abdullah 	if (softmatrix->channels != AFMT_CHANNEL(softfmt) ||
66990da2b28SAriff Abdullah 	    softmatrix->ext != AFMT_EXTCHANNEL(softfmt)) {
67090da2b28SAriff Abdullah 		softmatrix = feeder_matrix_format_map(softfmt);
67190da2b28SAriff Abdullah 		if (softmatrix == NULL) {
6724ece1a88SHans Petter Selasky 			/* setup a default matrix */
6734ece1a88SHans Petter Selasky 		  	softmatrix = &c->matrix;
6744ece1a88SHans Petter Selasky 			feeder_default_matrix(softmatrix, softfmt,
6754ece1a88SHans Petter Selasky 			    SND_CHN_MATRIX_PCMCHANNEL);
6764ece1a88SHans Petter Selasky 		} else {
67790da2b28SAriff Abdullah 			c->matrix = *softmatrix;
67890da2b28SAriff Abdullah 			c->matrix.id = SND_CHN_MATRIX_PCMCHANNEL;
67990da2b28SAriff Abdullah 		}
6804ece1a88SHans Petter Selasky 	}
68190da2b28SAriff Abdullah 	softfmt = SND_FORMAT(softfmt, softmatrix->channels, softmatrix->ext);
68290da2b28SAriff Abdullah 	if (softfmt != c->format)
68390da2b28SAriff Abdullah 		device_printf(c->dev,
68490da2b28SAriff Abdullah 		    "%s(): WARNING: %s Soft format 0x%08x -> 0x%08x\n",
68590da2b28SAriff Abdullah 		    __func__, CHN_DIRSTR(c), c->format, softfmt);
68690da2b28SAriff Abdullah 
68790da2b28SAriff Abdullah 	/*
68890da2b28SAriff Abdullah 	 * PLAY and REC are opposite.
68990da2b28SAriff Abdullah 	 */
69090da2b28SAriff Abdullah 	if (c->direction == PCMDIR_PLAY) {
69190da2b28SAriff Abdullah 		cdesc.origin.afmt    = softfmt;
69290da2b28SAriff Abdullah 		cdesc.origin.matrix  = softmatrix;
69390da2b28SAriff Abdullah 		cdesc.origin.rate    = c->speed;
69490da2b28SAriff Abdullah 		cdesc.target.afmt    = hwfmt;
69590da2b28SAriff Abdullah 		cdesc.target.matrix  = hwmatrix;
69690da2b28SAriff Abdullah 		cdesc.target.rate    = sndbuf_getspd(c->bufhard);
69790da2b28SAriff Abdullah 	} else {
69890da2b28SAriff Abdullah 		cdesc.origin.afmt    = hwfmt;
69990da2b28SAriff Abdullah 		cdesc.origin.matrix  = hwmatrix;
70090da2b28SAriff Abdullah 		cdesc.origin.rate    = sndbuf_getspd(c->bufhard);
70190da2b28SAriff Abdullah 		cdesc.target.afmt    = softfmt;
70290da2b28SAriff Abdullah 		cdesc.target.matrix  = softmatrix;
70390da2b28SAriff Abdullah 		cdesc.target.rate    = c->speed;
70490da2b28SAriff Abdullah 	}
70590da2b28SAriff Abdullah 
70690da2b28SAriff Abdullah 	d = c->parentsnddev;
70790da2b28SAriff Abdullah 
70890da2b28SAriff Abdullah 	/*
70990da2b28SAriff Abdullah 	 * If channel is in bitperfect or passthrough mode, make it appear
71090da2b28SAriff Abdullah 	 * that 'origin' and 'target' identical, skipping mostly chain
71190da2b28SAriff Abdullah 	 * procedures.
71290da2b28SAriff Abdullah 	 */
71390da2b28SAriff Abdullah 	if (CHN_BITPERFECT(c) || (c->format & AFMT_PASSTHROUGH)) {
71490da2b28SAriff Abdullah 		if (c->direction == PCMDIR_PLAY)
71590da2b28SAriff Abdullah 			cdesc.origin = cdesc.target;
71690da2b28SAriff Abdullah 		else
71790da2b28SAriff Abdullah 			cdesc.target = cdesc.origin;
71890da2b28SAriff Abdullah 		c->format = cdesc.target.afmt;
71990da2b28SAriff Abdullah 		c->speed  = cdesc.target.rate;
72090da2b28SAriff Abdullah 	} else {
72190da2b28SAriff Abdullah 		/* hwfmt is not convertible, so 'dummy' it. */
72290da2b28SAriff Abdullah 		if (hwfmt & AFMT_PASSTHROUGH)
72390da2b28SAriff Abdullah 			cdesc.dummy = 1;
72490da2b28SAriff Abdullah 
72590da2b28SAriff Abdullah 		if ((softfmt & AFMT_CONVERTIBLE) &&
72690da2b28SAriff Abdullah 		    (((d->flags & SD_F_VPC) && !(c->flags & CHN_F_HAS_VCHAN)) ||
72790da2b28SAriff Abdullah 		    (!(d->flags & SD_F_VPC) && (d->flags & SD_F_SOFTPCMVOL) &&
72890da2b28SAriff Abdullah 		    !(c->flags & CHN_F_VIRTUAL))))
72990da2b28SAriff Abdullah 			cdesc.use_volume = 1;
73090da2b28SAriff Abdullah 
73190da2b28SAriff Abdullah 		if (feeder_matrix_compare(cdesc.origin.matrix,
73290da2b28SAriff Abdullah 		    cdesc.target.matrix) != 0)
73390da2b28SAriff Abdullah 			cdesc.use_matrix = 1;
73490da2b28SAriff Abdullah 
73590da2b28SAriff Abdullah 		/* Soft EQ only applicable for PLAY. */
73690da2b28SAriff Abdullah 		if (cdesc.dummy == 0 &&
73790da2b28SAriff Abdullah 		    c->direction == PCMDIR_PLAY && (d->flags & SD_F_EQ) &&
73890da2b28SAriff Abdullah 		    (((d->flags & SD_F_EQ_PC) &&
73990da2b28SAriff Abdullah 		    !(c->flags & CHN_F_HAS_VCHAN)) ||
74090da2b28SAriff Abdullah 		    (!(d->flags & SD_F_EQ_PC) && !(c->flags & CHN_F_VIRTUAL))))
74190da2b28SAriff Abdullah 			cdesc.use_eq = 1;
74290da2b28SAriff Abdullah 
74390da2b28SAriff Abdullah 		if (FEEDFORMAT_NE_REQUIRED(&cdesc)) {
74490da2b28SAriff Abdullah 			cdesc.afmt_ne =
74590da2b28SAriff Abdullah 			    (cdesc.dummy != 0) ?
74690da2b28SAriff Abdullah 			    snd_fmtbest(AFMT_ENCODING(softfmt),
74790da2b28SAriff Abdullah 			    feeder_chain_formats[cdesc.mode]) :
74890da2b28SAriff Abdullah 			    snd_fmtbest(AFMT_ENCODING(cdesc.target.afmt),
74990da2b28SAriff Abdullah 			    feeder_chain_formats[cdesc.mode]);
75090da2b28SAriff Abdullah 			if (cdesc.afmt_ne == 0) {
75190da2b28SAriff Abdullah 				device_printf(c->dev,
75290da2b28SAriff Abdullah 				    "%s(): snd_fmtbest failed!\n", __func__);
75390da2b28SAriff Abdullah 				cdesc.afmt_ne =
75490da2b28SAriff Abdullah 				    (((cdesc.dummy != 0) ? softfmt :
75590da2b28SAriff Abdullah 				    cdesc.target.afmt) &
75690da2b28SAriff Abdullah 				    (AFMT_24BIT | AFMT_32BIT)) ?
75790da2b28SAriff Abdullah 				    AFMT_S32_NE : AFMT_S16_NE;
75890da2b28SAriff Abdullah 			}
75990da2b28SAriff Abdullah 		}
76090da2b28SAriff Abdullah 	}
76190da2b28SAriff Abdullah 
76290da2b28SAriff Abdullah 	cdesc.current = cdesc.origin;
76390da2b28SAriff Abdullah 
76490da2b28SAriff Abdullah 	/* Build everything. */
76590da2b28SAriff Abdullah 
76690da2b28SAriff Abdullah 	c->feederflags = 0;
76790da2b28SAriff Abdullah 
76890da2b28SAriff Abdullah #define FEEDER_BUILD(t)	do {						\
76990da2b28SAriff Abdullah 	ret = feeder_build_##t(c, &cdesc);				\
77090da2b28SAriff Abdullah 	if (ret != 0)							\
77190da2b28SAriff Abdullah 		return (ret);						\
77290da2b28SAriff Abdullah 	} while (0)
77390da2b28SAriff Abdullah 
77490da2b28SAriff Abdullah 	if (!(c->flags & CHN_F_HAS_VCHAN) || c->direction == PCMDIR_REC)
77590da2b28SAriff Abdullah 		FEEDER_BUILD(root);
77690da2b28SAriff Abdullah 	else if (c->direction == PCMDIR_PLAY && (c->flags & CHN_F_HAS_VCHAN))
77790da2b28SAriff Abdullah 		FEEDER_BUILD(mixer);
77890da2b28SAriff Abdullah 	else
77990da2b28SAriff Abdullah 		return (ENOTSUP);
78090da2b28SAriff Abdullah 
78190da2b28SAriff Abdullah 	/*
78290da2b28SAriff Abdullah 	 * The basic idea is: The smaller the bandwidth, the cheaper the
78390da2b28SAriff Abdullah 	 * conversion process, with following constraints:-
78490da2b28SAriff Abdullah 	 *
78590da2b28SAriff Abdullah 	 * 1) Almost all feeders work best in 16/32 native endian.
78690da2b28SAriff Abdullah 	 * 2) Try to avoid 8bit feeders due to poor dynamic range.
78790da2b28SAriff Abdullah 	 * 3) Avoid volume, format, matrix and rate in BITPERFECT or
78890da2b28SAriff Abdullah 	 *    PASSTHROUGH mode.
78990da2b28SAriff Abdullah 	 * 4) Try putting volume before EQ or rate. Should help to
79090da2b28SAriff Abdullah 	 *    avoid/reduce possible clipping.
79190da2b28SAriff Abdullah 	 * 5) EQ require specific, valid rate, unless it allow sloppy
79290da2b28SAriff Abdullah 	 *    conversion.
79390da2b28SAriff Abdullah 	 */
79490da2b28SAriff Abdullah 	if (FEEDMATRIX_UP(&cdesc)) {
79590da2b28SAriff Abdullah 		if (FEEDEQ_REQUIRED(&cdesc) &&
79690da2b28SAriff Abdullah 		    (!FEEDEQ_VALIDRATE(&cdesc, target) ||
79790da2b28SAriff Abdullah 		    (cdesc.expensive == 0 && FEEDEQ_ECONOMY(&cdesc))))
79890da2b28SAriff Abdullah 			FEEDER_BUILD(eq);
79990da2b28SAriff Abdullah 		if (FEEDRATE_REQUIRED(&cdesc))
80090da2b28SAriff Abdullah 			FEEDER_BUILD(rate);
80190da2b28SAriff Abdullah 		FEEDER_BUILD(matrix);
80290da2b28SAriff Abdullah 		if (FEEDVOLUME_REQUIRED(&cdesc))
80390da2b28SAriff Abdullah 			FEEDER_BUILD(volume);
80490da2b28SAriff Abdullah 		if (FEEDEQ_REQUIRED(&cdesc))
80590da2b28SAriff Abdullah 			FEEDER_BUILD(eq);
80690da2b28SAriff Abdullah 	} else if (FEEDMATRIX_DOWN(&cdesc)) {
80790da2b28SAriff Abdullah 		FEEDER_BUILD(matrix);
80890da2b28SAriff Abdullah 		if (FEEDVOLUME_REQUIRED(&cdesc))
80990da2b28SAriff Abdullah 			FEEDER_BUILD(volume);
81090da2b28SAriff Abdullah 		if (FEEDEQ_REQUIRED(&cdesc) &&
81190da2b28SAriff Abdullah 		    (!FEEDEQ_VALIDRATE(&cdesc, target) ||
81290da2b28SAriff Abdullah 		    FEEDEQ_ECONOMY(&cdesc)))
81390da2b28SAriff Abdullah 			FEEDER_BUILD(eq);
81490da2b28SAriff Abdullah 		if (FEEDRATE_REQUIRED(&cdesc))
81590da2b28SAriff Abdullah 			FEEDER_BUILD(rate);
81690da2b28SAriff Abdullah 		if (FEEDEQ_REQUIRED(&cdesc))
81790da2b28SAriff Abdullah 			FEEDER_BUILD(eq);
81890da2b28SAriff Abdullah 	} else {
81990da2b28SAriff Abdullah 		if (FEEDRATE_DOWN(&cdesc)) {
82090da2b28SAriff Abdullah 			if (FEEDEQ_REQUIRED(&cdesc) &&
82190da2b28SAriff Abdullah 			    !FEEDEQ_VALIDRATE(&cdesc, target)) {
82290da2b28SAriff Abdullah 				if (FEEDVOLUME_REQUIRED(&cdesc))
82390da2b28SAriff Abdullah 					FEEDER_BUILD(volume);
82490da2b28SAriff Abdullah 				FEEDER_BUILD(eq);
82590da2b28SAriff Abdullah 			}
82690da2b28SAriff Abdullah 			FEEDER_BUILD(rate);
82790da2b28SAriff Abdullah 		}
82890da2b28SAriff Abdullah 		if (FEEDMATRIX_REQUIRED(&cdesc))
82990da2b28SAriff Abdullah 			FEEDER_BUILD(matrix);
83090da2b28SAriff Abdullah 		if (FEEDVOLUME_REQUIRED(&cdesc))
83190da2b28SAriff Abdullah 			FEEDER_BUILD(volume);
83290da2b28SAriff Abdullah 		if (FEEDRATE_UP(&cdesc)) {
83390da2b28SAriff Abdullah 			if (FEEDEQ_REQUIRED(&cdesc) &&
83490da2b28SAriff Abdullah 			    !FEEDEQ_VALIDRATE(&cdesc, target))
83590da2b28SAriff Abdullah 				FEEDER_BUILD(eq);
83690da2b28SAriff Abdullah 			FEEDER_BUILD(rate);
83790da2b28SAriff Abdullah 		}
83890da2b28SAriff Abdullah 		if (FEEDEQ_REQUIRED(&cdesc))
83990da2b28SAriff Abdullah 			FEEDER_BUILD(eq);
84090da2b28SAriff Abdullah 	}
84190da2b28SAriff Abdullah 
84290da2b28SAriff Abdullah 	if (FEEDFORMAT_REQUIRED(&cdesc))
84390da2b28SAriff Abdullah 		FEEDER_BUILD(format);
84490da2b28SAriff Abdullah 
84590da2b28SAriff Abdullah 	if (c->direction == PCMDIR_REC && (c->flags & CHN_F_HAS_VCHAN))
84690da2b28SAriff Abdullah 		FEEDER_BUILD(mixer);
84790da2b28SAriff Abdullah 
84890da2b28SAriff Abdullah 	sndbuf_setfmt(c->bufsoft, c->format);
84990da2b28SAriff Abdullah 	sndbuf_setspd(c->bufsoft, c->speed);
85090da2b28SAriff Abdullah 
85190da2b28SAriff Abdullah 	sndbuf_setfmt(c->bufhard, hwfmt);
85290da2b28SAriff Abdullah 
85390da2b28SAriff Abdullah 	chn_syncstate(c);
85490da2b28SAriff Abdullah 
85590da2b28SAriff Abdullah 	return (0);
85690da2b28SAriff Abdullah }
857