+ 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;