+/* GStreamer
+ * Copyright (C) 2004 Ronald Bultje <rbultje@ronald.bitfreak.net>
+ * Copyright (C) 2008 Sebastian Dröge <slomo@circular-chaos.org>
+ *
+ * gstchannelmix.c: setup of channel conversion matrices
+ *
+ * This library is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU Library General Public
+ * License as published by the Free Software Foundation; either
+ * version 2 of the License, or (at your option) any later version.
+ *
+ * This library is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
+ * Library General Public License for more details.
+ *
+ * You should have received a copy of the GNU Library General Public
+ * License along with this library; if not, write to the
+ * Free Software Foundation, Inc., 59 Temple Place - Suite 330,
+ * Boston, MA 02111-1307, USA.
+ */
+
+#ifdef HAVE_CONFIG_H
+#include "config.h"
+#endif
+
+#include <math.h>
+#include <string.h>
+#include <gst/audio/multichannel.h>
+
+#include "gstchannelmix.h"
+
+/*
+ * Channel matrix functions.
+ */
+
+void
+gst_channel_mix_unset_matrix (AudioConvertCtx * this)
+{
+ gint i;
+
+ /* don't access if nothing there */
+ if (!this->matrix)
+ return;
+
+ /* free */
+ for (i = 0; i < this->in.channels; i++)
+ g_free (this->matrix[i]);
+ g_free (this->matrix);
+
+ this->matrix = NULL;
+ g_free (this->tmp);
+ this->tmp = NULL;
+}
+
+/*
+ * Detect and fill in identical channels. E.g.
+ * forward the left/right front channels in a
+ * 5.1 to 2.0 conversion.
+ */
+
+static void
+gst_channel_mix_fill_identical (AudioConvertCtx * this)
+{
+ gint ci, co;
+
+ /* Apart from the compatible channel assignments, we can also have
+ * same channel assignments. This is much simpler, we simply copy
+ * the value from source to dest! */
+ for (co = 0; co < this->out.channels; co++) {
+ /* find a channel in input with same position */
+ for (ci = 0; ci < this->in.channels; ci++) {
+ if (this->in.pos[ci] == this->out.pos[co]) {
+ this->matrix[ci][co] = 1.0;
+ }
+ }
+ }
+}
+
+/*
+ * Detect and fill in compatible channels. E.g.
+ * forward left/right front to mono (or the other
+ * way around) when going from 2.0 to 1.0.
+ */
+
+static void
+gst_channel_mix_fill_compatible (AudioConvertCtx * this)
+{
+ /* Conversions from one-channel to compatible two-channel configs */
+ struct
+ {
+ GstAudioChannelPosition pos1[2];
+ GstAudioChannelPosition pos2[1];
+ } conv[] = {
+ /* front: mono <-> stereo */
+ { {
+ GST_AUDIO_CHANNEL_POSITION_FRONT_LEFT,
+ GST_AUDIO_CHANNEL_POSITION_FRONT_RIGHT}, {
+ GST_AUDIO_CHANNEL_POSITION_FRONT_MONO}},
+ /* front center: 2 <-> 1 */
+ { {
+ GST_AUDIO_CHANNEL_POSITION_FRONT_LEFT_OF_CENTER,
+ GST_AUDIO_CHANNEL_POSITION_FRONT_RIGHT_OF_CENTER}, {
+ GST_AUDIO_CHANNEL_POSITION_FRONT_CENTER}},
+ /* rear: 2 <-> 1 */
+ { {
+ GST_AUDIO_CHANNEL_POSITION_REAR_LEFT,
+ GST_AUDIO_CHANNEL_POSITION_REAR_RIGHT}, {
+ GST_AUDIO_CHANNEL_POSITION_REAR_CENTER}}, { {
+ GST_AUDIO_CHANNEL_POSITION_INVALID}}
+ };
+ gint c;
+
+ /* conversions from compatible (but not the same) channel schemes */
+ for (c = 0; conv[c].pos1[0] != GST_AUDIO_CHANNEL_POSITION_INVALID; c++) {
+ gint pos1_0 = -1, pos1_1 = -1, pos1_2 = -1;
+ gint pos2_0 = -1, pos2_1 = -1, pos2_2 = -1;
+ gint n;
+
+ for (n = 0; n < this->in.channels; n++) {
+ if (this->in.pos[n] == conv[c].pos1[0])
+ pos1_0 = n;
+ else if (this->in.pos[n] == conv[c].pos1[1])
+ pos1_1 = n;
+ else if (this->in.pos[n] == conv[c].pos2[0])
+ pos1_2 = n;
+ }
+ for (n = 0; n < this->out.channels; n++) {
+ if (this->out.pos[n] == conv[c].pos1[0])
+ pos2_0 = n;
+ else if (this->out.pos[n] == conv[c].pos1[1])
+ pos2_1 = n;
+ else if (this->out.pos[n] == conv[c].pos2[0])
+ pos2_2 = n;
+ }
+
+ /* The general idea here is to fill in channels from the same position
+ * as good as possible. This means mixing left<->center and right<->center.
+ */
+
+ /* left -> center */
+ if (pos1_0 != -1 && pos1_2 == -1 && pos2_0 == -1 && pos2_2 != -1)
+ this->matrix[pos1_0][pos2_2] = 1.0;
+ else if (pos1_0 != -1 && pos1_2 != -1 && pos2_0 == -1 && pos2_2 != -1)
+ this->matrix[pos1_0][pos2_2] = 0.5;
+ else if (pos1_0 != -1 && pos1_2 == -1 && pos2_0 != -1 && pos2_2 != -1)
+ this->matrix[pos1_0][pos2_2] = 1.0;
+
+ /* right -> center */
+ if (pos1_1 != -1 && pos1_2 == -1 && pos2_1 == -1 && pos2_2 != -1)
+ this->matrix[pos1_1][pos2_2] = 1.0;
+ else if (pos1_1 != -1 && pos1_2 != -1 && pos2_1 == -1 && pos2_2 != -1)
+ this->matrix[pos1_1][pos2_2] = 0.5;
+ else if (pos1_1 != -1 && pos1_2 == -1 && pos2_1 != -1 && pos2_2 != -1)
+ this->matrix[pos1_1][pos2_2] = 1.0;
+
+ /* center -> left */
+ if (pos1_2 != -1 && pos1_0 == -1 && pos2_2 == -1 && pos2_0 != -1)
+ this->matrix[pos1_2][pos2_0] = 1.0;
+ else if (pos1_2 != -1 && pos1_0 != -1 && pos2_2 == -1 && pos2_0 != -1)
+ this->matrix[pos1_2][pos2_0] = 0.5;
+ else if (pos1_2 != -1 && pos1_0 == -1 && pos2_2 != -1 && pos2_0 != -1)
+ this->matrix[pos1_2][pos2_0] = 1.0;
+
+ /* center -> right */
+ if (pos1_2 != -1 && pos1_1 == -1 && pos2_2 == -1 && pos2_1 != -1)
+ this->matrix[pos1_2][pos2_1] = 1.0;
+ else if (pos1_2 != -1 && pos1_1 != -1 && pos2_2 == -1 && pos2_1 != -1)
+ this->matrix[pos1_2][pos2_1] = 0.5;
+ else if (pos1_2 != -1 && pos1_1 == -1 && pos2_2 != -1 && pos2_1 != -1)
+ this->matrix[pos1_2][pos2_1] = 1.0;
+ }
+}
+
+/*
+ * Detect and fill in channels not handled by the
+ * above two, e.g. center to left/right front in
+ * 5.1 to 2.0 (or the other way around).
+ *
+ * Unfortunately, limited to static conversions
+ * for now.
+ */
+
+static void
+gst_channel_mix_detect_pos (AudioConvertFmt * caps,
+ gint * f, gboolean * has_f,
+ gint * c, gboolean * has_c, gint * r, gboolean * has_r,
+ gint * s, gboolean * has_s, gint * b, gboolean * has_b)
+{
+ gint n;
+
+ for (n = 0; n < caps->channels; n++) {
+ switch (caps->pos[n]) {
+ case GST_AUDIO_CHANNEL_POSITION_FRONT_MONO:
+ f[1] = n;
+ *has_f = TRUE;
+ break;
+ case GST_AUDIO_CHANNEL_POSITION_FRONT_LEFT:
+ f[0] = n;
+ *has_f = TRUE;
+ break;
+ case GST_AUDIO_CHANNEL_POSITION_FRONT_RIGHT:
+ f[2] = n;
+ *has_f = TRUE;
+ break;
+ case GST_AUDIO_CHANNEL_POSITION_FRONT_CENTER:
+ c[1] = n;
+ *has_c = TRUE;
+ break;
+ case GST_AUDIO_CHANNEL_POSITION_FRONT_LEFT_OF_CENTER:
+ c[0] = n;
+ *has_c = TRUE;
+ break;
+ case GST_AUDIO_CHANNEL_POSITION_FRONT_RIGHT_OF_CENTER:
+ c[2] = n;
+ *has_c = TRUE;
+ break;
+ case GST_AUDIO_CHANNEL_POSITION_REAR_CENTER:
+ r[1] = n;
+ *has_r = TRUE;
+ break;
+ case GST_AUDIO_CHANNEL_POSITION_REAR_LEFT:
+ r[0] = n;
+ *has_r = TRUE;
+ break;
+ case GST_AUDIO_CHANNEL_POSITION_REAR_RIGHT:
+ r[2] = n;
+ *has_r = TRUE;
+ break;
+ case GST_AUDIO_CHANNEL_POSITION_SIDE_LEFT:
+ s[0] = n;
+ *has_s = TRUE;
+ break;
+ case GST_AUDIO_CHANNEL_POSITION_SIDE_RIGHT:
+ s[2] = n;
+ *has_s = TRUE;
+ break;
+ case GST_AUDIO_CHANNEL_POSITION_LFE:
+ *has_b = TRUE;
+ b[1] = n;
+ break;
+ default:
+ break;
+ }
+ }
+}
+
+static void
+gst_channel_mix_fill_one_other (gfloat ** matrix,
+ AudioConvertFmt * from_caps, gint * from_idx,
+ AudioConvertFmt * to_caps, gint * to_idx, gfloat ratio)
+{
+
+ /* src & dst have center => passthrough */
+ if (from_idx[1] != -1 && to_idx[1] != -1) {
+ matrix[from_idx[1]][to_idx[1]] = ratio;
+ }
+
+ /* src & dst have left => passthrough */
+ if (from_idx[0] != -1 && to_idx[0] != -1) {
+ matrix[from_idx[0]][to_idx[0]] = ratio;
+ }
+
+ /* src & dst have right => passthrough */
+ if (from_idx[2] != -1 && to_idx[2] != -1) {
+ matrix[from_idx[2]][to_idx[2]] = ratio;
+ }
+
+ /* src has left & dst has center => put into center */
+ if (from_idx[0] != -1 && to_idx[1] != -1 && from_idx[1] != -1) {
+ matrix[from_idx[0]][to_idx[1]] = 0.5 * ratio;
+ } else if (from_idx[0] != -1 && to_idx[1] != -1 && from_idx[1] == -1) {
+ matrix[from_idx[0]][to_idx[1]] = ratio;
+ }
+
+ /* src has right & dst has center => put into center */
+ if (from_idx[2] != -1 && to_idx[1] != -1 && from_idx[1] != -1) {
+ matrix[from_idx[2]][to_idx[1]] = 0.5 * ratio;
+ } else if (from_idx[2] != -1 && to_idx[1] != -1 && from_idx[1] == -1) {
+ matrix[from_idx[2]][to_idx[1]] = ratio;
+ }
+
+ /* src has center & dst has left => passthrough */
+ if (from_idx[1] != -1 && to_idx[0] != -1 && from_idx[0] != -1) {
+ matrix[from_idx[1]][to_idx[0]] = 0.5 * ratio;
+ } else if (from_idx[1] != -1 && to_idx[0] != -1 && from_idx[0] == -1) {
+ matrix[from_idx[1]][to_idx[0]] = ratio;
+ }
+
+ /* src has center & dst has right => passthrough */
+ if (from_idx[1] != -1 && to_idx[2] != -1 && from_idx[2] != -1) {
+ matrix[from_idx[1]][to_idx[2]] = 0.5 * ratio;
+ } else if (from_idx[1] != -1 && to_idx[2] != -1 && from_idx[2] == -1) {
+ matrix[from_idx[1]][to_idx[2]] = ratio;
+ }
+}
+
+#define RATIO_CENTER_FRONT (1.0 / sqrt (2.0))
+#define RATIO_CENTER_SIDE (1.0 / 2.0)
+#define RATIO_CENTER_REAR (1.0 / sqrt (8.0))
+
+#define RATIO_FRONT_CENTER (1.0 / sqrt (2.0))
+#define RATIO_FRONT_SIDE (1.0 / sqrt (2.0))
+#define RATIO_FRONT_REAR (1.0 / 2.0)
+
+#define RATIO_SIDE_CENTER (1.0 / 2.0)
+#define RATIO_SIDE_FRONT (1.0 / sqrt (2.0))
+#define RATIO_SIDE_REAR (1.0 / sqrt (2.0))
+
+#define RATIO_CENTER_BASS (1.0 / sqrt (2.0))
+#define RATIO_FRONT_BASS (1.0)
+#define RATIO_SIDE_BASS (1.0 / sqrt (2.0))
+#define RATIO_REAR_BASS (1.0 / sqrt (2.0))
+
+static void
+gst_channel_mix_fill_others (AudioConvertCtx * this)
+{
+ gboolean in_has_front = FALSE, out_has_front = FALSE,
+ in_has_center = FALSE, out_has_center = FALSE,
+ in_has_rear = FALSE, out_has_rear = FALSE,
+ in_has_side = FALSE, out_has_side = FALSE,
+ in_has_bass = FALSE, out_has_bass = FALSE;
+ /* LEFT, RIGHT, MONO */
+ gint in_f[3] = { -1, -1, -1 };
+ gint out_f[3] = { -1, -1, -1 };
+ /* LOC, ROC, CENTER */
+ gint in_c[3] = { -1, -1, -1 };
+ gint out_c[3] = { -1, -1, -1 };
+ /* RLEFT, RRIGHT, RCENTER */
+ gint in_r[3] = { -1, -1, -1 };
+ gint out_r[3] = { -1, -1, -1 };
+ /* SLEFT, INVALID, SRIGHT */
+ gint in_s[3] = { -1, -1, -1 };
+ gint out_s[3] = { -1, -1, -1 };
+ /* INVALID, LFE, INVALID */
+ gint in_b[3] = { -1, -1, -1 };
+ gint out_b[3] = { -1, -1, -1 };
+
+ /* First see where (if at all) the various channels from/to
+ * which we want to convert are located in our matrix/array. */
+ gst_channel_mix_detect_pos (&this->in,
+ in_f, &in_has_front,
+ in_c, &in_has_center, in_r, &in_has_rear,
+ in_s, &in_has_side, in_b, &in_has_bass);
+ gst_channel_mix_detect_pos (&this->out,
+ out_f, &out_has_front,
+ out_c, &out_has_center, out_r, &out_has_rear,
+ out_s, &out_has_side, out_b, &out_has_bass);
+
+ /* The general idea here is:
+ * - if the source has a channel that the destination doesn't have mix
+ * it into the nearest available destination channel
+ * - if the destination has a channel that the source doesn't have mix
+ * the nearest source channel into the destination channel
+ *
+ * The ratio for the mixing becomes lower as the distance between the
+ * channels gets larger
+ */
+
+ /* center <-> front/side/rear */
+ if (!in_has_center && in_has_front && out_has_center) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_f, &this->out, out_c, RATIO_CENTER_FRONT);
+ } else if (!in_has_center && !in_has_front && in_has_side && out_has_center) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_s, &this->out, out_c, RATIO_CENTER_SIDE);
+ } else if (!in_has_center && !in_has_front && !in_has_side && in_has_rear
+ && out_has_center) {
+ gst_channel_mix_fill_one_other (this->matrix, &this->in, in_r, &this->out,
+ out_c, RATIO_CENTER_REAR);
+ } else if (in_has_center && !out_has_center && out_has_front) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_c, &this->out, out_f, RATIO_CENTER_FRONT);
+ } else if (in_has_center && !out_has_center && !out_has_front && out_has_side) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_c, &this->out, out_s, RATIO_CENTER_SIDE);
+ } else if (in_has_center && !out_has_center && !out_has_front && !out_has_side
+ && out_has_rear) {
+ gst_channel_mix_fill_one_other (this->matrix, &this->in, in_c, &this->out,
+ out_r, RATIO_CENTER_REAR);
+ }
+
+ /* front <-> center/side/rear */
+ if (!in_has_front && in_has_center && !in_has_side && out_has_front) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_c, &this->out, out_f, RATIO_CENTER_FRONT);
+ } else if (!in_has_front && !in_has_center && in_has_side && out_has_front) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_s, &this->out, out_f, RATIO_FRONT_SIDE);
+ } else if (!in_has_front && in_has_center && in_has_side && out_has_front) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_c, &this->out, out_f, 0.5 * RATIO_CENTER_FRONT);
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_s, &this->out, out_f, 0.5 * RATIO_FRONT_SIDE);
+ } else if (!in_has_front && !in_has_center && !in_has_side && in_has_rear
+ && out_has_front) {
+ gst_channel_mix_fill_one_other (this->matrix, &this->in, in_r, &this->out,
+ out_f, RATIO_FRONT_REAR);
+ } else if (in_has_front && out_has_center && !out_has_side && !out_has_front) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_f, &this->out, out_c, RATIO_CENTER_FRONT);
+ } else if (in_has_front && !out_has_center && out_has_side && !out_has_front) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_f, &this->out, out_s, RATIO_FRONT_SIDE);
+ } else if (in_has_front && out_has_center && out_has_side && !out_has_front) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_f, &this->out, out_c, 0.5 * RATIO_CENTER_FRONT);
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_f, &this->out, out_s, 0.5 * RATIO_FRONT_SIDE);
+ } else if (in_has_front && !out_has_center && !out_has_side && !out_has_front
+ && out_has_rear) {
+ gst_channel_mix_fill_one_other (this->matrix, &this->in, in_f, &this->out,
+ out_r, RATIO_FRONT_REAR);
+ }
+
+ /* side <-> center/front/rear */
+ if (!in_has_side && in_has_front && !in_has_rear && out_has_side) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_f, &this->out, out_s, RATIO_FRONT_SIDE);
+ } else if (!in_has_side && !in_has_front && in_has_rear && out_has_side) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_r, &this->out, out_s, RATIO_SIDE_REAR);
+ } else if (!in_has_side && in_has_front && in_has_rear && out_has_side) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_f, &this->out, out_s, 0.5 * RATIO_FRONT_SIDE);
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_r, &this->out, out_s, 0.5 * RATIO_SIDE_REAR);
+ } else if (!in_has_side && !in_has_front && !in_has_rear && in_has_center
+ && out_has_side) {
+ gst_channel_mix_fill_one_other (this->matrix, &this->in, in_c, &this->out,
+ out_s, RATIO_CENTER_SIDE);
+ } else if (in_has_side && out_has_front && !out_has_rear && !out_has_side) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_s, &this->out, out_f, RATIO_FRONT_SIDE);
+ } else if (in_has_side && !out_has_front && out_has_rear && !out_has_side) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_s, &this->out, out_r, RATIO_SIDE_REAR);
+ } else if (in_has_side && out_has_front && out_has_rear && !out_has_side) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_s, &this->out, out_f, 0.5 * RATIO_FRONT_SIDE);
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_s, &this->out, out_r, 0.5 * RATIO_SIDE_REAR);
+ } else if (in_has_side && !out_has_front && !out_has_rear && out_has_center
+ && !out_has_side) {
+ gst_channel_mix_fill_one_other (this->matrix, &this->in, in_s, &this->out,
+ out_c, RATIO_CENTER_SIDE);
+ }
+
+ /* rear <-> center/front/side */
+ if (!in_has_rear && in_has_side && out_has_rear) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_s, &this->out, out_r, RATIO_SIDE_REAR);
+ } else if (!in_has_rear && !in_has_side && in_has_front && out_has_rear) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_f, &this->out, out_r, RATIO_FRONT_REAR);
+ } else if (!in_has_rear && !in_has_side && !in_has_front && in_has_center
+ && out_has_rear) {
+ gst_channel_mix_fill_one_other (this->matrix, &this->in, in_c, &this->out,
+ out_r, RATIO_CENTER_REAR);
+ } else if (in_has_rear && !out_has_rear && out_has_side) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_r, &this->out, out_s, RATIO_SIDE_REAR);
+ } else if (in_has_rear && !out_has_rear && !out_has_side && out_has_front) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_r, &this->out, out_f, RATIO_FRONT_REAR);
+ } else if (in_has_rear && !out_has_rear && !out_has_side && !out_has_front
+ && out_has_center) {
+ gst_channel_mix_fill_one_other (this->matrix, &this->in, in_r, &this->out,
+ out_c, RATIO_CENTER_REAR);
+ }
+
+ /* bass <-> any */
+ if (in_has_bass && !out_has_bass) {
+ if (out_has_center) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_b, &this->out, out_c, RATIO_CENTER_BASS);
+ }
+ if (out_has_front) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_b, &this->out, out_f, RATIO_FRONT_BASS);
+ }
+ if (out_has_side) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_b, &this->out, out_s, RATIO_SIDE_BASS);
+ }
+ if (out_has_rear) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_b, &this->out, out_r, RATIO_REAR_BASS);
+ }
+ } else if (!in_has_bass && out_has_bass) {
+ if (in_has_center) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_c, &this->out, out_b, RATIO_CENTER_BASS);
+ }
+ if (in_has_front) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_f, &this->out, out_b, RATIO_FRONT_BASS);
+ }
+ if (in_has_side) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_s, &this->out, out_b, RATIO_REAR_BASS);
+ }
+ if (in_has_rear) {
+ gst_channel_mix_fill_one_other (this->matrix,
+ &this->in, in_r, &this->out, out_b, RATIO_REAR_BASS);
+ }
+ }
+}
+
+/*
+ * Normalize output values.
+ */
+
+static void
+gst_channel_mix_fill_normalize (AudioConvertCtx * this)
+{
+ gfloat sum, top = 0;
+ gint i, j;
+
+ for (j = 0; j < this->out.channels; j++) {
+ /* calculate sum */
+ sum = 0.0;
+ for (i = 0; i < this->in.channels; i++) {
+ sum += fabs (this->matrix[i][j]);
+ }
+ if (sum > top) {
+ top = sum;
+ }
+ }
+
+ /* normalize to this */
+ if (top == 0.0)
+ return;
+
+ for (j = 0; j < this->out.channels; j++) {
+ for (i = 0; i < this->in.channels; i++) {
+ this->matrix[i][j] /= top;
+ }
+ }
+}
+
+static gboolean
+gst_channel_mix_fill_special (AudioConvertCtx * this)
+{
+ AudioConvertFmt *in = &this->in, *out = &this->out;
+
+ /* Special, standard conversions here */
+
+ /* Mono<->Stereo, just a fast-path */
+ if (in->channels == 2 && out->channels == 1 &&
+ ((in->pos[0] == GST_AUDIO_CHANNEL_POSITION_FRONT_LEFT &&
+ in->pos[1] == GST_AUDIO_CHANNEL_POSITION_FRONT_RIGHT) ||
+ (in->pos[0] == GST_AUDIO_CHANNEL_POSITION_FRONT_RIGHT &&
+ in->pos[1] == GST_AUDIO_CHANNEL_POSITION_FRONT_LEFT)) &&
+ out->pos[0] == GST_AUDIO_CHANNEL_POSITION_FRONT_MONO) {
+ this->matrix[0][0] = 0.5;
+ this->matrix[1][0] = 0.5;
+ return TRUE;
+ } else if (in->channels == 1 && out->channels == 2 &&
+ ((out->pos[0] == GST_AUDIO_CHANNEL_POSITION_FRONT_LEFT &&
+ out->pos[1] == GST_AUDIO_CHANNEL_POSITION_FRONT_RIGHT) ||
+ (out->pos[0] == GST_AUDIO_CHANNEL_POSITION_FRONT_RIGHT &&
+ out->pos[1] == GST_AUDIO_CHANNEL_POSITION_FRONT_LEFT)) &&
+ in->pos[0] == GST_AUDIO_CHANNEL_POSITION_FRONT_MONO) {
+ this->matrix[0][0] = 1.0;
+ this->matrix[0][1] = 1.0;
+ return TRUE;
+ }
+
+ /* TODO: 5.1 <-> Stereo and other standard conversions */
+
+ return FALSE;
+}
+
+/*
+ * Automagically generate conversion matrix.
+ */
+
+static void
+gst_channel_mix_fill_matrix (AudioConvertCtx * this)
+{
+ if (gst_channel_mix_fill_special (this))
+ return;
+
+ gst_channel_mix_fill_identical (this);
+
+ if (!this->in.unpositioned_layout) {
+ gst_channel_mix_fill_compatible (this);
+ gst_channel_mix_fill_others (this);
+ gst_channel_mix_fill_normalize (this);
+ }
+}
+
+/* only call after this->out and this->in are filled in */
+void
+gst_channel_mix_setup_matrix (AudioConvertCtx * this)
+{
+ gint i, j;
+
+ /* don't lose memory */
+ gst_channel_mix_unset_matrix (this);
+
+ /* temp storage */
+ if (this->in.is_int || this->out.is_int) {
+ this->tmp = (gpointer) g_new (gint32, this->out.channels);
+ } else {
+ this->tmp = (gpointer) g_new (gdouble, this->out.channels);
+ }
+
+ /* allocate */
+ this->matrix = g_new0 (gfloat *, this->in.channels);
+ for (i = 0; i < this->in.channels; i++) {
+ this->matrix[i] = g_new (gfloat, this->out.channels);
+ for (j = 0; j < this->out.channels; j++)
+ this->matrix[i][j] = 0.;
+ }
+
+ /* setup the matrix' internal values */
+ gst_channel_mix_fill_matrix (this);
+
+#ifndef GST_DISABLE_GST_DEBUG
+ /* debug */
+ {
+ GString *s;
+ s = g_string_new ("Matrix for");
+ g_string_append_printf (s, " %d -> %d: ",
+ this->in.channels, this->out.channels);
+ g_string_append (s, "{");
+ for (i = 0; i < this->in.channels; i++) {
+ if (i != 0)
+ g_string_append (s, ",");
+ g_string_append (s, " {");
+ for (j = 0; j < this->out.channels; j++) {
+ if (j != 0)
+ g_string_append (s, ",");
+ g_string_append_printf (s, " %f", this->matrix[i][j]);
+ }
+ g_string_append (s, " }");
+ }
+ g_string_append (s, " }");
+ GST_DEBUG ("%s", s->str);
+ g_string_free (s, TRUE);
+ }
+#endif
+}
+
+gboolean
+gst_channel_mix_passthrough (AudioConvertCtx * this)
+{
+ gint i;
+
+ /* only NxN matrices can be identities */
+ if (this->in.channels != this->out.channels)
+ return FALSE;
+
+ /* this assumes a normalized matrix */
+ for (i = 0; i < this->in.channels; i++)
+ if (this->matrix[i][i] != 1.)
+ return FALSE;
+
+ return TRUE;
+}
+
+/* IMPORTANT: out_data == in_data is possible, make sure to not overwrite data
+ * you might need later on! */
+void
+gst_channel_mix_mix_int (AudioConvertCtx * this,
+ gint32 * in_data, gint32 * out_data, gint samples)
+{
+ gint in, out, n;
+ gint64 res;
+ gboolean backwards;
+ gint inchannels, outchannels;
+ gint32 *tmp = (gint32 *) this->tmp;
+
+ g_return_if_fail (this->matrix != NULL);
+ g_return_if_fail (this->tmp != NULL);
+
+ inchannels = this->in.channels;
+ outchannels = this->out.channels;
+ backwards = outchannels > inchannels;
+
+ /* FIXME: use liboil here? */
+ for (n = (backwards ? samples - 1 : 0); n < samples && n >= 0;
+ backwards ? n-- : n++) {
+ for (out = 0; out < outchannels; out++) {
+ /* convert */
+ res = 0;
+ for (in = 0; in < inchannels; in++) {
+ res += in_data[n * inchannels + in] * this->matrix[in][out];
+ }
+
+ /* clip (shouldn't we use doubles instead as intermediate format?) */
+ if (res < G_MININT32)
+ res = G_MININT32;
+ else if (res > G_MAXINT32)
+ res = G_MAXINT32;
+ tmp[out] = res;
+ }
+ memcpy (&out_data[n * outchannels], this->tmp,
+ sizeof (gint32) * outchannels);
+ }
+}
+
+void
+gst_channel_mix_mix_float (AudioConvertCtx * this,
+ gdouble * in_data, gdouble * out_data, gint samples)
+{
+ gint in, out, n;
+ gdouble res;
+ gboolean backwards;
+ gint inchannels, outchannels;
+ gdouble *tmp = (gdouble *) this->tmp;
+
+ g_return_if_fail (this->matrix != NULL);
+ g_return_if_fail (this->tmp != NULL);
+
+ inchannels = this->in.channels;
+ outchannels = this->out.channels;
+ backwards = outchannels > inchannels;
+
+ /* FIXME: use liboil here? */
+ for (n = (backwards ? samples - 1 : 0); n < samples && n >= 0;
+ backwards ? n-- : n++) {
+ for (out = 0; out < outchannels; out++) {
+ /* convert */
+ res = 0.0;
+ for (in = 0; in < inchannels; in++) {
+ res += in_data[n * inchannels + in] * this->matrix[in][out];
+ }
+
+ /* clip (shouldn't we use doubles instead as intermediate format?) */
+ if (res < -1.0)
+ res = -1.0;
+ else if (res > 1.0)
+ res = 1.0;
+ tmp[out] = res;
+ }
+ memcpy (&out_data[n * outchannels], this->tmp,
+ sizeof (gdouble) * outchannels);
+ }
+}
projects / mafwsubrenderer / blobdiff