1b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent/* 2b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent** Copyright 2011, The Android Open-Source Project 3b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent** 4b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent** Licensed under the Apache License, Version 2.0 (the "License"); 5b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent** you may not use this file except in compliance with the License. 6b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent** You may obtain a copy of the License at 7b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent** 8b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent** http://www.apache.org/licenses/LICENSE-2.0 9b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent** 10b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent** Unless required by applicable law or agreed to in writing, software 11b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent** distributed under the License is distributed on an "AS IS" BASIS, 12b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent** WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 13b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent** See the License for the specific language governing permissions and 14b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent** limitations under the License. 15b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent*/ 16b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 17b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent//#define LOG_NDEBUG 0 18b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent#define LOG_TAG "echo_reference" 19b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 20b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent#include <errno.h> 2125e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn#include <inttypes.h> 22b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent#include <pthread.h> 2325e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn#include <stdlib.h> 2425e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn 2525e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn#include <log/log.h> 26b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent#include <system/audio.h> 27b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent#include <audio_utils/resampler.h> 28b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent#include <audio_utils/echo_reference.h> 29b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 30b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent// echo reference state: bit field indicating if read, write or both are active. 31b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurentenum state { 32b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent ECHOREF_IDLE = 0x00, // idle 33b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent ECHOREF_READING = 0x01, // reading is active 34b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent ECHOREF_WRITING = 0x02 // writing is active 35b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent}; 36b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 37b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurentstruct echo_reference { 38b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent struct echo_reference_itfe itfe; 39b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent int status; // init status 40b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent uint32_t state; // active state: reading, writing or both 41b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent audio_format_t rd_format; // read sample format 42b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent uint32_t rd_channel_count; // read number of channels 43b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent uint32_t rd_sampling_rate; // read sampling rate in Hz 44b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent size_t rd_frame_size; // read frame size (bytes per sample) 45b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent audio_format_t wr_format; // write sample format 46b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent uint32_t wr_channel_count; // write number of channels 47b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent uint32_t wr_sampling_rate; // write sampling rate in Hz 48b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent size_t wr_frame_size; // write frame size (bytes per sample) 49b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent void *buffer; // main buffer 50b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent size_t buf_size; // main buffer size in frames 51b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent size_t frames_in; // number of frames in main buffer 52b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent void *wr_buf; // buffer for input conversions 53b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent size_t wr_buf_size; // size of conversion buffer in frames 54b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent size_t wr_frames_in; // number of frames in conversion buffer 55f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent size_t wr_curr_frame_size; // number of frames given to current write() function 56b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent void *wr_src_buf; // resampler input buf (either wr_buf or buffer used by write()) 57b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent struct timespec wr_render_time; // latest render time indicated by write() 58b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent // default ALSA gettimeofday() format 59b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent int32_t playback_delay; // playback buffer delay indicated by last write() 60f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent int16_t prev_delta_sign; // sign of previous delay difference: 61f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent // 1: positive, -1: negative, 0: unknown 62f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent uint16_t delta_count; // number of consecutive delay differences with same sign 63b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent pthread_mutex_t lock; // mutex protecting read/write concurrency 64b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent pthread_cond_t cond; // condition signaled when data is ready to read 6533e8f78bb282cbb7b1c55ce0c9d412458989bc9eEric Laurent struct resampler_itfe *resampler; // input resampler 66b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent struct resampler_buffer_provider provider; // resampler buffer provider 67b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent}; 68b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 69b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 70b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurentint echo_reference_get_next_buffer(struct resampler_buffer_provider *buffer_provider, 71b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent struct resampler_buffer* buffer) 72b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent{ 73b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent struct echo_reference *er; 74b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 75b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if (buffer_provider == NULL) { 76b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent return -EINVAL; 77b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 78b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 79c9d5dff9789312449c936913a577fa799565bf1fEric Laurent er = (struct echo_reference *)((char *)buffer_provider - 80c9d5dff9789312449c936913a577fa799565bf1fEric Laurent offsetof(struct echo_reference, provider)); 81b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 82b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if (er->wr_src_buf == NULL || er->wr_frames_in == 0) { 83b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent buffer->raw = NULL; 84b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent buffer->frame_count = 0; 85b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent return -ENODATA; 86b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 87b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 88548d9cf23e9d7f3ae1aa78a521c29e1ec4c910a8Glenn Kasten buffer->frame_count = (buffer->frame_count > er->wr_frames_in) ? 89548d9cf23e9d7f3ae1aa78a521c29e1ec4c910a8Glenn Kasten er->wr_frames_in : buffer->frame_count; 90b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent // this is er->rd_channel_count here as we resample after stereo to mono conversion if any 91548d9cf23e9d7f3ae1aa78a521c29e1ec4c910a8Glenn Kasten buffer->i16 = (int16_t *)er->wr_src_buf + (er->wr_curr_frame_size - er->wr_frames_in) * 92548d9cf23e9d7f3ae1aa78a521c29e1ec4c910a8Glenn Kasten er->rd_channel_count; 93b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 94b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent return 0; 95b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent} 96b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 97b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurentvoid echo_reference_release_buffer(struct resampler_buffer_provider *buffer_provider, 98b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent struct resampler_buffer* buffer) 99b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent{ 100b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent struct echo_reference *er; 101b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 102b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if (buffer_provider == NULL) { 103b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent return; 104b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 105b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 106c9d5dff9789312449c936913a577fa799565bf1fEric Laurent er = (struct echo_reference *)((char *)buffer_provider - 107c9d5dff9789312449c936913a577fa799565bf1fEric Laurent offsetof(struct echo_reference, provider)); 108b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 109b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->wr_frames_in -= buffer->frame_count; 110b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent} 111b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 112b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurentstatic void echo_reference_reset_l(struct echo_reference *er) 113b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent{ 114473d4a5c5c66fd8a2e99791d61fa16076558ab54Steve Block ALOGV("echo_reference_reset_l()"); 115b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent free(er->buffer); 116b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->buffer = NULL; 117b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->buf_size = 0; 118b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->frames_in = 0; 119b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent free(er->wr_buf); 120b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->wr_buf = NULL; 121b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->wr_buf_size = 0; 122b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->wr_render_time.tv_sec = 0; 123b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->wr_render_time.tv_nsec = 0; 124f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent er->delta_count = 0; 125f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent er->prev_delta_sign = 0; 126b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent} 127b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 12833e8f78bb282cbb7b1c55ce0c9d412458989bc9eEric Laurent/* additional space in resampler buffer allowing for extra samples to be returned 12933e8f78bb282cbb7b1c55ce0c9d412458989bc9eEric Laurent * by speex resampler when sample rates ratio is not an integer. 13033e8f78bb282cbb7b1c55ce0c9d412458989bc9eEric Laurent */ 13133e8f78bb282cbb7b1c55ce0c9d412458989bc9eEric Laurent#define RESAMPLER_HEADROOM_SAMPLES 10 13233e8f78bb282cbb7b1c55ce0c9d412458989bc9eEric Laurent 133b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurentstatic int echo_reference_write(struct echo_reference_itfe *echo_reference, 134b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent struct echo_reference_buffer *buffer) 135b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent{ 136b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent struct echo_reference *er = (struct echo_reference *)echo_reference; 137b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent int status = 0; 138b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 139b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if (er == NULL) { 140b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent return -EINVAL; 141b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 142b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 143b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent pthread_mutex_lock(&er->lock); 144b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 145b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if (buffer == NULL) { 146473d4a5c5c66fd8a2e99791d61fa16076558ab54Steve Block ALOGV("echo_reference_write() stop write"); 147b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->state &= ~ECHOREF_WRITING; 148b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent echo_reference_reset_l(er); 149b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent goto exit; 150b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 151b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 15225e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn ALOGV("echo_reference_write() START trying to write %zu frames", buffer->frame_count); 15325e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn ALOGV("echo_reference_write() playbackTimestamp:[%d].[%d], er->playback_delay:[%" PRId32 "]", 154b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent (int)buffer->time_stamp.tv_sec, 155b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent (int)buffer->time_stamp.tv_nsec, er->playback_delay); 156b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 157473d4a5c5c66fd8a2e99791d61fa16076558ab54Steve Block //ALOGV("echo_reference_write() %d frames", buffer->frame_count); 158b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent // discard writes until a valid time stamp is provided. 159b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 160b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if ((buffer->time_stamp.tv_sec == 0) && (buffer->time_stamp.tv_nsec == 0) && 161b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent (er->wr_render_time.tv_sec == 0) && (er->wr_render_time.tv_nsec == 0)) { 162b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent goto exit; 163b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 164b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 165b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if ((er->state & ECHOREF_WRITING) == 0) { 166473d4a5c5c66fd8a2e99791d61fa16076558ab54Steve Block ALOGV("echo_reference_write() start write"); 16733e8f78bb282cbb7b1c55ce0c9d412458989bc9eEric Laurent if (er->resampler != NULL) { 16833e8f78bb282cbb7b1c55ce0c9d412458989bc9eEric Laurent er->resampler->reset(er->resampler); 169b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 170b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->state |= ECHOREF_WRITING; 171b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 172b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 173b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if ((er->state & ECHOREF_READING) == 0) { 174b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent goto exit; 175b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 176b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 177b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->wr_render_time.tv_sec = buffer->time_stamp.tv_sec; 178b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->wr_render_time.tv_nsec = buffer->time_stamp.tv_nsec; 179b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 180b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->playback_delay = buffer->delay_ns; 181b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 182f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent // this will be used in the get_next_buffer, to support variable input buffer sizes 183f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent er->wr_curr_frame_size = buffer->frame_count; 184f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent 185b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent void *srcBuf; 186b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent size_t inFrames; 187b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent // do stereo to mono and down sampling if necessary 188b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if (er->rd_channel_count != er->wr_channel_count || 189b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->rd_sampling_rate != er->wr_sampling_rate) { 190c164cb8a9ee435c00d1a7daeaf5e6836d772eb40Eric Laurent size_t wrBufSize = buffer->frame_count; 19133e8f78bb282cbb7b1c55ce0c9d412458989bc9eEric Laurent 192c164cb8a9ee435c00d1a7daeaf5e6836d772eb40Eric Laurent inFrames = buffer->frame_count; 193c164cb8a9ee435c00d1a7daeaf5e6836d772eb40Eric Laurent 194c164cb8a9ee435c00d1a7daeaf5e6836d772eb40Eric Laurent if (er->rd_sampling_rate != er->wr_sampling_rate) { 195c164cb8a9ee435c00d1a7daeaf5e6836d772eb40Eric Laurent inFrames = (buffer->frame_count * er->rd_sampling_rate) / er->wr_sampling_rate + 196c164cb8a9ee435c00d1a7daeaf5e6836d772eb40Eric Laurent RESAMPLER_HEADROOM_SAMPLES; 197c164cb8a9ee435c00d1a7daeaf5e6836d772eb40Eric Laurent // wr_buf is not only used as resampler output but also for stereo to mono conversion 198c164cb8a9ee435c00d1a7daeaf5e6836d772eb40Eric Laurent // output so buffer size is driven by both write and read sample rates 199c164cb8a9ee435c00d1a7daeaf5e6836d772eb40Eric Laurent if (inFrames > wrBufSize) { 200c164cb8a9ee435c00d1a7daeaf5e6836d772eb40Eric Laurent wrBufSize = inFrames; 201c164cb8a9ee435c00d1a7daeaf5e6836d772eb40Eric Laurent } 202c164cb8a9ee435c00d1a7daeaf5e6836d772eb40Eric Laurent } 203c164cb8a9ee435c00d1a7daeaf5e6836d772eb40Eric Laurent 204c164cb8a9ee435c00d1a7daeaf5e6836d772eb40Eric Laurent if (er->wr_buf_size < wrBufSize) { 20525e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn ALOGV("echo_reference_write() increasing write buffer size from %zu to %zu", 206c164cb8a9ee435c00d1a7daeaf5e6836d772eb40Eric Laurent er->wr_buf_size, wrBufSize); 207c164cb8a9ee435c00d1a7daeaf5e6836d772eb40Eric Laurent er->wr_buf_size = wrBufSize; 208b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->wr_buf = realloc(er->wr_buf, er->wr_buf_size * er->rd_frame_size); 209b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 210b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 211b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if (er->rd_channel_count != er->wr_channel_count) { 212b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent // must be stereo to mono 213b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent int16_t *src16 = (int16_t *)buffer->raw; 214b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent int16_t *dst16 = (int16_t *)er->wr_buf; 215b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent size_t frames = buffer->frame_count; 216b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent while (frames--) { 217b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent *dst16++ = (int16_t)(((int32_t)*src16 + (int32_t)*(src16 + 1)) >> 1); 218b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent src16 += 2; 219b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 220b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 221b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if (er->wr_sampling_rate != er->rd_sampling_rate) { 22233e8f78bb282cbb7b1c55ce0c9d412458989bc9eEric Laurent if (er->resampler == NULL) { 223b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent int rc; 224473d4a5c5c66fd8a2e99791d61fa16076558ab54Steve Block ALOGV("echo_reference_write() new ReSampler(%d, %d)", 225b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->wr_sampling_rate, er->rd_sampling_rate); 226b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->provider.get_next_buffer = echo_reference_get_next_buffer; 227b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->provider.release_buffer = echo_reference_release_buffer; 228b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent rc = create_resampler(er->wr_sampling_rate, 229b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->rd_sampling_rate, 230b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->rd_channel_count, 231f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent RESAMPLER_QUALITY_DEFAULT, 232b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent &er->provider, 23333e8f78bb282cbb7b1c55ce0c9d412458989bc9eEric Laurent &er->resampler); 234b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if (rc != 0) { 23533e8f78bb282cbb7b1c55ce0c9d412458989bc9eEric Laurent er->resampler = NULL; 236473d4a5c5c66fd8a2e99791d61fa16076558ab54Steve Block ALOGV("echo_reference_write() failure to create resampler %d", rc); 237b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent status = -ENODEV; 238b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent goto exit; 239b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 240b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 241548d9cf23e9d7f3ae1aa78a521c29e1ec4c910a8Glenn Kasten // er->wr_src_buf and er->wr_frames_in are used by getNexBuffer() called by the 242548d9cf23e9d7f3ae1aa78a521c29e1ec4c910a8Glenn Kasten // resampler to get new frames 243b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if (er->rd_channel_count != er->wr_channel_count) { 244b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->wr_src_buf = er->wr_buf; 245b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } else { 246b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->wr_src_buf = buffer->raw; 247b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 248b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->wr_frames_in = buffer->frame_count; 249b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent // inFrames is always more than we need here to get frames remaining from previous runs 250b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent // inFrames is updated by resample() with the number of frames produced 251473d4a5c5c66fd8a2e99791d61fa16076558ab54Steve Block ALOGV("echo_reference_write() ReSampling(%d, %d)", 252b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->wr_sampling_rate, er->rd_sampling_rate); 25333e8f78bb282cbb7b1c55ce0c9d412458989bc9eEric Laurent er->resampler->resample_from_provider(er->resampler, 254b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent (int16_t *)er->wr_buf, &inFrames); 255f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent ALOGV_IF(er->wr_frames_in != 0, 256b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent "echo_reference_write() er->wr_frames_in not 0 (%d) after resampler", 257b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->wr_frames_in); 258b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 259b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent srcBuf = er->wr_buf; 260b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } else { 261b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent inFrames = buffer->frame_count; 262b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent srcBuf = buffer->raw; 263b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 264b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 265b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if (er->frames_in + inFrames > er->buf_size) { 26625e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn ALOGV("echo_reference_write() increasing buffer size from %zu to %zu", 267b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->buf_size, er->frames_in + inFrames); 268b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->buf_size = er->frames_in + inFrames; 269b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->buffer = realloc(er->buffer, er->buf_size * er->rd_frame_size); 270b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 271b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent memcpy((char *)er->buffer + er->frames_in * er->rd_frame_size, 272b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent srcBuf, 273b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent inFrames * er->rd_frame_size); 274b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->frames_in += inFrames; 275b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 27625e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn ALOGV("echo_reference_write() frames written:[%zu], frames total:[%zu] buffer size:[%zu]\n" 27725e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn " er->wr_render_time:[%d].[%d], er->playback_delay:[%" PRId32 "]", 278f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent inFrames, er->frames_in, er->buf_size, 279f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent (int)er->wr_render_time.tv_sec, (int)er->wr_render_time.tv_nsec, er->playback_delay); 280b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 281b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent pthread_cond_signal(&er->cond); 282b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurentexit: 283b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent pthread_mutex_unlock(&er->lock); 284473d4a5c5c66fd8a2e99791d61fa16076558ab54Steve Block ALOGV("echo_reference_write() END"); 285b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent return status; 286b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent} 287b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 288f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent// delay jump threshold to update ref buffer: 6 samples at 8kHz in nsecs 289f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent#define MIN_DELAY_DELTA_NS (375000*2) 290f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent// number of consecutive delta with same sign between expected and actual delay before adjusting 291f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent// the buffer 292f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent#define MIN_DELTA_NUM 4 293b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 294b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 295b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurentstatic int echo_reference_read(struct echo_reference_itfe *echo_reference, 296b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent struct echo_reference_buffer *buffer) 297b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent{ 298b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent struct echo_reference *er = (struct echo_reference *)echo_reference; 299b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 300b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if (er == NULL) { 301b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent return -EINVAL; 302b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 303b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 304b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent pthread_mutex_lock(&er->lock); 305b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 306b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if (buffer == NULL) { 307f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent ALOGV("echo_reference_read() stop read"); 308b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->state &= ~ECHOREF_READING; 309b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent goto exit; 310b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 311b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 31225e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn ALOGV("echo_reference_read() START, delayCapture:[%" PRId32 "], " 31325e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn "er->frames_in:[%zu],buffer->frame_count:[%zu]", 314b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent buffer->delay_ns, er->frames_in, buffer->frame_count); 315b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 316b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if ((er->state & ECHOREF_READING) == 0) { 317f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent ALOGV("echo_reference_read() start read"); 318b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent echo_reference_reset_l(er); 319b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->state |= ECHOREF_READING; 320b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 321b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 322b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if ((er->state & ECHOREF_WRITING) == 0) { 323b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent memset(buffer->raw, 0, er->rd_frame_size * buffer->frame_count); 324b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent buffer->delay_ns = 0; 325b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent goto exit; 326b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 327b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 328f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent// ALOGV("echo_reference_read() %d frames", buffer->frame_count); 329b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 330b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent // allow some time for new frames to arrive if not enough frames are ready for read 331b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if (er->frames_in < buffer->frame_count) { 332b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent uint32_t timeoutMs = (uint32_t)((1000 * buffer->frame_count) / er->rd_sampling_rate / 2); 33331c4e5cdb771e7bc760b5a7f856a9f10904c0f7fColin Cross struct timespec ts = {0, 0}; 334b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 3355facaf4f68096f05b78a38434060fe42d359eb70Elliott Hughes clock_gettime(CLOCK_REALTIME, &ts); 3365facaf4f68096f05b78a38434060fe42d359eb70Elliott Hughes 33731c4e5cdb771e7bc760b5a7f856a9f10904c0f7fColin Cross ts.tv_sec += timeoutMs/1000; 33831c4e5cdb771e7bc760b5a7f856a9f10904c0f7fColin Cross ts.tv_nsec += (timeoutMs%1000) * 1000000; 33931c4e5cdb771e7bc760b5a7f856a9f10904c0f7fColin Cross if (ts.tv_nsec >= 1000000000) { 34031c4e5cdb771e7bc760b5a7f856a9f10904c0f7fColin Cross ts.tv_nsec -= 1000000000; 34131c4e5cdb771e7bc760b5a7f856a9f10904c0f7fColin Cross ts.tv_sec += 1; 34231c4e5cdb771e7bc760b5a7f856a9f10904c0f7fColin Cross } 34331c4e5cdb771e7bc760b5a7f856a9f10904c0f7fColin Cross 34431c4e5cdb771e7bc760b5a7f856a9f10904c0f7fColin Cross pthread_cond_timedwait(&er->cond, &er->lock, &ts); 345b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 346f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent ALOGV_IF((er->frames_in < buffer->frame_count), 347f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent "echo_reference_read() waited %d ms but still not enough frames"\ 348b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent " er->frames_in: %d, buffer->frame_count = %d", 349f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent timeoutMs, er->frames_in, buffer->frame_count); 350b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 351b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 352b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent int64_t timeDiff; 353b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent struct timespec tmp; 354b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 355b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if ((er->wr_render_time.tv_sec == 0 && er->wr_render_time.tv_nsec == 0) || 356b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent (buffer->time_stamp.tv_sec == 0 && buffer->time_stamp.tv_nsec == 0)) { 357f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent ALOGV("echo_reference_read(): NEW:timestamp is zero---------setting timeDiff = 0, "\ 358b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent "not updating delay this time"); 359b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent timeDiff = 0; 360b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } else { 361b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if (buffer->time_stamp.tv_nsec < er->wr_render_time.tv_nsec) { 362b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent tmp.tv_sec = buffer->time_stamp.tv_sec - er->wr_render_time.tv_sec - 1; 363b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent tmp.tv_nsec = 1000000000 + buffer->time_stamp.tv_nsec - er->wr_render_time.tv_nsec; 364b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } else { 365b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent tmp.tv_sec = buffer->time_stamp.tv_sec - er->wr_render_time.tv_sec; 366b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent tmp.tv_nsec = buffer->time_stamp.tv_nsec - er->wr_render_time.tv_nsec; 367b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 368b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent timeDiff = (((int64_t)tmp.tv_sec * 1000000000 + tmp.tv_nsec)); 369b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 370b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent int64_t expectedDelayNs = er->playback_delay + buffer->delay_ns - timeDiff; 371b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 372f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent if (er->resampler != NULL) { 373f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent // Resampler already compensates part of the delay 374f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent int32_t rsmp_delay = er->resampler->delay_ns(er->resampler); 375f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent expectedDelayNs -= rsmp_delay; 376f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent } 377f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent 37825e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn ALOGV("echo_reference_read(): expectedDelayNs[%" PRId64 "] = " 37925e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn "er->playback_delay[%" PRId32 "] + delayCapture[%" PRId32 38025e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn "] - timeDiff[%" PRId64 "]", 381f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent expectedDelayNs, er->playback_delay, buffer->delay_ns, timeDiff); 382b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 383b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if (expectedDelayNs > 0) { 384b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent int64_t delayNs = ((int64_t)er->frames_in * 1000000000) / er->rd_sampling_rate; 385b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 386f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent int64_t deltaNs = delayNs - expectedDelayNs; 387f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent 388ef44fccfd601d20c6996fefc3cd80c2fc9908335Glenn Kasten ALOGV("echo_reference_read(): EchoPathDelayDeviation between reference and DMA [%" 389ef44fccfd601d20c6996fefc3cd80c2fc9908335Glenn Kasten PRId64 "]", deltaNs); 390346b33a37a1097756391645edea8e7fc2a22c9e1Dan Albert if (llabs(deltaNs) >= MIN_DELAY_DELTA_NS) { 391f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent // smooth the variation and update the reference buffer only 392f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent // if a deviation in the same direction is observed for more than MIN_DELTA_NUM 393f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent // consecutive reads. 394f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent int16_t delay_sign = (deltaNs >= 0) ? 1 : -1; 395f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent if (delay_sign == er->prev_delta_sign) { 396f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent er->delta_count++; 397f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent } else { 398f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent er->delta_count = 1; 399f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent } 400f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent er->prev_delta_sign = delay_sign; 401b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 402f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent if (er->delta_count > MIN_DELTA_NUM) { 403b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent size_t previousFrameIn = er->frames_in; 404f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent er->frames_in = (size_t)((expectedDelayNs * er->rd_sampling_rate)/1000000000); 405f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent int offset = er->frames_in - previousFrameIn; 406f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent 407f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent ALOGV("echo_reference_read(): deltaNs ENOUGH and %s: " 40825e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn "er->frames_in: %zu, previousFrameIn = %zu", 409f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent delay_sign ? "positive" : "negative", er->frames_in, previousFrameIn); 410f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent 411f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent if (deltaNs < 0) { 412f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent // Less data available in the reference buffer than expected 413f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent if (er->frames_in > er->buf_size) { 414f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent er->buf_size = er->frames_in; 415f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent er->buffer = realloc(er->buffer, er->buf_size * er->rd_frame_size); 41625e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn ALOGV("echo_reference_read(): increasing buffer size to %zu", 417f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent er->buf_size); 418f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent } 419b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 420f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent if (offset > 0) { 421f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent memset((char *)er->buffer + previousFrameIn * er->rd_frame_size, 422f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent 0, offset * er->rd_frame_size); 423f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent ALOGV("echo_reference_read(): pushing ref buffer by [%d]", offset); 424b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 425b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } else { 426f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent // More data available in the reference buffer than expected 427f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent offset = -offset; 428b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if (offset > 0) { 429b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent memcpy(er->buffer, (char *)er->buffer + (offset * er->rd_frame_size), 430f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent er->frames_in * er->rd_frame_size); 43125e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn ALOGV("echo_reference_read(): shifting ref buffer by [%zu]", 432f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent er->frames_in); 433b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 434b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 435b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 436b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } else { 437f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent er->delta_count = 0; 438f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent er->prev_delta_sign = 0; 439f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent ALOGV("echo_reference_read(): Constant EchoPathDelay - difference " 44025e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn "between reference and DMA %" PRId64, deltaNs); 441b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 442b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } else { 44325e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn ALOGV("echo_reference_read(): NEGATIVE expectedDelayNs[%" PRId64 44425e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn "] = er->playback_delay[%" PRId32 "] + delayCapture[%" PRId32 44525e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn "] - timeDiff[%" PRId64 "]", 446b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent expectedDelayNs, er->playback_delay, buffer->delay_ns, timeDiff); 447b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 448b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 449b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 450f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent if (er->frames_in < buffer->frame_count) { 451f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent if (buffer->frame_count > er->buf_size) { 452f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent er->buf_size = buffer->frame_count; 453f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent er->buffer = realloc(er->buffer, er->buf_size * er->rd_frame_size); 45425e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn ALOGV("echo_reference_read(): increasing buffer size to %zu", er->buf_size); 455f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent } 456f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent // filling up the reference buffer with 0s to match the expected delay. 457f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent memset((char *)er->buffer + er->frames_in * er->rd_frame_size, 458f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent 0, (buffer->frame_count - er->frames_in) * er->rd_frame_size); 459f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent er->frames_in = buffer->frame_count; 460f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent } 461f06cdb511b2d093fed687fdff4153f7b6e088b62Eric Laurent 462b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent memcpy(buffer->raw, 463b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent (char *)er->buffer, 464b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent buffer->frame_count * er->rd_frame_size); 465b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 466b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->frames_in -= buffer->frame_count; 467b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent memcpy(er->buffer, 468b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent (char *)er->buffer + buffer->frame_count * er->rd_frame_size, 469b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->frames_in * er->rd_frame_size); 470b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 471b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent // As the reference buffer is now time aligned to the microphone signal there is a zero delay 472b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent buffer->delay_ns = 0; 473b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 47425e6c382d68fbf40fa3c70123e2086a821a93257Mark Salyzyn ALOGV("echo_reference_read() END %zu frames, total frames in %zu", 475b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent buffer->frame_count, er->frames_in); 476b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 477b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent pthread_cond_signal(&er->cond); 478b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 479b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurentexit: 480b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent pthread_mutex_unlock(&er->lock); 481b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent return 0; 482b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent} 483b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 484b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 485b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurentint create_echo_reference(audio_format_t rdFormat, 486b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent uint32_t rdChannelCount, 487b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent uint32_t rdSamplingRate, 488b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent audio_format_t wrFormat, 489b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent uint32_t wrChannelCount, 490b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent uint32_t wrSamplingRate, 491b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent struct echo_reference_itfe **echo_reference) 492b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent{ 493b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent struct echo_reference *er; 494b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 495473d4a5c5c66fd8a2e99791d61fa16076558ab54Steve Block ALOGV("create_echo_reference()"); 496b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 497b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if (echo_reference == NULL) { 498b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent return -EINVAL; 499b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 500b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 501b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent *echo_reference = NULL; 502b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 503b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if (rdFormat != AUDIO_FORMAT_PCM_16_BIT || 504b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent rdFormat != wrFormat) { 505d0e472977acbfd5c8d56d506f40039f451f84f8fSteve Block ALOGW("create_echo_reference bad format rd %d, wr %d", rdFormat, wrFormat); 506b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent return -EINVAL; 507b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 508b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if ((rdChannelCount != 1 && rdChannelCount != 2) || 509b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent wrChannelCount != 2) { 510548d9cf23e9d7f3ae1aa78a521c29e1ec4c910a8Glenn Kasten ALOGW("create_echo_reference bad channel count rd %d, wr %d", rdChannelCount, 511548d9cf23e9d7f3ae1aa78a521c29e1ec4c910a8Glenn Kasten wrChannelCount); 512b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent return -EINVAL; 513b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 514b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 515b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er = (struct echo_reference *)calloc(1, sizeof(struct echo_reference)); 516b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 517b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->itfe.read = echo_reference_read; 518b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->itfe.write = echo_reference_write; 519b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 520b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->state = ECHOREF_IDLE; 521b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->rd_format = rdFormat; 522b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->rd_channel_count = rdChannelCount; 523b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->rd_sampling_rate = rdSamplingRate; 524b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->wr_format = wrFormat; 525b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->wr_channel_count = wrChannelCount; 526b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->wr_sampling_rate = wrSamplingRate; 527b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->rd_frame_size = audio_bytes_per_sample(rdFormat) * rdChannelCount; 528b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent er->wr_frame_size = audio_bytes_per_sample(wrFormat) * wrChannelCount; 529b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent *echo_reference = &er->itfe; 530b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent return 0; 531b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent} 532b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 533b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurentvoid release_echo_reference(struct echo_reference_itfe *echo_reference) { 534b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent struct echo_reference *er = (struct echo_reference *)echo_reference; 535b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 536b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent if (er == NULL) { 537b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent return; 538b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 539b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 540473d4a5c5c66fd8a2e99791d61fa16076558ab54Steve Block ALOGV("EchoReference dstor"); 541b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent echo_reference_reset_l(er); 54233e8f78bb282cbb7b1c55ce0c9d412458989bc9eEric Laurent if (er->resampler != NULL) { 54333e8f78bb282cbb7b1c55ce0c9d412458989bc9eEric Laurent release_resampler(er->resampler); 544b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent } 545b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent free(er); 546b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent} 547b3184d71bc6cee9fcbb36343e379143329be00ceEric Laurent 548