/*
- * Route Plug-In
+ * Attenuated route Plug-In
* Copyright (c) 2000 by Abramo Bagnara <abramo@alsa-project.org>
*
*
*/
#include <sound/driver.h>
-
-#ifdef CONFIG_SND_PCM_OSS_PLUGINS
-
#include <linux/slab.h>
#include <linux/time.h>
#include <sound/core.h>
#include <sound/pcm.h>
#include "pcm_plugin.h"
-static void zero_areas(struct snd_pcm_plugin_channel *dvp, int ndsts,
- snd_pcm_uframes_t frames, int format)
+/* The best possible hack to support missing optimization in gcc 2.7.2.3 */
+#if ROUTE_PLUGIN_RESOLUTION & (ROUTE_PLUGIN_RESOLUTION - 1) != 0
+#define div(a) a /= ROUTE_PLUGIN_RESOLUTION
+#elif ROUTE_PLUGIN_RESOLUTION == 16
+#define div(a) a >>= 4
+#else
+#error "Add some code here"
+#endif
+
+struct ttable_dst;
+
+typedef void (*route_channel_f)(struct snd_pcm_plugin *plugin,
+ const struct snd_pcm_plugin_channel *src_channels,
+ struct snd_pcm_plugin_channel *dst_channel,
+ struct ttable_dst *ttable, snd_pcm_uframes_t frames);
+
+struct ttable_src {
+ int channel;
+ int as_int;
+};
+
+struct ttable_dst {
+ int att; /* Attenuated */
+ unsigned int nsrcs;
+ struct ttable_src *srcs;
+ route_channel_f func;
+};
+
+struct route_priv {
+ enum {R_UINT32=0, R_UINT64=1} sum_type;
+ int get, put;
+ int conv;
+ int src_sample_size;
+ struct ttable_dst ttable[0];
+};
+
+union sum {
+ u_int32_t as_uint32;
+ u_int64_t as_uint64;
+};
+
+
+static void route_to_channel_from_zero(struct snd_pcm_plugin *plugin,
+ const struct snd_pcm_plugin_channel *src_channels,
+ struct snd_pcm_plugin_channel *dst_channel,
+ struct ttable_dst *ttable,
+ snd_pcm_uframes_t frames)
{
- int dst = 0;
- for (; dst < ndsts; ++dst) {
- if (dvp->wanted)
- snd_pcm_area_silence(&dvp->area, 0, frames, format);
- dvp->enabled = 0;
- dvp++;
+ if (dst_channel->wanted)
+ snd_pcm_area_silence(&dst_channel->area, 0, frames, plugin->dst_format.format);
+ dst_channel->enabled = 0;
+}
+
+static void route_to_channel_from_one(struct snd_pcm_plugin *plugin,
+ const struct snd_pcm_plugin_channel *src_channels,
+ struct snd_pcm_plugin_channel *dst_channel,
+ struct ttable_dst *ttable,
+ snd_pcm_uframes_t frames)
+{
+#define CONV_LABELS
+#include "plugin_ops.h"
+#undef CONV_LABELS
+ struct route_priv *data = (struct route_priv *)plugin->extra_data;
+ void *conv;
+ const struct snd_pcm_plugin_channel *src_channel = NULL;
+ unsigned int srcidx;
+ char *src, *dst;
+ int src_step, dst_step;
+ for (srcidx = 0; srcidx < ttable->nsrcs; ++srcidx) {
+ src_channel = &src_channels[ttable->srcs[srcidx].channel];
+ if (src_channel->area.addr != NULL)
+ break;
+ }
+ if (srcidx == ttable->nsrcs) {
+ route_to_channel_from_zero(plugin, src_channels, dst_channel, ttable, frames);
+ return;
+ }
+
+ dst_channel->enabled = 1;
+ conv = conv_labels[data->conv];
+ src = src_channel->area.addr + src_channel->area.first / 8;
+ src_step = src_channel->area.step / 8;
+ dst = dst_channel->area.addr + dst_channel->area.first / 8;
+ dst_step = dst_channel->area.step / 8;
+ while (frames-- > 0) {
+ goto *conv;
+#define CONV_END after
+#include "plugin_ops.h"
+#undef CONV_END
+ after:
+ src += src_step;
+ dst += dst_step;
}
}
-static inline void copy_area(const struct snd_pcm_plugin_channel *src_channel,
+static void route_to_channel(struct snd_pcm_plugin *plugin,
+ const struct snd_pcm_plugin_channel *src_channels,
struct snd_pcm_plugin_channel *dst_channel,
- snd_pcm_uframes_t frames, int format)
+ struct ttable_dst *ttable, snd_pcm_uframes_t frames)
{
+#define GET_U_LABELS
+#define PUT_U32_LABELS
+#include "plugin_ops.h"
+#undef GET_U_LABELS
+#undef PUT_U32_LABELS
+ static void *zero_labels[2] = { &&zero_int32, &&zero_int64 };
+ /* sum_type att */
+ static void *add_labels[2 * 2] = { &&add_int32_noatt, &&add_int32_att,
+ &&add_int64_noatt, &&add_int64_att,
+ };
+ /* sum_type att shift */
+ static void *norm_labels[2 * 2 * 4] = { NULL,
+ &&norm_int32_8_noatt,
+ &&norm_int32_16_noatt,
+ &&norm_int32_24_noatt,
+ NULL,
+ &&norm_int32_8_att,
+ &&norm_int32_16_att,
+ &&norm_int32_24_att,
+ &&norm_int64_0_noatt,
+ &&norm_int64_8_noatt,
+ &&norm_int64_16_noatt,
+ &&norm_int64_24_noatt,
+ &&norm_int64_0_att,
+ &&norm_int64_8_att,
+ &&norm_int64_16_att,
+ &&norm_int64_24_att,
+ };
+ struct route_priv *data = (struct route_priv *)plugin->extra_data;
+ void *zero, *get, *add, *norm, *put_u32;
+ int nsrcs = ttable->nsrcs;
+ char *dst;
+ int dst_step;
+ char *srcs[nsrcs];
+ int src_steps[nsrcs];
+ struct ttable_src src_tt[nsrcs];
+ u_int32_t sample = 0;
+ int srcidx, srcidx1 = 0;
+ for (srcidx = 0; srcidx < nsrcs; ++srcidx) {
+ const struct snd_pcm_plugin_channel *src_channel = &src_channels[ttable->srcs[srcidx].channel];
+ if (!src_channel->enabled)
+ continue;
+ srcs[srcidx1] = src_channel->area.addr + src_channel->area.first / 8;
+ src_steps[srcidx1] = src_channel->area.step / 8;
+ src_tt[srcidx1] = ttable->srcs[srcidx];
+ srcidx1++;
+ }
+ nsrcs = srcidx1;
+ if (nsrcs == 0) {
+ route_to_channel_from_zero(plugin, src_channels, dst_channel, ttable, frames);
+ return;
+ } else if (nsrcs == 1 && src_tt[0].as_int == ROUTE_PLUGIN_RESOLUTION) {
+ route_to_channel_from_one(plugin, src_channels, dst_channel, ttable, frames);
+ return;
+ }
+
dst_channel->enabled = 1;
- snd_pcm_area_copy(&src_channel->area, 0, &dst_channel->area, 0, frames, format);
+ zero = zero_labels[data->sum_type];
+ get = get_u_labels[data->get];
+ add = add_labels[data->sum_type * 2 + ttable->att];
+ norm = norm_labels[data->sum_type * 8 + ttable->att * 4 + 4 - data->src_sample_size];
+ put_u32 = put_u32_labels[data->put];
+ dst = dst_channel->area.addr + dst_channel->area.first / 8;
+ dst_step = dst_channel->area.step / 8;
+
+ while (frames-- > 0) {
+ struct ttable_src *ttp = src_tt;
+ union sum sum;
+
+ /* Zero sum */
+ goto *zero;
+ zero_int32:
+ sum.as_uint32 = 0;
+ goto zero_end;
+ zero_int64:
+ sum.as_uint64 = 0;
+ goto zero_end;
+ zero_end:
+ for (srcidx = 0; srcidx < nsrcs; ++srcidx) {
+ char *src = srcs[srcidx];
+
+ /* Get sample */
+ goto *get;
+#define GET_U_END after_get
+#include "plugin_ops.h"
+#undef GET_U_END
+ after_get:
+
+ /* Sum */
+ goto *add;
+ add_int32_att:
+ sum.as_uint32 += sample * ttp->as_int;
+ goto after_sum;
+ add_int32_noatt:
+ if (ttp->as_int)
+ sum.as_uint32 += sample;
+ goto after_sum;
+ add_int64_att:
+ sum.as_uint64 += (u_int64_t) sample * ttp->as_int;
+ goto after_sum;
+ add_int64_noatt:
+ if (ttp->as_int)
+ sum.as_uint64 += sample;
+ goto after_sum;
+ after_sum:
+ srcs[srcidx] += src_steps[srcidx];
+ ttp++;
+ }
+
+ /* Normalization */
+ goto *norm;
+ norm_int32_8_att:
+ sum.as_uint64 = sum.as_uint32;
+ norm_int64_8_att:
+ sum.as_uint64 <<= 8;
+ norm_int64_0_att:
+ div(sum.as_uint64);
+ goto norm_int;
+
+ norm_int32_16_att:
+ sum.as_uint64 = sum.as_uint32;
+ norm_int64_16_att:
+ sum.as_uint64 <<= 16;
+ div(sum.as_uint64);
+ goto norm_int;
+
+ norm_int32_24_att:
+ sum.as_uint64 = sum.as_uint32;
+ norm_int64_24_att:
+ 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;
+
+ 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;
+ }
+}
+
+static int route_src_channels_mask(struct snd_pcm_plugin *plugin,
+ unsigned long *dst_vmask,
+ unsigned long **src_vmask)
+{
+ struct route_priv *data = (struct route_priv *)plugin->extra_data;
+ int schannels = plugin->src_format.channels;
+ int dchannels = plugin->dst_format.channels;
+ unsigned long *vmask = plugin->src_vmask;
+ int channel;
+ struct ttable_dst *dp = data->ttable;
+ bitmap_zero(vmask, schannels);
+ for (channel = 0; channel < dchannels; channel++, dp++) {
+ unsigned int src;
+ struct ttable_src *sp;
+ if (!test_bit(channel, dst_vmask))
+ continue;
+ sp = dp->srcs;
+ for (src = 0; src < dp->nsrcs; src++, sp++)
+ set_bit(sp->channel, vmask);
+ }
+ *src_vmask = vmask;
+ return 0;
+}
+
+static int route_dst_channels_mask(struct snd_pcm_plugin *plugin,
+ unsigned long *src_vmask,
+ unsigned long **dst_vmask)
+{
+ struct route_priv *data = (struct route_priv *)plugin->extra_data;
+ int dchannels = plugin->dst_format.channels;
+ unsigned long *vmask = plugin->dst_vmask;
+ int channel;
+ struct ttable_dst *dp = data->ttable;
+ bitmap_zero(vmask, dchannels);
+ for (channel = 0; channel < dchannels; channel++, dp++) {
+ unsigned int src;
+ struct ttable_src *sp;
+ sp = dp->srcs;
+ for (src = 0; src < dp->nsrcs; src++, sp++) {
+ if (test_bit(sp->channel, src_vmask)) {
+ set_bit(channel, vmask);
+ break;
+ }
+ }
+ }
+ *dst_vmask = vmask;
+ return 0;
+}
+
+static void route_free(struct snd_pcm_plugin *plugin)
+{
+ struct route_priv *data = (struct route_priv *)plugin->extra_data;
+ unsigned int dst_channel;
+ for (dst_channel = 0; dst_channel < plugin->dst_format.channels; ++dst_channel) {
+ kfree(data->ttable[dst_channel].srcs);
+ }
+}
+
+static int route_load_ttable(struct snd_pcm_plugin *plugin,
+ const int *src_ttable)
+{
+ struct route_priv *data;
+ unsigned int src_channel, dst_channel;
+ const int *sptr;
+ struct ttable_dst *dptr;
+ if (src_ttable == NULL)
+ return 0;
+ data = (struct route_priv *)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) {
+ int t = 0;
+ int att = 0;
+ int nsrcs = 0;
+ struct ttable_src 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;
+ srcs[nsrcs].as_int = *sptr;
+ 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 = 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(struct snd_pcm_plugin *plugin,
- const struct snd_pcm_plugin_channel *src_channels,
- struct snd_pcm_plugin_channel *dst_channels,
- snd_pcm_uframes_t frames)
+ const struct snd_pcm_plugin_channel *src_channels,
+ struct snd_pcm_plugin_channel *dst_channels,
+ snd_pcm_uframes_t frames)
{
- int nsrcs, ndsts, dst;
+ struct route_priv *data;
+ int src_nchannels, dst_nchannels;
+ int dst_channel;
+ struct ttable_dst *ttp;
struct snd_pcm_plugin_channel *dvp;
- int format;
snd_assert(plugin != NULL && src_channels != NULL && dst_channels != NULL, return -ENXIO);
if (frames == 0)
return 0;
+ data = (struct route_priv *)plugin->extra_data;
- nsrcs = plugin->src_format.channels;
- ndsts = plugin->dst_format.channels;
+ src_nchannels = plugin->src_format.channels;
+ dst_nchannels = plugin->dst_format.channels;
- format = plugin->dst_format.format;
- dvp = dst_channels;
- if (nsrcs <= 1) {
- /* expand to all channels */
- for (dst = 0; dst < ndsts; ++dst) {
- copy_area(src_channels, dvp, frames, format);
- dvp++;
+#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);
}
- return frames;
}
+#endif
- for (dst = 0; dst < ndsts && dst < nsrcs; ++dst) {
- copy_area(src_channels, dvp, frames, format);
+ 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++;
- src_channels++;
+ ttp++;
}
- if (dst < ndsts)
- zero_areas(dvp, ndsts - dst, frames, format);
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(struct snd_pcm_substream *plug,
struct snd_pcm_plugin_format *src_format,
struct snd_pcm_plugin_format *dst_format,
+ int *ttable,
struct snd_pcm_plugin **r_plugin)
{
+ struct route_priv *data;
struct snd_pcm_plugin *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(src_format->format == dst_format->format, 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, "route conversion",
- src_format, dst_format, 0, &plugin);
+ err = snd_pcm_plugin_build(plug, "attenuated route conversion",
+ src_format, dst_format,
+ sizeof(struct route_priv) +
+ sizeof(data->ttable[0]) * dst_format->channels,
+ &plugin);
if (err < 0)
return err;
+ data = (struct route_priv *)plugin->extra_data;
+
+ data->get = getput_index(src_format->format);
+ snd_assert(data->get >= 0 && data->get < 4*2*2, return -EINVAL);
+ data->put = getput_index(dst_format->format);
+ snd_assert(data->get >= 0 && data->get < 4*2*2, return -EINVAL);
+ data->conv = conv_index(src_format->format, dst_format->format);
+
+ if (snd_pcm_format_width(src_format->format) == 32)
+ data->sum_type = R_UINT64;
+ else
+ data->sum_type = R_UINT32;
+ 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;
}
-
-#endif
git://git.onelab.eu / linux-2.6.git / blobdiff