yading@11: /* yading@11: * Copyright (c) 2012 Justin Ruggles yading@11: * yading@11: * This file is part of Libav. yading@11: * yading@11: * Libav is free software; you can redistribute it and/or yading@11: * modify it under the terms of the GNU Lesser General Public yading@11: * License as published by the Free Software Foundation; either yading@11: * version 2.1 of the License, or (at your option) any later version. yading@11: * yading@11: * Libav is distributed in the hope that it will be useful, yading@11: * but WITHOUT ANY WARRANTY; without even the implied warranty of yading@11: * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU yading@11: * Lesser General Public License for more details. yading@11: * yading@11: * You should have received a copy of the GNU Lesser General Public yading@11: * License along with Libav; if not, write to the Free Software yading@11: * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA yading@11: */ yading@11: yading@11: #include yading@11: yading@11: #include "libavutil/common.h" yading@11: #include "libavutil/libm.h" yading@11: #include "libavutil/samplefmt.h" yading@11: #include "avresample.h" yading@11: #include "internal.h" yading@11: #include "audio_data.h" yading@11: #include "audio_mix.h" yading@11: yading@11: static const char *coeff_type_names[] = { "q8", "q15", "flt" }; yading@11: yading@11: struct AudioMix { yading@11: AVAudioResampleContext *avr; yading@11: enum AVSampleFormat fmt; yading@11: enum AVMixCoeffType coeff_type; yading@11: uint64_t in_layout; yading@11: uint64_t out_layout; yading@11: int in_channels; yading@11: int out_channels; yading@11: yading@11: int ptr_align; yading@11: int samples_align; yading@11: int has_optimized_func; yading@11: const char *func_descr; yading@11: const char *func_descr_generic; yading@11: mix_func *mix; yading@11: mix_func *mix_generic; yading@11: yading@11: int in_matrix_channels; yading@11: int out_matrix_channels; yading@11: int output_zero[AVRESAMPLE_MAX_CHANNELS]; yading@11: int input_skip[AVRESAMPLE_MAX_CHANNELS]; yading@11: int output_skip[AVRESAMPLE_MAX_CHANNELS]; yading@11: int16_t *matrix_q8[AVRESAMPLE_MAX_CHANNELS]; yading@11: int32_t *matrix_q15[AVRESAMPLE_MAX_CHANNELS]; yading@11: float *matrix_flt[AVRESAMPLE_MAX_CHANNELS]; yading@11: void **matrix; yading@11: }; yading@11: yading@11: void ff_audio_mix_set_func(AudioMix *am, enum AVSampleFormat fmt, yading@11: enum AVMixCoeffType coeff_type, int in_channels, yading@11: int out_channels, int ptr_align, int samples_align, yading@11: const char *descr, void *mix_func) yading@11: { yading@11: if (fmt == am->fmt && coeff_type == am->coeff_type && yading@11: ( in_channels == am->in_matrix_channels || in_channels == 0) && yading@11: (out_channels == am->out_matrix_channels || out_channels == 0)) { yading@11: char chan_str[16]; yading@11: am->mix = mix_func; yading@11: am->func_descr = descr; yading@11: am->ptr_align = ptr_align; yading@11: am->samples_align = samples_align; yading@11: if (ptr_align == 1 && samples_align == 1) { yading@11: am->mix_generic = mix_func; yading@11: am->func_descr_generic = descr; yading@11: } else { yading@11: am->has_optimized_func = 1; yading@11: } yading@11: if (in_channels) { yading@11: if (out_channels) yading@11: snprintf(chan_str, sizeof(chan_str), "[%d to %d] ", yading@11: in_channels, out_channels); yading@11: else yading@11: snprintf(chan_str, sizeof(chan_str), "[%d to any] ", yading@11: in_channels); yading@11: } else if (out_channels) { yading@11: snprintf(chan_str, sizeof(chan_str), "[any to %d] ", yading@11: out_channels); yading@11: } else { yading@11: snprintf(chan_str, sizeof(chan_str), "[any to any] "); yading@11: } yading@11: av_log(am->avr, AV_LOG_DEBUG, "audio_mix: found function: [fmt=%s] " yading@11: "[c=%s] %s(%s)\n", av_get_sample_fmt_name(fmt), yading@11: coeff_type_names[coeff_type], chan_str, descr); yading@11: } yading@11: } yading@11: yading@11: #define MIX_FUNC_NAME(fmt, cfmt) mix_any_ ## fmt ##_## cfmt ##_c yading@11: yading@11: #define MIX_FUNC_GENERIC(fmt, cfmt, stype, ctype, sumtype, expr) \ yading@11: static void MIX_FUNC_NAME(fmt, cfmt)(stype **samples, ctype **matrix, \ yading@11: int len, int out_ch, int in_ch) \ yading@11: { \ yading@11: int i, in, out; \ yading@11: stype temp[AVRESAMPLE_MAX_CHANNELS]; \ yading@11: for (i = 0; i < len; i++) { \ yading@11: for (out = 0; out < out_ch; out++) { \ yading@11: sumtype sum = 0; \ yading@11: for (in = 0; in < in_ch; in++) \ yading@11: sum += samples[in][i] * matrix[out][in]; \ yading@11: temp[out] = expr; \ yading@11: } \ yading@11: for (out = 0; out < out_ch; out++) \ yading@11: samples[out][i] = temp[out]; \ yading@11: } \ yading@11: } yading@11: yading@11: MIX_FUNC_GENERIC(FLTP, FLT, float, float, float, sum) yading@11: MIX_FUNC_GENERIC(S16P, FLT, int16_t, float, float, av_clip_int16(lrintf(sum))) yading@11: MIX_FUNC_GENERIC(S16P, Q15, int16_t, int32_t, int64_t, av_clip_int16(sum >> 15)) yading@11: MIX_FUNC_GENERIC(S16P, Q8, int16_t, int16_t, int32_t, av_clip_int16(sum >> 8)) yading@11: yading@11: /* TODO: templatize the channel-specific C functions */ yading@11: yading@11: static void mix_2_to_1_fltp_flt_c(float **samples, float **matrix, int len, yading@11: int out_ch, int in_ch) yading@11: { yading@11: float *src0 = samples[0]; yading@11: float *src1 = samples[1]; yading@11: float *dst = src0; yading@11: float m0 = matrix[0][0]; yading@11: float m1 = matrix[0][1]; yading@11: yading@11: while (len > 4) { yading@11: *dst++ = *src0++ * m0 + *src1++ * m1; yading@11: *dst++ = *src0++ * m0 + *src1++ * m1; yading@11: *dst++ = *src0++ * m0 + *src1++ * m1; yading@11: *dst++ = *src0++ * m0 + *src1++ * m1; yading@11: len -= 4; yading@11: } yading@11: while (len > 0) { yading@11: *dst++ = *src0++ * m0 + *src1++ * m1; yading@11: len--; yading@11: } yading@11: } yading@11: yading@11: static void mix_2_to_1_s16p_flt_c(int16_t **samples, float **matrix, int len, yading@11: int out_ch, int in_ch) yading@11: { yading@11: int16_t *src0 = samples[0]; yading@11: int16_t *src1 = samples[1]; yading@11: int16_t *dst = src0; yading@11: float m0 = matrix[0][0]; yading@11: float m1 = matrix[0][1]; yading@11: yading@11: while (len > 4) { yading@11: *dst++ = av_clip_int16(lrintf(*src0++ * m0 + *src1++ * m1)); yading@11: *dst++ = av_clip_int16(lrintf(*src0++ * m0 + *src1++ * m1)); yading@11: *dst++ = av_clip_int16(lrintf(*src0++ * m0 + *src1++ * m1)); yading@11: *dst++ = av_clip_int16(lrintf(*src0++ * m0 + *src1++ * m1)); yading@11: len -= 4; yading@11: } yading@11: while (len > 0) { yading@11: *dst++ = av_clip_int16(lrintf(*src0++ * m0 + *src1++ * m1)); yading@11: len--; yading@11: } yading@11: } yading@11: yading@11: static void mix_2_to_1_s16p_q8_c(int16_t **samples, int16_t **matrix, int len, yading@11: int out_ch, int in_ch) yading@11: { yading@11: int16_t *src0 = samples[0]; yading@11: int16_t *src1 = samples[1]; yading@11: int16_t *dst = src0; yading@11: int16_t m0 = matrix[0][0]; yading@11: int16_t m1 = matrix[0][1]; yading@11: yading@11: while (len > 4) { yading@11: *dst++ = (*src0++ * m0 + *src1++ * m1) >> 8; yading@11: *dst++ = (*src0++ * m0 + *src1++ * m1) >> 8; yading@11: *dst++ = (*src0++ * m0 + *src1++ * m1) >> 8; yading@11: *dst++ = (*src0++ * m0 + *src1++ * m1) >> 8; yading@11: len -= 4; yading@11: } yading@11: while (len > 0) { yading@11: *dst++ = (*src0++ * m0 + *src1++ * m1) >> 8; yading@11: len--; yading@11: } yading@11: } yading@11: yading@11: static void mix_1_to_2_fltp_flt_c(float **samples, float **matrix, int len, yading@11: int out_ch, int in_ch) yading@11: { yading@11: float v; yading@11: float *dst0 = samples[0]; yading@11: float *dst1 = samples[1]; yading@11: float *src = dst0; yading@11: float m0 = matrix[0][0]; yading@11: float m1 = matrix[1][0]; yading@11: yading@11: while (len > 4) { yading@11: v = *src++; yading@11: *dst0++ = v * m1; yading@11: *dst1++ = v * m0; yading@11: v = *src++; yading@11: *dst0++ = v * m1; yading@11: *dst1++ = v * m0; yading@11: v = *src++; yading@11: *dst0++ = v * m1; yading@11: *dst1++ = v * m0; yading@11: v = *src++; yading@11: *dst0++ = v * m1; yading@11: *dst1++ = v * m0; yading@11: len -= 4; yading@11: } yading@11: while (len > 0) { yading@11: v = *src++; yading@11: *dst0++ = v * m1; yading@11: *dst1++ = v * m0; yading@11: len--; yading@11: } yading@11: } yading@11: yading@11: static void mix_6_to_2_fltp_flt_c(float **samples, float **matrix, int len, yading@11: int out_ch, int in_ch) yading@11: { yading@11: float v0, v1; yading@11: float *src0 = samples[0]; yading@11: float *src1 = samples[1]; yading@11: float *src2 = samples[2]; yading@11: float *src3 = samples[3]; yading@11: float *src4 = samples[4]; yading@11: float *src5 = samples[5]; yading@11: float *dst0 = src0; yading@11: float *dst1 = src1; yading@11: float *m0 = matrix[0]; yading@11: float *m1 = matrix[1]; yading@11: yading@11: while (len > 0) { yading@11: v0 = *src0++; yading@11: v1 = *src1++; yading@11: *dst0++ = v0 * m0[0] + yading@11: v1 * m0[1] + yading@11: *src2 * m0[2] + yading@11: *src3 * m0[3] + yading@11: *src4 * m0[4] + yading@11: *src5 * m0[5]; yading@11: *dst1++ = v0 * m1[0] + yading@11: v1 * m1[1] + yading@11: *src2++ * m1[2] + yading@11: *src3++ * m1[3] + yading@11: *src4++ * m1[4] + yading@11: *src5++ * m1[5]; yading@11: len--; yading@11: } yading@11: } yading@11: yading@11: static void mix_2_to_6_fltp_flt_c(float **samples, float **matrix, int len, yading@11: int out_ch, int in_ch) yading@11: { yading@11: float v0, v1; yading@11: float *dst0 = samples[0]; yading@11: float *dst1 = samples[1]; yading@11: float *dst2 = samples[2]; yading@11: float *dst3 = samples[3]; yading@11: float *dst4 = samples[4]; yading@11: float *dst5 = samples[5]; yading@11: float *src0 = dst0; yading@11: float *src1 = dst1; yading@11: yading@11: while (len > 0) { yading@11: v0 = *src0++; yading@11: v1 = *src1++; yading@11: *dst0++ = v0 * matrix[0][0] + v1 * matrix[0][1]; yading@11: *dst1++ = v0 * matrix[1][0] + v1 * matrix[1][1]; yading@11: *dst2++ = v0 * matrix[2][0] + v1 * matrix[2][1]; yading@11: *dst3++ = v0 * matrix[3][0] + v1 * matrix[3][1]; yading@11: *dst4++ = v0 * matrix[4][0] + v1 * matrix[4][1]; yading@11: *dst5++ = v0 * matrix[5][0] + v1 * matrix[5][1]; yading@11: len--; yading@11: } yading@11: } yading@11: yading@11: static int mix_function_init(AudioMix *am) yading@11: { yading@11: am->func_descr = am->func_descr_generic = "n/a"; yading@11: am->mix = am->mix_generic = NULL; yading@11: yading@11: /* no need to set a mix function when we're skipping mixing */ yading@11: if (!am->in_matrix_channels || !am->out_matrix_channels) yading@11: return 0; yading@11: yading@11: /* any-to-any C versions */ yading@11: yading@11: ff_audio_mix_set_func(am, AV_SAMPLE_FMT_FLTP, AV_MIX_COEFF_TYPE_FLT, yading@11: 0, 0, 1, 1, "C", MIX_FUNC_NAME(FLTP, FLT)); yading@11: yading@11: ff_audio_mix_set_func(am, AV_SAMPLE_FMT_S16P, AV_MIX_COEFF_TYPE_FLT, yading@11: 0, 0, 1, 1, "C", MIX_FUNC_NAME(S16P, FLT)); yading@11: yading@11: ff_audio_mix_set_func(am, AV_SAMPLE_FMT_S16P, AV_MIX_COEFF_TYPE_Q15, yading@11: 0, 0, 1, 1, "C", MIX_FUNC_NAME(S16P, Q15)); yading@11: yading@11: ff_audio_mix_set_func(am, AV_SAMPLE_FMT_S16P, AV_MIX_COEFF_TYPE_Q8, yading@11: 0, 0, 1, 1, "C", MIX_FUNC_NAME(S16P, Q8)); yading@11: yading@11: /* channel-specific C versions */ yading@11: yading@11: ff_audio_mix_set_func(am, AV_SAMPLE_FMT_FLTP, AV_MIX_COEFF_TYPE_FLT, yading@11: 2, 1, 1, 1, "C", mix_2_to_1_fltp_flt_c); yading@11: yading@11: ff_audio_mix_set_func(am, AV_SAMPLE_FMT_S16P, AV_MIX_COEFF_TYPE_FLT, yading@11: 2, 1, 1, 1, "C", mix_2_to_1_s16p_flt_c); yading@11: yading@11: ff_audio_mix_set_func(am, AV_SAMPLE_FMT_S16P, AV_MIX_COEFF_TYPE_Q8, yading@11: 2, 1, 1, 1, "C", mix_2_to_1_s16p_q8_c); yading@11: yading@11: ff_audio_mix_set_func(am, AV_SAMPLE_FMT_FLTP, AV_MIX_COEFF_TYPE_FLT, yading@11: 1, 2, 1, 1, "C", mix_1_to_2_fltp_flt_c); yading@11: yading@11: ff_audio_mix_set_func(am, AV_SAMPLE_FMT_FLTP, AV_MIX_COEFF_TYPE_FLT, yading@11: 6, 2, 1, 1, "C", mix_6_to_2_fltp_flt_c); yading@11: yading@11: ff_audio_mix_set_func(am, AV_SAMPLE_FMT_FLTP, AV_MIX_COEFF_TYPE_FLT, yading@11: 2, 6, 1, 1, "C", mix_2_to_6_fltp_flt_c); yading@11: yading@11: if (ARCH_X86) yading@11: ff_audio_mix_init_x86(am); yading@11: yading@11: if (!am->mix) { yading@11: av_log(am->avr, AV_LOG_ERROR, "audio_mix: NO FUNCTION FOUND: [fmt=%s] " yading@11: "[c=%s] [%d to %d]\n", av_get_sample_fmt_name(am->fmt), yading@11: coeff_type_names[am->coeff_type], am->in_channels, yading@11: am->out_channels); yading@11: return AVERROR_PATCHWELCOME; yading@11: } yading@11: return 0; yading@11: } yading@11: yading@11: AudioMix *ff_audio_mix_alloc(AVAudioResampleContext *avr) yading@11: { yading@11: AudioMix *am; yading@11: int ret; yading@11: yading@11: am = av_mallocz(sizeof(*am)); yading@11: if (!am) yading@11: return NULL; yading@11: am->avr = avr; yading@11: yading@11: if (avr->internal_sample_fmt != AV_SAMPLE_FMT_S16P && yading@11: avr->internal_sample_fmt != AV_SAMPLE_FMT_FLTP) { yading@11: av_log(avr, AV_LOG_ERROR, "Unsupported internal format for " yading@11: "mixing: %s\n", yading@11: av_get_sample_fmt_name(avr->internal_sample_fmt)); yading@11: goto error; yading@11: } yading@11: yading@11: am->fmt = avr->internal_sample_fmt; yading@11: am->coeff_type = avr->mix_coeff_type; yading@11: am->in_layout = avr->in_channel_layout; yading@11: am->out_layout = avr->out_channel_layout; yading@11: am->in_channels = avr->in_channels; yading@11: am->out_channels = avr->out_channels; yading@11: yading@11: /* build matrix if the user did not already set one */ yading@11: if (avr->mix_matrix) { yading@11: ret = ff_audio_mix_set_matrix(am, avr->mix_matrix, avr->in_channels); yading@11: if (ret < 0) yading@11: goto error; yading@11: av_freep(&avr->mix_matrix); yading@11: } else { yading@11: double *matrix_dbl = av_mallocz(avr->out_channels * avr->in_channels * yading@11: sizeof(*matrix_dbl)); yading@11: if (!matrix_dbl) yading@11: goto error; yading@11: yading@11: ret = avresample_build_matrix(avr->in_channel_layout, yading@11: avr->out_channel_layout, yading@11: avr->center_mix_level, yading@11: avr->surround_mix_level, yading@11: avr->lfe_mix_level, yading@11: avr->normalize_mix_level, yading@11: matrix_dbl, yading@11: avr->in_channels, yading@11: avr->matrix_encoding); yading@11: if (ret < 0) { yading@11: av_free(matrix_dbl); yading@11: goto error; yading@11: } yading@11: yading@11: ret = ff_audio_mix_set_matrix(am, matrix_dbl, avr->in_channels); yading@11: if (ret < 0) { yading@11: av_log(avr, AV_LOG_ERROR, "error setting mix matrix\n"); yading@11: av_free(matrix_dbl); yading@11: goto error; yading@11: } yading@11: yading@11: av_free(matrix_dbl); yading@11: } yading@11: yading@11: return am; yading@11: yading@11: error: yading@11: av_free(am); yading@11: return NULL; yading@11: } yading@11: yading@11: void ff_audio_mix_free(AudioMix **am_p) yading@11: { yading@11: AudioMix *am; yading@11: yading@11: if (!*am_p) yading@11: return; yading@11: am = *am_p; yading@11: yading@11: if (am->matrix) { yading@11: av_free(am->matrix[0]); yading@11: am->matrix = NULL; yading@11: } yading@11: memset(am->matrix_q8, 0, sizeof(am->matrix_q8 )); yading@11: memset(am->matrix_q15, 0, sizeof(am->matrix_q15)); yading@11: memset(am->matrix_flt, 0, sizeof(am->matrix_flt)); yading@11: yading@11: av_freep(am_p); yading@11: } yading@11: yading@11: int ff_audio_mix(AudioMix *am, AudioData *src) yading@11: { yading@11: int use_generic = 1; yading@11: int len = src->nb_samples; yading@11: int i, j; yading@11: yading@11: /* determine whether to use the optimized function based on pointer and yading@11: samples alignment in both the input and output */ yading@11: if (am->has_optimized_func) { yading@11: int aligned_len = FFALIGN(len, am->samples_align); yading@11: if (!(src->ptr_align % am->ptr_align) && yading@11: src->samples_align >= aligned_len) { yading@11: len = aligned_len; yading@11: use_generic = 0; yading@11: } yading@11: } yading@11: av_dlog(am->avr, "audio_mix: %d samples - %d to %d channels (%s)\n", yading@11: src->nb_samples, am->in_channels, am->out_channels, yading@11: use_generic ? am->func_descr_generic : am->func_descr); yading@11: yading@11: if (am->in_matrix_channels && am->out_matrix_channels) { yading@11: uint8_t **data; yading@11: uint8_t *data0[AVRESAMPLE_MAX_CHANNELS]; yading@11: yading@11: if (am->out_matrix_channels < am->out_channels || yading@11: am->in_matrix_channels < am->in_channels) { yading@11: for (i = 0, j = 0; i < FFMAX(am->in_channels, am->out_channels); i++) { yading@11: if (am->input_skip[i] || am->output_skip[i] || am->output_zero[i]) yading@11: continue; yading@11: data0[j++] = src->data[i]; yading@11: } yading@11: data = data0; yading@11: } else { yading@11: data = src->data; yading@11: } yading@11: yading@11: if (use_generic) yading@11: am->mix_generic(data, am->matrix, len, am->out_matrix_channels, yading@11: am->in_matrix_channels); yading@11: else yading@11: am->mix(data, am->matrix, len, am->out_matrix_channels, yading@11: am->in_matrix_channels); yading@11: } yading@11: yading@11: if (am->out_matrix_channels < am->out_channels) { yading@11: for (i = 0; i < am->out_channels; i++) yading@11: if (am->output_zero[i]) yading@11: av_samples_set_silence(&src->data[i], 0, len, 1, am->fmt); yading@11: } yading@11: yading@11: ff_audio_data_set_channels(src, am->out_channels); yading@11: yading@11: return 0; yading@11: } yading@11: yading@11: int ff_audio_mix_get_matrix(AudioMix *am, double *matrix, int stride) yading@11: { yading@11: int i, o, i0, o0; yading@11: yading@11: if ( am->in_channels <= 0 || am->in_channels > AVRESAMPLE_MAX_CHANNELS || yading@11: am->out_channels <= 0 || am->out_channels > AVRESAMPLE_MAX_CHANNELS) { yading@11: av_log(am->avr, AV_LOG_ERROR, "Invalid channel counts\n"); yading@11: return AVERROR(EINVAL); yading@11: } yading@11: yading@11: #define GET_MATRIX_CONVERT(suffix, scale) \ yading@11: if (!am->matrix_ ## suffix[0]) { \ yading@11: av_log(am->avr, AV_LOG_ERROR, "matrix is not set\n"); \ yading@11: return AVERROR(EINVAL); \ yading@11: } \ yading@11: for (o = 0, o0 = 0; o < am->out_channels; o++) { \ yading@11: for (i = 0, i0 = 0; i < am->in_channels; i++) { \ yading@11: if (am->input_skip[i] || am->output_zero[o]) \ yading@11: matrix[o * stride + i] = 0.0; \ yading@11: else \ yading@11: matrix[o * stride + i] = am->matrix_ ## suffix[o0][i0] * \ yading@11: (scale); \ yading@11: if (!am->input_skip[i]) \ yading@11: i0++; \ yading@11: } \ yading@11: if (!am->output_zero[o]) \ yading@11: o0++; \ yading@11: } yading@11: yading@11: switch (am->coeff_type) { yading@11: case AV_MIX_COEFF_TYPE_Q8: yading@11: GET_MATRIX_CONVERT(q8, 1.0 / 256.0); yading@11: break; yading@11: case AV_MIX_COEFF_TYPE_Q15: yading@11: GET_MATRIX_CONVERT(q15, 1.0 / 32768.0); yading@11: break; yading@11: case AV_MIX_COEFF_TYPE_FLT: yading@11: GET_MATRIX_CONVERT(flt, 1.0); yading@11: break; yading@11: default: yading@11: av_log(am->avr, AV_LOG_ERROR, "Invalid mix coeff type\n"); yading@11: return AVERROR(EINVAL); yading@11: } yading@11: yading@11: return 0; yading@11: } yading@11: yading@11: static void reduce_matrix(AudioMix *am, const double *matrix, int stride) yading@11: { yading@11: int i, o; yading@11: yading@11: memset(am->output_zero, 0, sizeof(am->output_zero)); yading@11: memset(am->input_skip, 0, sizeof(am->input_skip)); yading@11: memset(am->output_skip, 0, sizeof(am->output_skip)); yading@11: yading@11: /* exclude output channels if they can be zeroed instead of mixed */ yading@11: for (o = 0; o < am->out_channels; o++) { yading@11: int zero = 1; yading@11: yading@11: /* check if the output is always silent */ yading@11: for (i = 0; i < am->in_channels; i++) { yading@11: if (matrix[o * stride + i] != 0.0) { yading@11: zero = 0; yading@11: break; yading@11: } yading@11: } yading@11: /* check if the corresponding input channel makes a contribution to yading@11: any output channel */ yading@11: if (o < am->in_channels) { yading@11: for (i = 0; i < am->out_channels; i++) { yading@11: if (matrix[i * stride + o] != 0.0) { yading@11: zero = 0; yading@11: break; yading@11: } yading@11: } yading@11: } yading@11: if (zero) { yading@11: am->output_zero[o] = 1; yading@11: am->out_matrix_channels--; yading@11: } yading@11: } yading@11: if (am->out_matrix_channels == 0) { yading@11: am->in_matrix_channels = 0; yading@11: return; yading@11: } yading@11: yading@11: /* skip input channels that contribute fully only to the corresponding yading@11: output channel */ yading@11: for (i = 0; i < FFMIN(am->in_channels, am->out_channels); i++) { yading@11: int skip = 1; yading@11: yading@11: for (o = 0; o < am->out_channels; o++) { yading@11: int i0; yading@11: if ((o != i && matrix[o * stride + i] != 0.0) || yading@11: (o == i && matrix[o * stride + i] != 1.0)) { yading@11: skip = 0; yading@11: break; yading@11: } yading@11: /* if the input contributes fully to the output, also check that no yading@11: other inputs contribute to this output */ yading@11: if (o == i) { yading@11: for (i0 = 0; i0 < am->in_channels; i0++) { yading@11: if (i0 != i && matrix[o * stride + i0] != 0.0) { yading@11: skip = 0; yading@11: break; yading@11: } yading@11: } yading@11: } yading@11: } yading@11: if (skip) { yading@11: am->input_skip[i] = 1; yading@11: am->in_matrix_channels--; yading@11: } yading@11: } yading@11: /* skip input channels that do not contribute to any output channel */ yading@11: for (; i < am->in_channels; i++) { yading@11: int contrib = 0; yading@11: yading@11: for (o = 0; o < am->out_channels; o++) { yading@11: if (matrix[o * stride + i] != 0.0) { yading@11: contrib = 1; yading@11: break; yading@11: } yading@11: } yading@11: if (!contrib) { yading@11: am->input_skip[i] = 1; yading@11: am->in_matrix_channels--; yading@11: } yading@11: } yading@11: if (am->in_matrix_channels == 0) { yading@11: am->out_matrix_channels = 0; yading@11: return; yading@11: } yading@11: yading@11: /* skip output channels that only get full contribution from the yading@11: corresponding input channel */ yading@11: for (o = 0; o < FFMIN(am->in_channels, am->out_channels); o++) { yading@11: int skip = 1; yading@11: int o0; yading@11: yading@11: for (i = 0; i < am->in_channels; i++) { yading@11: if ((o != i && matrix[o * stride + i] != 0.0) || yading@11: (o == i && matrix[o * stride + i] != 1.0)) { yading@11: skip = 0; yading@11: break; yading@11: } yading@11: } yading@11: /* check if the corresponding input channel makes a contribution to yading@11: any other output channel */ yading@11: i = o; yading@11: for (o0 = 0; o0 < am->out_channels; o0++) { yading@11: if (o0 != i && matrix[o0 * stride + i] != 0.0) { yading@11: skip = 0; yading@11: break; yading@11: } yading@11: } yading@11: if (skip) { yading@11: am->output_skip[o] = 1; yading@11: am->out_matrix_channels--; yading@11: } yading@11: } yading@11: if (am->out_matrix_channels == 0) { yading@11: am->in_matrix_channels = 0; yading@11: return; yading@11: } yading@11: } yading@11: yading@11: int ff_audio_mix_set_matrix(AudioMix *am, const double *matrix, int stride) yading@11: { yading@11: int i, o, i0, o0, ret; yading@11: char in_layout_name[128]; yading@11: char out_layout_name[128]; yading@11: yading@11: if ( am->in_channels <= 0 || am->in_channels > AVRESAMPLE_MAX_CHANNELS || yading@11: am->out_channels <= 0 || am->out_channels > AVRESAMPLE_MAX_CHANNELS) { yading@11: av_log(am->avr, AV_LOG_ERROR, "Invalid channel counts\n"); yading@11: return AVERROR(EINVAL); yading@11: } yading@11: yading@11: if (am->matrix) { yading@11: av_free(am->matrix[0]); yading@11: am->matrix = NULL; yading@11: } yading@11: yading@11: am->in_matrix_channels = am->in_channels; yading@11: am->out_matrix_channels = am->out_channels; yading@11: yading@11: reduce_matrix(am, matrix, stride); yading@11: yading@11: #define CONVERT_MATRIX(type, expr) \ yading@11: am->matrix_## type[0] = av_mallocz(am->out_matrix_channels * \ yading@11: am->in_matrix_channels * \ yading@11: sizeof(*am->matrix_## type[0])); \ yading@11: if (!am->matrix_## type[0]) \ yading@11: return AVERROR(ENOMEM); \ yading@11: for (o = 0, o0 = 0; o < am->out_channels; o++) { \ yading@11: if (am->output_zero[o] || am->output_skip[o]) \ yading@11: continue; \ yading@11: if (o0 > 0) \ yading@11: am->matrix_## type[o0] = am->matrix_## type[o0 - 1] + \ yading@11: am->in_matrix_channels; \ yading@11: for (i = 0, i0 = 0; i < am->in_channels; i++) { \ yading@11: double v; \ yading@11: if (am->input_skip[i]) \ yading@11: continue; \ yading@11: v = matrix[o * stride + i]; \ yading@11: am->matrix_## type[o0][i0] = expr; \ yading@11: i0++; \ yading@11: } \ yading@11: o0++; \ yading@11: } \ yading@11: am->matrix = (void **)am->matrix_## type; yading@11: yading@11: if (am->in_matrix_channels && am->out_matrix_channels) { yading@11: switch (am->coeff_type) { yading@11: case AV_MIX_COEFF_TYPE_Q8: yading@11: CONVERT_MATRIX(q8, av_clip_int16(lrint(256.0 * v))) yading@11: break; yading@11: case AV_MIX_COEFF_TYPE_Q15: yading@11: CONVERT_MATRIX(q15, av_clipl_int32(llrint(32768.0 * v))) yading@11: break; yading@11: case AV_MIX_COEFF_TYPE_FLT: yading@11: CONVERT_MATRIX(flt, v) yading@11: break; yading@11: default: yading@11: av_log(am->avr, AV_LOG_ERROR, "Invalid mix coeff type\n"); yading@11: return AVERROR(EINVAL); yading@11: } yading@11: } yading@11: yading@11: ret = mix_function_init(am); yading@11: if (ret < 0) yading@11: return ret; yading@11: yading@11: av_get_channel_layout_string(in_layout_name, sizeof(in_layout_name), yading@11: am->in_channels, am->in_layout); yading@11: av_get_channel_layout_string(out_layout_name, sizeof(out_layout_name), yading@11: am->out_channels, am->out_layout); yading@11: av_log(am->avr, AV_LOG_DEBUG, "audio_mix: %s to %s\n", yading@11: in_layout_name, out_layout_name); yading@11: av_log(am->avr, AV_LOG_DEBUG, "matrix size: %d x %d\n", yading@11: am->in_matrix_channels, am->out_matrix_channels); yading@11: for (o = 0; o < am->out_channels; o++) { yading@11: for (i = 0; i < am->in_channels; i++) { yading@11: if (am->output_zero[o]) yading@11: av_log(am->avr, AV_LOG_DEBUG, " (ZERO)"); yading@11: else if (am->input_skip[i] || am->output_skip[o]) yading@11: av_log(am->avr, AV_LOG_DEBUG, " (SKIP)"); yading@11: else yading@11: av_log(am->avr, AV_LOG_DEBUG, " %0.3f ", yading@11: matrix[o * am->in_channels + i]); yading@11: } yading@11: av_log(am->avr, AV_LOG_DEBUG, "\n"); yading@11: } yading@11: yading@11: return 0; yading@11: }