xref: /freebsd/sys/dev/sound/pcm/feeder_chain.c (revision e1bbaa71d62c8681a576f9f5bedf475c7541bd35)
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