2010-09-06 15:51:20 +05:30
|
|
|
/***
|
|
|
|
|
This file is part of PulseAudio.
|
|
|
|
|
|
|
|
|
|
Copyright 2010 Wim Taymans <wim.taymans@gmail.com>
|
|
|
|
|
|
|
|
|
|
Contributor: Arun Raghavan <arun.raghavan@collabora.co.uk>
|
|
|
|
|
|
|
|
|
|
PulseAudio is free software; you can redistribute it and/or modify
|
|
|
|
|
it under the terms of the GNU Lesser General Public License as published
|
|
|
|
|
by the Free Software Foundation; either version 2.1 of the License,
|
|
|
|
|
or (at your option) any later version.
|
|
|
|
|
|
|
|
|
|
PulseAudio 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
|
|
|
|
|
General Public License for more details.
|
|
|
|
|
|
|
|
|
|
You should have received a copy of the GNU Lesser General Public License
|
|
|
|
|
along with PulseAudio; if not, write to the Free Software
|
|
|
|
|
Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
|
|
|
|
|
USA.
|
|
|
|
|
***/
|
|
|
|
|
|
2010-09-06 21:24:55 +05:30
|
|
|
#ifdef HAVE_CONFIG_H
|
|
|
|
|
#include <config.h>
|
|
|
|
|
#endif
|
|
|
|
|
|
2011-08-25 17:47:05 +05:30
|
|
|
#include <pulsecore/core-util.h>
|
2010-09-06 21:24:55 +05:30
|
|
|
#include <pulsecore/modargs.h>
|
2010-09-06 15:51:20 +05:30
|
|
|
#include "echo-cancel.h"
|
|
|
|
|
|
2010-09-06 21:24:55 +05:30
|
|
|
/* should be between 10-20 ms */
|
|
|
|
|
#define DEFAULT_FRAME_SIZE_MS 20
|
|
|
|
|
/* should be between 100-500 ms */
|
|
|
|
|
#define DEFAULT_FILTER_SIZE_MS 200
|
2011-08-25 17:47:05 +05:30
|
|
|
#define DEFAULT_AGC_ENABLED TRUE
|
|
|
|
|
#define DEFAULT_DENOISE_ENABLED TRUE
|
|
|
|
|
#define DEFAULT_ECHO_SUPPRESS_ENABLED TRUE
|
|
|
|
|
#define DEFAULT_ECHO_SUPPRESS_ATTENUATION 0
|
2010-09-06 21:24:55 +05:30
|
|
|
|
|
|
|
|
static const char* const valid_modargs[] = {
|
|
|
|
|
"frame_size_ms",
|
|
|
|
|
"filter_size_ms",
|
2011-08-25 17:47:05 +05:30
|
|
|
"agc",
|
|
|
|
|
"denoise",
|
|
|
|
|
"echo_suppress",
|
|
|
|
|
"echo_suppress_attenuation",
|
|
|
|
|
"echo_suppress_attenuation_active",
|
2010-09-06 21:24:55 +05:30
|
|
|
NULL
|
|
|
|
|
};
|
|
|
|
|
|
2010-09-06 22:23:51 +05:30
|
|
|
static void pa_speex_ec_fixate_spec(pa_sample_spec *source_ss, pa_channel_map *source_map,
|
2011-03-02 12:41:26 +01:00
|
|
|
pa_sample_spec *sink_ss, pa_channel_map *sink_map)
|
2010-09-06 15:51:20 +05:30
|
|
|
{
|
2010-09-23 17:46:00 +05:30
|
|
|
source_ss->format = PA_SAMPLE_S16NE;
|
2010-09-06 22:23:51 +05:30
|
|
|
|
|
|
|
|
*sink_ss = *source_ss;
|
|
|
|
|
*sink_map = *source_map;
|
|
|
|
|
}
|
|
|
|
|
|
2011-08-25 17:47:05 +05:30
|
|
|
static pa_bool_t pa_speex_ec_preprocessor_init(pa_echo_canceller *ec, pa_sample_spec *source_ss, uint32_t blocksize, pa_modargs *ma) {
|
|
|
|
|
pa_bool_t agc;
|
|
|
|
|
pa_bool_t denoise;
|
|
|
|
|
pa_bool_t echo_suppress;
|
|
|
|
|
int32_t echo_suppress_attenuation;
|
|
|
|
|
int32_t echo_suppress_attenuation_active;
|
|
|
|
|
|
|
|
|
|
agc = DEFAULT_AGC_ENABLED;
|
|
|
|
|
if (pa_modargs_get_value_boolean(ma, "agc", &agc) < 0) {
|
|
|
|
|
pa_log("Failed to parse agc value");
|
|
|
|
|
goto fail;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
denoise = DEFAULT_DENOISE_ENABLED;
|
|
|
|
|
if (pa_modargs_get_value_boolean(ma, "denoise", &denoise) < 0) {
|
|
|
|
|
pa_log("Failed to parse denoise value");
|
|
|
|
|
goto fail;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
echo_suppress = DEFAULT_ECHO_SUPPRESS_ENABLED;
|
|
|
|
|
if (pa_modargs_get_value_boolean(ma, "echo_suppress", &echo_suppress) < 0) {
|
|
|
|
|
pa_log("Failed to parse echo_suppress value");
|
|
|
|
|
goto fail;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
echo_suppress_attenuation = DEFAULT_ECHO_SUPPRESS_ATTENUATION;
|
|
|
|
|
if (pa_modargs_get_value_s32(ma, "echo_suppress_attenuation", &echo_suppress_attenuation) < 0) {
|
|
|
|
|
pa_log("Failed to parse echo_suppress_attenuation value");
|
|
|
|
|
goto fail;
|
|
|
|
|
}
|
|
|
|
|
if (echo_suppress_attenuation > 0) {
|
|
|
|
|
pa_log("echo_suppress_attenuation should be a negative dB value");
|
|
|
|
|
goto fail;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
echo_suppress_attenuation_active = DEFAULT_ECHO_SUPPRESS_ATTENUATION;
|
|
|
|
|
if (pa_modargs_get_value_s32(ma, "echo_suppress_attenuation_active", &echo_suppress_attenuation_active) < 0) {
|
|
|
|
|
pa_log("Failed to parse echo_suppress_attenuation_active value");
|
|
|
|
|
goto fail;
|
|
|
|
|
}
|
|
|
|
|
if (echo_suppress_attenuation_active > 0) {
|
|
|
|
|
pa_log("echo_suppress_attenuation_active should be a negative dB value");
|
|
|
|
|
goto fail;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (agc || denoise || echo_suppress) {
|
|
|
|
|
spx_int32_t tmp;
|
|
|
|
|
|
|
|
|
|
if (source_ss->channels != 1) {
|
|
|
|
|
pa_log("AGC, denoising and echo suppression only work with channels=1");
|
|
|
|
|
goto fail;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
ec->params.priv.speex.pp_state = speex_preprocess_state_init(blocksize / pa_frame_size(source_ss), source_ss->rate);
|
|
|
|
|
|
|
|
|
|
tmp = agc;
|
|
|
|
|
speex_preprocess_ctl(ec->params.priv.speex.pp_state, SPEEX_PREPROCESS_SET_AGC, &tmp);
|
|
|
|
|
|
|
|
|
|
tmp = denoise;
|
|
|
|
|
speex_preprocess_ctl(ec->params.priv.speex.pp_state, SPEEX_PREPROCESS_SET_DENOISE, &tmp);
|
|
|
|
|
|
|
|
|
|
if (echo_suppress) {
|
|
|
|
|
if (echo_suppress_attenuation)
|
|
|
|
|
speex_preprocess_ctl(ec->params.priv.speex.pp_state, SPEEX_PREPROCESS_SET_ECHO_SUPPRESS,
|
|
|
|
|
&echo_suppress_attenuation);
|
|
|
|
|
|
|
|
|
|
if (echo_suppress_attenuation_active) {
|
|
|
|
|
speex_preprocess_ctl(ec->params.priv.speex.pp_state, SPEEX_PREPROCESS_SET_ECHO_SUPPRESS_ACTIVE,
|
|
|
|
|
&echo_suppress_attenuation_active);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
speex_preprocess_ctl(ec->params.priv.speex.pp_state, SPEEX_PREPROCESS_SET_ECHO_STATE,
|
|
|
|
|
ec->params.priv.speex.state);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
pa_log_info("Loaded speex preprocessor with params: agc=%s, denoise=%s, echo_suppress=%s", pa_yes_no(agc),
|
|
|
|
|
pa_yes_no(denoise), pa_yes_no(echo_suppress));
|
|
|
|
|
} else
|
|
|
|
|
pa_log_info("All preprocessing options are disabled");
|
|
|
|
|
|
|
|
|
|
return TRUE;
|
|
|
|
|
|
|
|
|
|
fail:
|
|
|
|
|
return FALSE;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
2010-09-21 20:42:32 +05:30
|
|
|
pa_bool_t pa_speex_ec_init(pa_core *c, pa_echo_canceller *ec,
|
2010-09-06 22:23:51 +05:30
|
|
|
pa_sample_spec *source_ss, pa_channel_map *source_map,
|
|
|
|
|
pa_sample_spec *sink_ss, pa_channel_map *sink_map,
|
2010-09-07 14:55:38 +05:30
|
|
|
uint32_t *blocksize, const char *args)
|
2010-09-06 22:23:51 +05:30
|
|
|
{
|
|
|
|
|
int framelen, y, rate;
|
2010-09-06 21:24:55 +05:30
|
|
|
uint32_t frame_size_ms, filter_size_ms;
|
|
|
|
|
pa_modargs *ma;
|
|
|
|
|
|
|
|
|
|
if (!(ma = pa_modargs_new(args, valid_modargs))) {
|
|
|
|
|
pa_log("Failed to parse submodule arguments.");
|
|
|
|
|
goto fail;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
filter_size_ms = DEFAULT_FILTER_SIZE_MS;
|
|
|
|
|
if (pa_modargs_get_value_u32(ma, "filter_size_ms", &filter_size_ms) < 0 || filter_size_ms < 1 || filter_size_ms > 2000) {
|
|
|
|
|
pa_log("Invalid filter_size_ms specification");
|
|
|
|
|
goto fail;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
frame_size_ms = DEFAULT_FRAME_SIZE_MS;
|
|
|
|
|
if (pa_modargs_get_value_u32(ma, "frame_size_ms", &frame_size_ms) < 0 || frame_size_ms < 1 || frame_size_ms > 200) {
|
|
|
|
|
pa_log("Invalid frame_size_ms specification");
|
|
|
|
|
goto fail;
|
|
|
|
|
}
|
2010-09-06 15:51:20 +05:30
|
|
|
|
2010-09-06 22:23:51 +05:30
|
|
|
pa_speex_ec_fixate_spec(source_ss, source_map, sink_ss, sink_map);
|
|
|
|
|
|
|
|
|
|
rate = source_ss->rate;
|
2010-09-06 15:51:20 +05:30
|
|
|
framelen = (rate * frame_size_ms) / 1000;
|
|
|
|
|
/* framelen should be a power of 2, round down to nearest power of two */
|
|
|
|
|
y = 1 << ((8 * sizeof (int)) - 2);
|
|
|
|
|
while (y > framelen)
|
|
|
|
|
y >>= 1;
|
|
|
|
|
framelen = y;
|
|
|
|
|
|
2010-09-07 14:55:38 +05:30
|
|
|
*blocksize = framelen * pa_frame_size (source_ss);
|
2010-09-06 15:51:20 +05:30
|
|
|
|
2010-09-07 14:55:38 +05:30
|
|
|
pa_log_debug ("Using framelen %d, blocksize %u, channels %d, rate %d", framelen, *blocksize, source_ss->channels, source_ss->rate);
|
2010-09-06 15:51:20 +05:30
|
|
|
|
2010-09-06 22:23:51 +05:30
|
|
|
ec->params.priv.speex.state = speex_echo_state_init_mc (framelen, (rate * filter_size_ms) / 1000, source_ss->channels, source_ss->channels);
|
2010-09-06 15:51:20 +05:30
|
|
|
|
2010-09-06 21:24:55 +05:30
|
|
|
if (!ec->params.priv.speex.state)
|
2011-03-02 12:41:26 +01:00
|
|
|
goto fail;
|
2010-09-06 21:24:55 +05:30
|
|
|
|
|
|
|
|
speex_echo_ctl(ec->params.priv.speex.state, SPEEX_ECHO_SET_SAMPLING_RATE, &rate);
|
|
|
|
|
|
2011-08-25 17:47:05 +05:30
|
|
|
if (!pa_speex_ec_preprocessor_init(ec, source_ss, *blocksize, ma))
|
|
|
|
|
goto fail;
|
|
|
|
|
|
2010-09-06 21:24:55 +05:30
|
|
|
pa_modargs_free(ma);
|
|
|
|
|
return TRUE;
|
|
|
|
|
|
|
|
|
|
fail:
|
|
|
|
|
if (ma)
|
2011-03-02 12:41:26 +01:00
|
|
|
pa_modargs_free(ma);
|
2011-08-25 17:47:05 +05:30
|
|
|
if (ec->params.priv.speex.state)
|
|
|
|
|
speex_preprocess_state_destroy(ec->params.priv.speex.pp_state);
|
2010-09-06 21:24:55 +05:30
|
|
|
return FALSE;
|
2010-09-06 15:51:20 +05:30
|
|
|
}
|
|
|
|
|
|
2011-03-02 12:41:26 +01:00
|
|
|
void pa_speex_ec_run(pa_echo_canceller *ec, const uint8_t *rec, const uint8_t *play, uint8_t *out) {
|
2011-08-25 17:47:05 +05:30
|
|
|
speex_echo_cancellation(ec->params.priv.speex.state, (const spx_int16_t *) rec, (const spx_int16_t *) play,
|
|
|
|
|
(spx_int16_t *) out);
|
|
|
|
|
|
|
|
|
|
/* preprecessor is run after AEC. This is not a mistake! */
|
|
|
|
|
if (ec->params.priv.speex.pp_state)
|
|
|
|
|
speex_preprocess_run(ec->params.priv.speex.pp_state, (spx_int16_t *) out);
|
2010-09-06 15:51:20 +05:30
|
|
|
}
|
|
|
|
|
|
2011-03-02 12:41:26 +01:00
|
|
|
void pa_speex_ec_done(pa_echo_canceller *ec) {
|
2011-08-25 17:47:05 +05:30
|
|
|
if (ec->params.priv.speex.pp_state) {
|
|
|
|
|
speex_preprocess_state_destroy(ec->params.priv.speex.pp_state);
|
|
|
|
|
ec->params.priv.speex.pp_state = NULL;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (ec->params.priv.speex.state) {
|
2011-05-28 07:51:35 +05:30
|
|
|
speex_echo_state_destroy(ec->params.priv.speex.state);
|
2011-08-25 17:47:05 +05:30
|
|
|
ec->params.priv.speex.state = NULL;
|
|
|
|
|
}
|
2010-09-06 15:51:20 +05:30
|
|
|
}
|