route.c

优龙2410linux2.6.8内核源代码

		sum.as_uint64 <<= 24;
		div(sum.as_uint64);
		goto norm_int;

	norm_int32_8_noatt:
		sum.as_uint64 = sum.as_uint32;
	norm_int64_8_noatt:
		sum.as_uint64 <<= 8;
		goto norm_int;

	norm_int32_16_noatt:
		sum.as_uint64 = sum.as_uint32;
	norm_int64_16_noatt:
		sum.as_uint64 <<= 16;
		goto norm_int;

	norm_int32_24_noatt:
		sum.as_uint64 = sum.as_uint32;
	norm_int64_24_noatt:
		sum.as_uint64 <<= 24;
		goto norm_int;

	norm_int64_0_noatt:
	norm_int:
		if (sum.as_uint64 > (u_int32_t)0xffffffff)
			sample = (u_int32_t)0xffffffff;
		else
			sample = sum.as_uint64;
		goto after_norm;

#if ROUTE_PLUGIN_USE_FLOAT
	norm_float_8:
		sum.as_float *= 1 << 8;
		goto norm_float;
	norm_float_16:
		sum.as_float *= 1 << 16;
		goto norm_float;
	norm_float_24:
		sum.as_float *= 1 << 24;
		goto norm_float;
	norm_float_0:
	norm_float:
		sum.as_float = floor(sum.as_float + 0.5);
		if (sum.as_float > (u_int32_t)0xffffffff)
			sample = (u_int32_t)0xffffffff;
		else
			sample = sum.as_float;
		goto after_norm;
#endif
	after_norm:
		
		/* Put sample */
		goto *put_u32;
#define PUT_U32_END after_put_u32
#include "plugin_ops.h"
#undef PUT_U32_END
	after_put_u32:
		
		dst += dst_step;
	}
}

int route_src_channels_mask(snd_pcm_plugin_t *plugin,
			  bitset_t *dst_vmask,
			  bitset_t **src_vmask)
{
	route_t *data = (route_t *)plugin->extra_data;
	int schannels = plugin->src_format.channels;
	int dchannels = plugin->dst_format.channels;
	bitset_t *vmask = plugin->src_vmask;
	int channel;
	ttable_dst_t *dp = data->ttable;
	bitset_zero(vmask, schannels);
	for (channel = 0; channel < dchannels; channel++, dp++) {
		unsigned int src;
		ttable_src_t *sp;
		if (!bitset_get(dst_vmask, channel))
			continue;
		sp = dp->srcs;
		for (src = 0; src < dp->nsrcs; src++, sp++)
			bitset_set(vmask, sp->channel);
	}
	*src_vmask = vmask;
	return 0;
}

int route_dst_channels_mask(snd_pcm_plugin_t *plugin,
			  bitset_t *src_vmask,
			  bitset_t **dst_vmask)
{
	route_t *data = (route_t *)plugin->extra_data;
	int dchannels = plugin->dst_format.channels;
	bitset_t *vmask = plugin->dst_vmask;
	int channel;
	ttable_dst_t *dp = data->ttable;
	bitset_zero(vmask, dchannels);
	for (channel = 0; channel < dchannels; channel++, dp++) {
		unsigned int src;
		ttable_src_t *sp;
		sp = dp->srcs;
		for (src = 0; src < dp->nsrcs; src++, sp++) {
			if (bitset_get(src_vmask, sp->channel)) {
				bitset_set(vmask, channel);
				break;
			}
		}
	}
	*dst_vmask = vmask;
	return 0;
}

static void route_free(snd_pcm_plugin_t *plugin)
{
	route_t *data = (route_t *)plugin->extra_data;
	unsigned int dst_channel;
	for (dst_channel = 0; dst_channel < plugin->dst_format.channels; ++dst_channel) {
		if (data->ttable[dst_channel].srcs != NULL)
			kfree(data->ttable[dst_channel].srcs);
	}
}

static int route_load_ttable(snd_pcm_plugin_t *plugin, 
			     const route_ttable_entry_t* src_ttable)
{
	route_t *data;
	unsigned int src_channel, dst_channel;
	const route_ttable_entry_t *sptr;
	ttable_dst_t *dptr;
	if (src_ttable == NULL)
		return 0;
	data = (route_t *)plugin->extra_data;
	dptr = data->ttable;
	sptr = src_ttable;
	plugin->private_free = route_free;
	for (dst_channel = 0; dst_channel < plugin->dst_format.channels; ++dst_channel) {
		route_ttable_entry_t t = 0;
		int att = 0;
		int nsrcs = 0;
		ttable_src_t srcs[plugin->src_format.channels];
		for (src_channel = 0; src_channel < plugin->src_format.channels; ++src_channel) {
			snd_assert(*sptr >= 0 || *sptr <= FULL, return -ENXIO);
			if (*sptr != 0) {
				srcs[nsrcs].channel = src_channel;
#if ROUTE_PLUGIN_USE_FLOAT
				/* Also in user space for non attenuated */
				srcs[nsrcs].as_int = (*sptr == FULL ? ROUTE_PLUGIN_RESOLUTION : 0);
				srcs[nsrcs].as_float = *sptr;
#else
				srcs[nsrcs].as_int = *sptr;
#endif
				if (*sptr != FULL)
					att = 1;
				t += *sptr;
				nsrcs++;
			}
			sptr++;
		}
		dptr->att = att;
		dptr->nsrcs = nsrcs;
		if (nsrcs == 0)
			dptr->func = route_to_channel_from_zero;
		else if (nsrcs == 1 && !att)
			dptr->func = route_to_channel_from_one;
		else
			dptr->func = route_to_channel;
		if (nsrcs > 0) {
                        int srcidx;
			dptr->srcs = snd_kcalloc(nsrcs * sizeof(*srcs), GFP_KERNEL);
                        for(srcidx = 0; srcidx < nsrcs; srcidx++)
				dptr->srcs[srcidx] = srcs[srcidx];
		} else
			dptr->srcs = NULL;
		dptr++;
	}
	return 0;
}

static snd_pcm_sframes_t route_transfer(snd_pcm_plugin_t *plugin,
			      const snd_pcm_plugin_channel_t *src_channels,
			      snd_pcm_plugin_channel_t *dst_channels,
			      snd_pcm_uframes_t frames)
{
	route_t *data;
	int src_nchannels, dst_nchannels;
	int dst_channel;
	ttable_dst_t *ttp;
	snd_pcm_plugin_channel_t *dvp;

	snd_assert(plugin != NULL && src_channels != NULL && dst_channels != NULL, return -ENXIO);
	if (frames == 0)
		return 0;
	data = (route_t *)plugin->extra_data;

	src_nchannels = plugin->src_format.channels;
	dst_nchannels = plugin->dst_format.channels;

#ifdef CONFIG_SND_DEBUG
	{
		int src_channel;
		for (src_channel = 0; src_channel < src_nchannels; ++src_channel) {
			snd_assert(src_channels[src_channel].area.first % 8 == 0 ||
				   src_channels[src_channel].area.step % 8 == 0,
				   return -ENXIO);
		}
		for (dst_channel = 0; dst_channel < dst_nchannels; ++dst_channel) {
			snd_assert(dst_channels[dst_channel].area.first % 8 == 0 ||
				   dst_channels[dst_channel].area.step % 8 == 0,
				   return -ENXIO);
		}
	}
#endif

	ttp = data->ttable;
	dvp = dst_channels;
	for (dst_channel = 0; dst_channel < dst_nchannels; ++dst_channel) {
		ttp->func(plugin, src_channels, dvp, ttp, frames);
		dvp++;
		ttp++;
	}
	return frames;
}

int getput_index(int format)
{
	int sign, width, endian;
	sign = !snd_pcm_format_signed(format);
	width = snd_pcm_format_width(format) / 8 - 1;
	if (width < 0 || width > 3) {
		snd_printk(KERN_ERR "snd-pcm-oss: invalid format %d\n", format);
		width = 0;
	}
#ifdef SNDRV_LITTLE_ENDIAN
	endian = snd_pcm_format_big_endian(format);
#else
	endian = snd_pcm_format_little_endian(format);
#endif
	if (endian < 0)
		endian = 0;
	return width * 4 + endian * 2 + sign;
}

int snd_pcm_plugin_build_route(snd_pcm_plug_t *plug,
			       snd_pcm_plugin_format_t *src_format,
			       snd_pcm_plugin_format_t *dst_format,
			       route_ttable_entry_t *ttable,
			       snd_pcm_plugin_t **r_plugin)
{
	route_t *data;
	snd_pcm_plugin_t *plugin;
	int err;

	snd_assert(r_plugin != NULL, return -ENXIO);
	*r_plugin = NULL;
	snd_assert(src_format->rate == dst_format->rate, return -ENXIO);
	snd_assert(snd_pcm_format_linear(src_format->format) != 0 &&
		   snd_pcm_format_linear(dst_format->format) != 0,
		   return -ENXIO);

	err = snd_pcm_plugin_build(plug, "attenuated route conversion",
				   src_format, dst_format,
				   sizeof(route_t) + sizeof(data->ttable[0]) * dst_format->channels,
				   &plugin);
	if (err < 0)
		return err;

	data = (route_t *) plugin->extra_data;

	data->get = getput_index(src_format->format);
	data->put = getput_index(dst_format->format);
	data->conv = conv_index(src_format->format, dst_format->format);

#if ROUTE_PLUGIN_USE_FLOAT
	data->sum_type = R_FLOAT;
#else
	if (snd_pcm_format_width(src_format->format) == 32)
		data->sum_type = R_UINT64;
	else
		data->sum_type = R_UINT32;
#endif
	data->src_sample_size = snd_pcm_format_width(src_format->format) / 8;

	if ((err = route_load_ttable(plugin, ttable)) < 0) {
		snd_pcm_plugin_free(plugin);
		return err;
	}
	plugin->transfer = route_transfer;
	plugin->src_channels_mask = route_src_channels_mask;
	plugin->dst_channels_mask = route_dst_channels_mask;
	*r_plugin = plugin;
	return 0;
}