git.sesse.net Git - ffmpeg/blob - libavresample/audio_mix.c

   1 /*
   2  * Copyright (c) 2012 Justin Ruggles <justin.ruggles@gmail.com>
   3  *
   4  * This file is part of Libav.
   5  *
   6  * Libav is free software; you can redistribute it and/or
   7  * modify it under the terms of the GNU Lesser General Public
   8  * License as published by the Free Software Foundation; either
   9  * version 2.1 of the License, or (at your option) any later version.
  10  *
  11  * Libav is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  14  * Lesser General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU Lesser General Public
  17  * License along with Libav; if not, write to the Free Software
  18  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  19  */
  20
  21 #include <stdint.h>
  22
  23 #include "libavutil/common.h"
  24 #include "libavutil/libm.h"
  25 #include "libavutil/samplefmt.h"
  26 #include "avresample.h"
  27 #include "internal.h"
  28 #include "audio_data.h"
  29 #include "audio_mix.h"
  30
  31 static const char *coeff_type_names[] = { "q8", "q15", "flt" };
  32
  33 struct AudioMix {
  34     AVAudioResampleContext *avr;
  35     enum AVSampleFormat fmt;
  36     enum AVMixCoeffType coeff_type;
  37     uint64_t in_layout;
  38     uint64_t out_layout;
  39     int in_channels;
  40     int out_channels;
  41
  42     int ptr_align;
  43     int samples_align;
  44     int has_optimized_func;
  45     const char *func_descr;
  46     const char *func_descr_generic;
  47     mix_func *mix;
  48     mix_func *mix_generic;
  49
  50     int in_matrix_channels;
  51     int out_matrix_channels;
  52     int output_zero[AVRESAMPLE_MAX_CHANNELS];
  53     int input_skip[AVRESAMPLE_MAX_CHANNELS];
  54     int output_skip[AVRESAMPLE_MAX_CHANNELS];
  55     int16_t *matrix_q8[AVRESAMPLE_MAX_CHANNELS];
  56     int32_t *matrix_q15[AVRESAMPLE_MAX_CHANNELS];
  57     float   *matrix_flt[AVRESAMPLE_MAX_CHANNELS];
  58     void   **matrix;
  59 };
  60
  61 void ff_audio_mix_set_func(AudioMix *am, enum AVSampleFormat fmt,
  62                            enum AVMixCoeffType coeff_type, int in_channels,
  63                            int out_channels, int ptr_align, int samples_align,
  64                            const char *descr, void *mix_func)
  65 {
  66     if (fmt == am->fmt && coeff_type == am->coeff_type &&
  67         ( in_channels ==  am->in_matrix_channels ||  in_channels == 0) &&
  68         (out_channels == am->out_matrix_channels || out_channels == 0)) {
  69         char chan_str[16];
  70         am->mix           = mix_func;
  71         am->func_descr    = descr;
  72         am->ptr_align     = ptr_align;
  73         am->samples_align = samples_align;
  74         if (ptr_align == 1 && samples_align == 1) {
  75             am->mix_generic        = mix_func;
  76             am->func_descr_generic = descr;
  77         } else {
  78             am->has_optimized_func = 1;
  79         }
  80         if (in_channels) {
  81             if (out_channels)
  82                 snprintf(chan_str, sizeof(chan_str), "[%d to %d] ",
  83                          in_channels, out_channels);
  84             else
  85                 snprintf(chan_str, sizeof(chan_str), "[%d to any] ",
  86                          in_channels);
  87         } else if (out_channels) {
  88                 snprintf(chan_str, sizeof(chan_str), "[any to %d] ",
  89                          out_channels);
  90         } else {
  91             snprintf(chan_str, sizeof(chan_str), "[any to any] ");
  92         }
  93         av_log(am->avr, AV_LOG_DEBUG, "audio_mix: found function: [fmt=%s] "
  94                "[c=%s] %s(%s)\n", av_get_sample_fmt_name(fmt),
  95                coeff_type_names[coeff_type], chan_str, descr);
  96     }
  97 }
  98
  99 #define MIX_FUNC_NAME(fmt, cfmt) mix_any_ ## fmt ##_## cfmt ##_c
 100
 101 #define MIX_FUNC_GENERIC(fmt, cfmt, stype, ctype, sumtype, expr)            \
 102 static void MIX_FUNC_NAME(fmt, cfmt)(stype **samples, ctype **matrix,       \
 103                                      int len, int out_ch, int in_ch)        \
 104 {                                                                           \
 105     int i, in, out;                                                         \
 106     stype temp[AVRESAMPLE_MAX_CHANNELS];                                    \
 107     for (i = 0; i < len; i++) {                                             \
 108         for (out = 0; out < out_ch; out++) {                                \
 109             sumtype sum = 0;                                                \
 110             for (in = 0; in < in_ch; in++)                                  \
 111                 sum += samples[in][i] * matrix[out][in];                    \
 112             temp[out] = expr;                                               \
 113         }                                                                   \
 114         for (out = 0; out < out_ch; out++)                                  \
 115             samples[out][i] = temp[out];                                    \
 116     }                                                                       \
 117 }
 118
 119 MIX_FUNC_GENERIC(FLTP, FLT, float,   float,   float,   sum)
 120 MIX_FUNC_GENERIC(S16P, FLT, int16_t, float,   float,   av_clip_int16(lrintf(sum)))
 121 MIX_FUNC_GENERIC(S16P, Q15, int16_t, int32_t, int64_t, av_clip_int16(sum >> 15))
 122 MIX_FUNC_GENERIC(S16P, Q8,  int16_t, int16_t, int32_t, av_clip_int16(sum >>  8))
 123
 124 /* TODO: templatize the channel-specific C functions */
 125
 126 static void mix_2_to_1_fltp_flt_c(float **samples, float **matrix, int len,
 127                                   int out_ch, int in_ch)
 128 {
 129     float *src0 = samples[0];
 130     float *src1 = samples[1];
 131     float *dst  = src0;
 132     float m0    = matrix[0][0];
 133     float m1    = matrix[0][1];
 134
 135     while (len > 4) {
 136         *dst++ = *src0++ * m0 + *src1++ * m1;
 137         *dst++ = *src0++ * m0 + *src1++ * m1;
 138         *dst++ = *src0++ * m0 + *src1++ * m1;
 139         *dst++ = *src0++ * m0 + *src1++ * m1;
 140         len -= 4;
 141     }
 142     while (len > 0) {
 143         *dst++ = *src0++ * m0 + *src1++ * m1;
 144         len--;
 145     }
 146 }
 147
 148 static void mix_2_to_1_s16p_flt_c(int16_t **samples, float **matrix, int len,
 149                                   int out_ch, int in_ch)
 150 {
 151     int16_t *src0 = samples[0];
 152     int16_t *src1 = samples[1];
 153     int16_t *dst  = src0;
 154     float m0      = matrix[0][0];
 155     float m1      = matrix[0][1];
 156
 157     while (len > 4) {
 158         *dst++ = av_clip_int16(lrintf(*src0++ * m0 + *src1++ * m1));
 159         *dst++ = av_clip_int16(lrintf(*src0++ * m0 + *src1++ * m1));
 160         *dst++ = av_clip_int16(lrintf(*src0++ * m0 + *src1++ * m1));
 161         *dst++ = av_clip_int16(lrintf(*src0++ * m0 + *src1++ * m1));
 162         len -= 4;
 163     }
 164     while (len > 0) {
 165         *dst++ = av_clip_int16(lrintf(*src0++ * m0 + *src1++ * m1));
 166         len--;
 167     }
 168 }
 169
 170 static void mix_2_to_1_s16p_q8_c(int16_t **samples, int16_t **matrix, int len,
 171                                  int out_ch, int in_ch)
 172 {
 173     int16_t *src0 = samples[0];
 174     int16_t *src1 = samples[1];
 175     int16_t *dst  = src0;
 176     int16_t m0    = matrix[0][0];
 177     int16_t m1    = matrix[0][1];
 178
 179     while (len > 4) {
 180         *dst++ = (*src0++ * m0 + *src1++ * m1) >> 8;
 181         *dst++ = (*src0++ * m0 + *src1++ * m1) >> 8;
 182         *dst++ = (*src0++ * m0 + *src1++ * m1) >> 8;
 183         *dst++ = (*src0++ * m0 + *src1++ * m1) >> 8;
 184         len -= 4;
 185     }
 186     while (len > 0) {
 187         *dst++ = (*src0++ * m0 + *src1++ * m1) >> 8;
 188         len--;
 189     }
 190 }
 191
 192 static void mix_1_to_2_fltp_flt_c(float **samples, float **matrix, int len,
 193                                   int out_ch, int in_ch)
 194 {
 195     float v;
 196     float *dst0 = samples[0];
 197     float *dst1 = samples[1];
 198     float *src  = dst0;
 199     float m0    = matrix[0][0];
 200     float m1    = matrix[1][0];
 201
 202     while (len > 4) {
 203         v = *src++;
 204         *dst0++ = v * m1;
 205         *dst1++ = v * m0;
 206         v = *src++;
 207         *dst0++ = v * m1;
 208         *dst1++ = v * m0;
 209         v = *src++;
 210         *dst0++ = v * m1;
 211         *dst1++ = v * m0;
 212         v = *src++;
 213         *dst0++ = v * m1;
 214         *dst1++ = v * m0;
 215         len -= 4;
 216     }
 217     while (len > 0) {
 218         v = *src++;
 219         *dst0++ = v * m1;
 220         *dst1++ = v * m0;
 221         len--;
 222     }
 223 }
 224
 225 static void mix_6_to_2_fltp_flt_c(float **samples, float **matrix, int len,
 226                                   int out_ch, int in_ch)
 227 {
 228     float v0, v1;
 229     float *src0 = samples[0];
 230     float *src1 = samples[1];
 231     float *src2 = samples[2];
 232     float *src3 = samples[3];
 233     float *src4 = samples[4];
 234     float *src5 = samples[5];
 235     float *dst0 = src0;
 236     float *dst1 = src1;
 237     float *m0   = matrix[0];
 238     float *m1   = matrix[1];
 239
 240     while (len > 0) {
 241         v0 = *src0++;
 242         v1 = *src1++;
 243         *dst0++ = v0      * m0[0] +
 244                   v1      * m0[1] +
 245                   *src2   * m0[2] +
 246                   *src3   * m0[3] +
 247                   *src4   * m0[4] +
 248                   *src5   * m0[5];
 249         *dst1++ = v0      * m1[0] +
 250                   v1      * m1[1] +
 251                   *src2++ * m1[2] +
 252                   *src3++ * m1[3] +
 253                   *src4++ * m1[4] +
 254                   *src5++ * m1[5];
 255         len--;
 256     }
 257 }
 258
 259 static void mix_2_to_6_fltp_flt_c(float **samples, float **matrix, int len,
 260                                   int out_ch, int in_ch)
 261 {
 262     float v0, v1;
 263     float *dst0 = samples[0];
 264     float *dst1 = samples[1];
 265     float *dst2 = samples[2];
 266     float *dst3 = samples[3];
 267     float *dst4 = samples[4];
 268     float *dst5 = samples[5];
 269     float *src0 = dst0;
 270     float *src1 = dst1;
 271
 272     while (len > 0) {
 273         v0 = *src0++;
 274         v1 = *src1++;
 275         *dst0++ = v0 * matrix[0][0] + v1 * matrix[0][1];
 276         *dst1++ = v0 * matrix[1][0] + v1 * matrix[1][1];
 277         *dst2++ = v0 * matrix[2][0] + v1 * matrix[2][1];
 278         *dst3++ = v0 * matrix[3][0] + v1 * matrix[3][1];
 279         *dst4++ = v0 * matrix[4][0] + v1 * matrix[4][1];
 280         *dst5++ = v0 * matrix[5][0] + v1 * matrix[5][1];
 281         len--;
 282     }
 283 }
 284
 285 static int mix_function_init(AudioMix *am)
 286 {
 287     am->func_descr = am->func_descr_generic = "n/a";
 288     am->mix = am->mix_generic = NULL;
 289
 290     /* no need to set a mix function when we're skipping mixing */
 291     if (!am->in_matrix_channels || !am->out_matrix_channels)
 292         return 0;
 293
 294     /* any-to-any C versions */
 295
 296     ff_audio_mix_set_func(am, AV_SAMPLE_FMT_FLTP, AV_MIX_COEFF_TYPE_FLT,
 297                           0, 0, 1, 1, "C", MIX_FUNC_NAME(FLTP, FLT));
 298
 299     ff_audio_mix_set_func(am, AV_SAMPLE_FMT_S16P, AV_MIX_COEFF_TYPE_FLT,
 300                           0, 0, 1, 1, "C", MIX_FUNC_NAME(S16P, FLT));
 301
 302     ff_audio_mix_set_func(am, AV_SAMPLE_FMT_S16P, AV_MIX_COEFF_TYPE_Q15,
 303                           0, 0, 1, 1, "C", MIX_FUNC_NAME(S16P, Q15));
 304
 305     ff_audio_mix_set_func(am, AV_SAMPLE_FMT_S16P, AV_MIX_COEFF_TYPE_Q8,
 306                           0, 0, 1, 1, "C", MIX_FUNC_NAME(S16P, Q8));
 307
 308     /* channel-specific C versions */
 309
 310     ff_audio_mix_set_func(am, AV_SAMPLE_FMT_FLTP, AV_MIX_COEFF_TYPE_FLT,
 311                           2, 1, 1, 1, "C", mix_2_to_1_fltp_flt_c);
 312
 313     ff_audio_mix_set_func(am, AV_SAMPLE_FMT_S16P, AV_MIX_COEFF_TYPE_FLT,
 314                           2, 1, 1, 1, "C", mix_2_to_1_s16p_flt_c);
 315
 316     ff_audio_mix_set_func(am, AV_SAMPLE_FMT_S16P, AV_MIX_COEFF_TYPE_Q8,
 317                           2, 1, 1, 1, "C", mix_2_to_1_s16p_q8_c);
 318
 319     ff_audio_mix_set_func(am, AV_SAMPLE_FMT_FLTP, AV_MIX_COEFF_TYPE_FLT,
 320                           1, 2, 1, 1, "C", mix_1_to_2_fltp_flt_c);
 321
 322     ff_audio_mix_set_func(am, AV_SAMPLE_FMT_FLTP, AV_MIX_COEFF_TYPE_FLT,
 323                           6, 2, 1, 1, "C", mix_6_to_2_fltp_flt_c);
 324
 325     ff_audio_mix_set_func(am, AV_SAMPLE_FMT_FLTP, AV_MIX_COEFF_TYPE_FLT,
 326                           2, 6, 1, 1, "C", mix_2_to_6_fltp_flt_c);
 327
 328     if (ARCH_X86)
 329         ff_audio_mix_init_x86(am);
 330
 331     if (!am->mix) {
 332         av_log(am->avr, AV_LOG_ERROR, "audio_mix: NO FUNCTION FOUND: [fmt=%s] "
 333                "[c=%s] [%d to %d]\n", av_get_sample_fmt_name(am->fmt),
 334                coeff_type_names[am->coeff_type], am->in_channels,
 335                am->out_channels);
 336         return AVERROR_PATCHWELCOME;
 337     }
 338     return 0;
 339 }
 340
 341 AudioMix *ff_audio_mix_alloc(AVAudioResampleContext *avr)
 342 {
 343     AudioMix *am;
 344     int ret;
 345
 346     am = av_mallocz(sizeof(*am));
 347     if (!am)
 348         return NULL;
 349     am->avr = avr;
 350
 351     if (avr->internal_sample_fmt != AV_SAMPLE_FMT_S16P &&
 352         avr->internal_sample_fmt != AV_SAMPLE_FMT_FLTP) {
 353         av_log(avr, AV_LOG_ERROR, "Unsupported internal format for "
 354                "mixing: %s\n",
 355                av_get_sample_fmt_name(avr->internal_sample_fmt));
 356         goto error;
 357     }
 358
 359     am->fmt          = avr->internal_sample_fmt;
 360     am->coeff_type   = avr->mix_coeff_type;
 361     am->in_layout    = avr->in_channel_layout;
 362     am->out_layout   = avr->out_channel_layout;
 363     am->in_channels  = avr->in_channels;
 364     am->out_channels = avr->out_channels;
 365
 366     /* build matrix if the user did not already set one */
 367     if (avr->mix_matrix) {
 368         ret = ff_audio_mix_set_matrix(am, avr->mix_matrix, avr->in_channels);
 369         if (ret < 0)
 370             goto error;
 371         av_freep(&avr->mix_matrix);
 372     } else {
 373         double *matrix_dbl = av_mallocz(avr->out_channels * avr->in_channels *
 374                                         sizeof(*matrix_dbl));
 375         if (!matrix_dbl)
 376             goto error;
 377
 378         ret = avresample_build_matrix(avr->in_channel_layout,
 379                                       avr->out_channel_layout,
 380                                       avr->center_mix_level,
 381                                       avr->surround_mix_level,
 382                                       avr->lfe_mix_level,
 383                                       avr->normalize_mix_level,
 384                                       matrix_dbl,
 385                                       avr->in_channels,
 386                                       avr->matrix_encoding);
 387         if (ret < 0) {
 388             av_free(matrix_dbl);
 389             goto error;
 390         }
 391
 392         ret = ff_audio_mix_set_matrix(am, matrix_dbl, avr->in_channels);
 393         if (ret < 0) {
 394             av_log(avr, AV_LOG_ERROR, "error setting mix matrix\n");
 395             av_free(matrix_dbl);
 396             goto error;
 397         }
 398
 399         av_free(matrix_dbl);
 400     }
 401
 402     return am;
 403
 404 error:
 405     av_free(am);
 406     return NULL;
 407 }
 408
 409 void ff_audio_mix_free(AudioMix **am_p)
 410 {
 411     AudioMix *am;
 412
 413     if (!*am_p)
 414         return;
 415     am = *am_p;
 416
 417     if (am->matrix) {
 418         av_free(am->matrix[0]);
 419         am->matrix = NULL;
 420     }
 421     memset(am->matrix_q8,  0, sizeof(am->matrix_q8 ));
 422     memset(am->matrix_q15, 0, sizeof(am->matrix_q15));
 423     memset(am->matrix_flt, 0, sizeof(am->matrix_flt));
 424
 425     av_freep(am_p);
 426 }
 427
 428 int ff_audio_mix(AudioMix *am, AudioData *src)
 429 {
 430     int use_generic = 1;
 431     int len = src->nb_samples;
 432     int i, j;
 433
 434     /* determine whether to use the optimized function based on pointer and
 435        samples alignment in both the input and output */
 436     if (am->has_optimized_func) {
 437         int aligned_len = FFALIGN(len, am->samples_align);
 438         if (!(src->ptr_align % am->ptr_align) &&
 439             src->samples_align >= aligned_len) {
 440             len = aligned_len;
 441             use_generic = 0;
 442         }
 443     }
 444     av_dlog(am->avr, "audio_mix: %d samples - %d to %d channels (%s)\n",
 445             src->nb_samples, am->in_channels, am->out_channels,
 446             use_generic ? am->func_descr_generic : am->func_descr);
 447
 448     if (am->in_matrix_channels && am->out_matrix_channels) {
 449         uint8_t **data;
 450         uint8_t *data0[AVRESAMPLE_MAX_CHANNELS];
 451
 452         if (am->out_matrix_channels < am->out_channels ||
 453              am->in_matrix_channels <  am->in_channels) {
 454             for (i = 0, j = 0; i < FFMAX(am->in_channels, am->out_channels); i++) {
 455                 if (am->input_skip[i] || am->output_skip[i] || am->output_zero[i])
 456                     continue;
 457                 data0[j++] = src->data[i];
 458             }
 459             data = data0;
 460         } else {
 461             data = src->data;
 462         }
 463
 464         if (use_generic)
 465             am->mix_generic(data, am->matrix, len, am->out_matrix_channels,
 466                             am->in_matrix_channels);
 467         else
 468             am->mix(data, am->matrix, len, am->out_matrix_channels,
 469                     am->in_matrix_channels);
 470     }
 471
 472     if (am->out_matrix_channels < am->out_channels) {
 473         for (i = 0; i < am->out_channels; i++)
 474             if (am->output_zero[i])
 475                 av_samples_set_silence(&src->data[i], 0, len, 1, am->fmt);
 476     }
 477
 478     ff_audio_data_set_channels(src, am->out_channels);
 479
 480     return 0;
 481 }
 482
 483 int ff_audio_mix_get_matrix(AudioMix *am, double *matrix, int stride)
 484 {
 485     int i, o, i0, o0;
 486
 487     if ( am->in_channels <= 0 ||  am->in_channels > AVRESAMPLE_MAX_CHANNELS ||
 488         am->out_channels <= 0 || am->out_channels > AVRESAMPLE_MAX_CHANNELS) {
 489         av_log(am->avr, AV_LOG_ERROR, "Invalid channel counts\n");
 490         return AVERROR(EINVAL);
 491     }
 492
 493 #define GET_MATRIX_CONVERT(suffix, scale)                                   \
 494     if (!am->matrix_ ## suffix[0]) {                                        \
 495         av_log(am->avr, AV_LOG_ERROR, "matrix is not set\n");               \
 496         return AVERROR(EINVAL);                                             \
 497     }                                                                       \
 498     for (o = 0, o0 = 0; o < am->out_channels; o++) {                        \
 499         for (i = 0, i0 = 0; i < am->in_channels; i++) {                     \
 500             if (am->input_skip[i] || am->output_zero[o])                    \
 501                 matrix[o * stride + i] = 0.0;                               \
 502             else                                                            \
 503                 matrix[o * stride + i] = am->matrix_ ## suffix[o0][i0] *    \
 504                                          (scale);                           \
 505             if (!am->input_skip[i])                                         \
 506                 i0++;                                                       \
 507         }                                                                   \
 508         if (!am->output_zero[o])                                            \
 509             o0++;                                                           \
 510     }
 511
 512     switch (am->coeff_type) {
 513     case AV_MIX_COEFF_TYPE_Q8:
 514         GET_MATRIX_CONVERT(q8, 1.0 / 256.0);
 515         break;
 516     case AV_MIX_COEFF_TYPE_Q15:
 517         GET_MATRIX_CONVERT(q15, 1.0 / 32768.0);
 518         break;
 519     case AV_MIX_COEFF_TYPE_FLT:
 520         GET_MATRIX_CONVERT(flt, 1.0);
 521         break;
 522     default:
 523         av_log(am->avr, AV_LOG_ERROR, "Invalid mix coeff type\n");
 524         return AVERROR(EINVAL);
 525     }
 526
 527     return 0;
 528 }
 529
 530 static void reduce_matrix(AudioMix *am, const double *matrix, int stride)
 531 {
 532     int i, o;
 533
 534     memset(am->output_zero, 0, sizeof(am->output_zero));
 535     memset(am->input_skip,  0, sizeof(am->input_skip));
 536     memset(am->output_skip, 0, sizeof(am->output_skip));
 537
 538     /* exclude output channels if they can be zeroed instead of mixed */
 539     for (o = 0; o < am->out_channels; o++) {
 540         int zero = 1;
 541
 542         /* check if the output is always silent */
 543         for (i = 0; i < am->in_channels; i++) {
 544             if (matrix[o * stride + i] != 0.0) {
 545                 zero = 0;
 546                 break;
 547             }
 548         }
 549         /* check if the corresponding input channel makes a contribution to
 550            any output channel */
 551         if (o < am->in_channels) {
 552             for (i = 0; i < am->out_channels; i++) {
 553                 if (matrix[i * stride + o] != 0.0) {
 554                     zero = 0;
 555                     break;
 556                 }
 557             }
 558         }
 559         if (zero) {
 560             am->output_zero[o] = 1;
 561             am->out_matrix_channels--;
 562         }
 563     }
 564     if (am->out_matrix_channels == 0) {
 565         am->in_matrix_channels = 0;
 566         return;
 567     }
 568
 569     /* skip input channels that contribute fully only to the corresponding
 570        output channel */
 571     for (i = 0; i < FFMIN(am->in_channels, am->out_channels); i++) {
 572         int skip = 1;
 573
 574         for (o = 0; o < am->out_channels; o++) {
 575             if ((o != i && matrix[o * stride + i] != 0.0) ||
 576                 (o == i && matrix[o * stride + i] != 1.0)) {
 577                 skip = 0;
 578                 break;
 579             }
 580         }
 581         if (skip) {
 582             am->input_skip[i] = 1;
 583             am->in_matrix_channels--;
 584         }
 585     }
 586     /* skip input channels that do not contribute to any output channel */
 587     for (; i < am->in_channels; i++) {
 588         int contrib = 0;
 589
 590         for (o = 0; o < am->out_channels; o++) {
 591             if (matrix[o * stride + i] != 0.0) {
 592                 contrib = 1;
 593                 break;
 594             }
 595         }
 596         if (!contrib) {
 597             am->input_skip[i] = 1;
 598             am->in_matrix_channels--;
 599         }
 600     }
 601     if (am->in_matrix_channels == 0) {
 602         am->out_matrix_channels = 0;
 603         return;
 604     }
 605
 606     /* skip output channels that only get full contribution from the
 607        corresponding input channel */
 608     for (o = 0; o < FFMIN(am->in_channels, am->out_channels); o++) {
 609         int skip = 1;
 610
 611         for (i = 0; i < am->in_channels; i++) {
 612             if ((o != i && matrix[o * stride + i] != 0.0) ||
 613                 (o == i && matrix[o * stride + i] != 1.0)) {
 614                 skip = 0;
 615                 break;
 616             }
 617         }
 618         if (skip) {
 619             am->output_skip[o] = 1;
 620             am->out_matrix_channels--;
 621         }
 622     }
 623     if (am->out_matrix_channels == 0) {
 624         am->in_matrix_channels = 0;
 625         return;
 626     }
 627 }
 628
 629 int ff_audio_mix_set_matrix(AudioMix *am, const double *matrix, int stride)
 630 {
 631     int i, o, i0, o0, ret;
 632     char in_layout_name[128];
 633     char out_layout_name[128];
 634
 635     if ( am->in_channels <= 0 ||  am->in_channels > AVRESAMPLE_MAX_CHANNELS ||
 636         am->out_channels <= 0 || am->out_channels > AVRESAMPLE_MAX_CHANNELS) {
 637         av_log(am->avr, AV_LOG_ERROR, "Invalid channel counts\n");
 638         return AVERROR(EINVAL);
 639     }
 640
 641     if (am->matrix) {
 642         av_free(am->matrix[0]);
 643         am->matrix = NULL;
 644     }
 645
 646     am->in_matrix_channels  = am->in_channels;
 647     am->out_matrix_channels = am->out_channels;
 648
 649     reduce_matrix(am, matrix, stride);
 650
 651 #define CONVERT_MATRIX(type, expr)                                          \
 652     am->matrix_## type[0] = av_mallocz(am->out_matrix_channels *            \
 653                                        am->in_matrix_channels  *            \
 654                                        sizeof(*am->matrix_## type[0]));     \
 655     if (!am->matrix_## type[0])                                             \
 656         return AVERROR(ENOMEM);                                             \
 657     for (o = 0, o0 = 0; o < am->out_channels; o++) {                        \
 658         if (am->output_zero[o] || am->output_skip[o])                       \
 659             continue;                                                       \
 660         if (o0 > 0)                                                         \
 661             am->matrix_## type[o0] = am->matrix_## type[o0 - 1] +           \
 662                                      am->in_matrix_channels;                \
 663         for (i = 0, i0 = 0; i < am->in_channels; i++) {                     \
 664             double v;                                                       \
 665             if (am->input_skip[i])                                          \
 666                 continue;                                                   \
 667             v = matrix[o * stride + i];                                     \
 668             am->matrix_## type[o0][i0] = expr;                              \
 669             i0++;                                                           \
 670         }                                                                   \
 671         o0++;                                                               \
 672     }                                                                       \
 673     am->matrix = (void **)am->matrix_## type;
 674
 675     if (am->in_matrix_channels && am->out_matrix_channels) {
 676     switch (am->coeff_type) {
 677     case AV_MIX_COEFF_TYPE_Q8:
 678         CONVERT_MATRIX(q8, av_clip_int16(lrint(256.0 * v)))
 679         break;
 680     case AV_MIX_COEFF_TYPE_Q15:
 681         CONVERT_MATRIX(q15, av_clipl_int32(llrint(32768.0 * v)))
 682         break;
 683     case AV_MIX_COEFF_TYPE_FLT:
 684         CONVERT_MATRIX(flt, v)
 685         break;
 686     default:
 687         av_log(am->avr, AV_LOG_ERROR, "Invalid mix coeff type\n");
 688         return AVERROR(EINVAL);
 689     }
 690     }
 691
 692     ret = mix_function_init(am);
 693     if (ret < 0)
 694         return ret;
 695
 696     av_get_channel_layout_string(in_layout_name, sizeof(in_layout_name),
 697                                  am->in_channels, am->in_layout);
 698     av_get_channel_layout_string(out_layout_name, sizeof(out_layout_name),
 699                                  am->out_channels, am->out_layout);
 700     av_log(am->avr, AV_LOG_DEBUG, "audio_mix: %s to %s\n",
 701            in_layout_name, out_layout_name);
 702     av_log(am->avr, AV_LOG_DEBUG, "matrix size: %d x %d\n",
 703            am->in_matrix_channels, am->out_matrix_channels);
 704     for (o = 0; o < am->out_channels; o++) {
 705         for (i = 0; i < am->in_channels; i++) {
 706             if (am->output_zero[o])
 707                 av_log(am->avr, AV_LOG_DEBUG, "  (ZERO)");
 708             else if (am->input_skip[i] || am->output_skip[o])
 709                 av_log(am->avr, AV_LOG_DEBUG, "  (SKIP)");
 710             else
 711                 av_log(am->avr, AV_LOG_DEBUG, "  %0.3f ",
 712                        matrix[o * am->in_channels + i]);
 713         }
 714         av_log(am->avr, AV_LOG_DEBUG, "\n");
 715     }
 716
 717     return 0;
 718 }