mirror of
https://github.com/signalwire/freeswitch.git
synced 2025-02-24 10:31:13 +00:00
a33b576e70
git-svn-id: http://svn.freeswitch.org/svn/freeswitch/trunk@17138 d0543943-73ff-0310-b7d9-9358b9ac24b2
721 lines
22 KiB
C
721 lines
22 KiB
C
/*
|
|
* $Id: pablio.c 1151 2006-11-29 02:11:16Z leland_lucius $
|
|
* pablio.c
|
|
* Portable Audio Blocking Input/Output utility.
|
|
*
|
|
* Author: Phil Burk, http://www.softsynth.com
|
|
*
|
|
* This program uses the PortAudio Portable Audio Library.
|
|
* For more information see: http://www.portaudio.com
|
|
* Copyright (c) 1999-2000 Ross Bencina and Phil Burk
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person obtaining
|
|
* a copy of this software and associated documentation files
|
|
* (the "Software"), to deal in the Software without restriction,
|
|
* including without limitation the rights to use, copy, modify, merge,
|
|
* publish, distribute, sublicense, and/or sell copies of the Software,
|
|
* and to permit persons to whom the Software is furnished to do so,
|
|
* subject to the following conditions:
|
|
*
|
|
* The above copyright notice and this permission notice shall be
|
|
* included in all copies or substantial portions of the Software.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
|
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
|
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
|
|
* IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR
|
|
* ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF
|
|
* CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
|
|
* WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
|
|
*/
|
|
|
|
/*
|
|
* The text above constitutes the entire PortAudio license; however,
|
|
* the PortAudio community also makes the following non-binding requests:
|
|
*
|
|
* Any person wishing to distribute modifications to the Software is
|
|
* requested to send the modifications to the original developer so that
|
|
* they can be incorporated into the canonical version. It is also
|
|
* requested that these non-binding requests be included along with the
|
|
* license above.
|
|
*/
|
|
#define WANT_SPEEX
|
|
#include <switch.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <math.h>
|
|
#include "portaudio.h"
|
|
#include "pa_ringbuffer.h"
|
|
#include "pablio.h"
|
|
#include <string.h>
|
|
#include <time.h>
|
|
#ifdef WANT_SPEEX
|
|
#include "speex/speex_preprocess.h"
|
|
#include "speex/speex_echo.h"
|
|
SpeexPreprocessState *preprocess;
|
|
SpeexPreprocessState *preprocess2;
|
|
SpeexEchoState *echo_state;
|
|
|
|
int speexecho=1;
|
|
int speexpreprocess=1;
|
|
#endif// WANT_SPEEX
|
|
|
|
/************************************************************************/
|
|
/******** Prototypes ****************************************************/
|
|
/************************************************************************/
|
|
|
|
static int iblockingIOCallback(const void *inputBuffer, void *outputBuffer,
|
|
unsigned long framesPerBuffer, const PaStreamCallbackTimeInfo * timeInfo, PaStreamCallbackFlags statusFlags, void *userData);
|
|
static int oblockingIOCallback(const void *inputBuffer, void *outputBuffer,
|
|
unsigned long framesPerBuffer, const PaStreamCallbackTimeInfo * timeInfo, PaStreamCallbackFlags statusFlags, void *userData);
|
|
|
|
static int ioblockingIOCallback(const void *inputBuffer, void *outputBuffer,
|
|
unsigned long framesPerBuffer, const PaStreamCallbackTimeInfo * timeInfo, PaStreamCallbackFlags statusFlags, void *userData);
|
|
|
|
static PaError PABLIO_InitFIFO(PaUtilRingBuffer * rbuf, long numFrames, long bytesPerFrame);
|
|
static PaError PABLIO_TermFIFO(PaUtilRingBuffer * rbuf);
|
|
|
|
/************************************************************************/
|
|
/******** Functions *****************************************************/
|
|
/************************************************************************/
|
|
|
|
/* Called from PortAudio.
|
|
* Read and write data
|
|
*/
|
|
static int iblockingIOCallback(const void *inputBuffer, void *outputBuffer,
|
|
unsigned long framesPerBuffer, const PaStreamCallbackTimeInfo * timeInfo, PaStreamCallbackFlags statusFlags, void *userData)
|
|
{
|
|
PABLIO_Stream *data = (PABLIO_Stream *) userData;
|
|
long numBytes = data->bytesPerFrame * framesPerBuffer;
|
|
#ifdef WANT_SPEEX
|
|
spx_int16_t *speexptr=NULL;
|
|
spx_int16_t pcm2[160];
|
|
int i;
|
|
#endif// WANT_SPEEX
|
|
|
|
/* This may get called with NULL inputBuffer during initial setup. */
|
|
if (inputBuffer != NULL) {
|
|
#ifdef WANT_SPEEX
|
|
//FIXME speex_echo_cancellation(echo_state, inputBuffer, outputBuffer, pcm2);
|
|
//FIXME speexptr=(spx_int16_t *)inputBuffer;
|
|
//FIXME for (i = 0; i < 160; i++)
|
|
//FIXME speexptr[i] = pcm2[i];
|
|
//FIXME speex_preprocess_run(preprocess, speexptr);
|
|
#if 1
|
|
if (speexecho) {
|
|
speexptr = ((spx_int16_t *) inputBuffer);
|
|
|
|
/* Perform echo cancellation */
|
|
speex_echo_capture(echo_state, speexptr, pcm2);
|
|
#ifndef GIOVA48
|
|
for (i = 0; i < 160; i++)
|
|
#else //GIOVA48
|
|
for (i = 0; i < 960; i++)
|
|
#endif //GIOVA48
|
|
speexptr[i] = pcm2[i];
|
|
//printf("read\n");
|
|
}
|
|
if (speexpreprocess) {
|
|
speex_preprocess_run(preprocess, speexptr);
|
|
}
|
|
/* Apply noise/echo residual suppression */
|
|
#endif
|
|
#endif //WANT_SPEEX
|
|
|
|
|
|
if (PaUtil_WriteRingBuffer(&data->inFIFO, inputBuffer, numBytes) != numBytes) {
|
|
PaUtil_FlushRingBuffer(&data->inFIFO);
|
|
PaUtil_WriteRingBuffer(&data->inFIFO, inputBuffer, numBytes);
|
|
printf("HEEEEEEEEEEEj\n");
|
|
speex_echo_state_reset(echo_state);
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int oblockingIOCallback(const void *inputBuffer, void *outputBuffer,
|
|
unsigned long framesPerBuffer, const PaStreamCallbackTimeInfo * timeInfo, PaStreamCallbackFlags statusFlags, void *userData)
|
|
{
|
|
PABLIO_Stream *data = (PABLIO_Stream *) userData;
|
|
long numBytes = data->bytesPerFrame * framesPerBuffer;
|
|
#ifdef WANT_SPEEX
|
|
spx_int16_t *speexptr=NULL;
|
|
//spx_int16_t pcm2[160];
|
|
//int i;
|
|
#endif// WANT_SPEEX
|
|
|
|
|
|
if (outputBuffer != NULL) {
|
|
int i;
|
|
int numRead = PaUtil_ReadRingBuffer(&data->outFIFO, outputBuffer, numBytes);
|
|
/* Zero out remainder of buffer if we run out of data. */
|
|
for (i = numRead; i < numBytes; i++) {
|
|
((char *) outputBuffer)[i] = 0;
|
|
}
|
|
|
|
if(numRead == 0){
|
|
//printf("ZERO\n");
|
|
//usleep(60000);
|
|
//speex_echo_state_reset(echo_state);
|
|
}
|
|
#ifdef WANT_SPEEX
|
|
//FIXME speexptr = (spx_int16_t *) outputBuffer;
|
|
//FIXME speex_preprocess_run(preprocess2, speexptr);
|
|
#if 1
|
|
if (speexecho ) {
|
|
speexptr = (spx_int16_t *) outputBuffer;
|
|
if (speexpreprocess && numRead) {
|
|
//speex_preprocess_run(preprocess2, speexptr);
|
|
}
|
|
|
|
|
|
|
|
/* Put frame into playback buffer */
|
|
speex_echo_playback(echo_state, speexptr);
|
|
//printf("write\n");
|
|
}
|
|
|
|
#endif
|
|
#endif //WANT_SPEEX
|
|
|
|
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ioblockingIOCallback(const void *inputBuffer, void *outputBuffer,
|
|
unsigned long framesPerBuffer, const PaStreamCallbackTimeInfo * timeInfo, PaStreamCallbackFlags statusFlags, void *userData)
|
|
{
|
|
|
|
|
|
//write
|
|
oblockingIOCallback(inputBuffer, outputBuffer, framesPerBuffer, timeInfo, statusFlags, userData);
|
|
//read
|
|
iblockingIOCallback(inputBuffer, outputBuffer, framesPerBuffer, timeInfo, statusFlags, userData);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Allocate buffer. */
|
|
static PaError PABLIO_InitFIFO(PaUtilRingBuffer * rbuf, long numFrames, long bytesPerFrame)
|
|
{
|
|
long numBytes = numFrames * bytesPerFrame;
|
|
char *buffer = (char *) malloc(numBytes);
|
|
if (buffer == NULL)
|
|
return paInsufficientMemory;
|
|
memset(buffer, 0, numBytes);
|
|
return (PaError) PaUtil_InitializeRingBuffer(rbuf, numBytes, buffer);
|
|
}
|
|
|
|
/* Free buffer. */
|
|
static PaError PABLIO_TermFIFO(PaUtilRingBuffer * rbuf)
|
|
{
|
|
if (rbuf->buffer)
|
|
free(rbuf->buffer);
|
|
rbuf->buffer = NULL;
|
|
return paNoError;
|
|
}
|
|
|
|
/************************************************************
|
|
* Write data to ring buffer.
|
|
* Will not return until all the data has been written.
|
|
*/
|
|
long WriteAudioStream(PABLIO_Stream * aStream, void *data, long numFrames, switch_timer_t *timer)
|
|
{
|
|
long bytesWritten;
|
|
char *p = (char *) data;
|
|
long numBytes = aStream->bytesPerFrame * numFrames;
|
|
|
|
switch_core_timer_next(timer);
|
|
|
|
bytesWritten = PaUtil_WriteRingBuffer(&aStream->outFIFO, p, numBytes);
|
|
numBytes -= bytesWritten;
|
|
p += bytesWritten;
|
|
|
|
if (numBytes > 0) {
|
|
PaUtil_FlushRingBuffer(&aStream->outFIFO);
|
|
printf("2HEEEEEEEEEEEj\n");
|
|
speex_echo_state_reset(echo_state);
|
|
return 0;
|
|
}
|
|
return numFrames;
|
|
}
|
|
|
|
/************************************************************
|
|
* Read data from ring buffer.
|
|
* Will not return until all the data has been read.
|
|
*/
|
|
long ReadAudioStream(PABLIO_Stream * aStream, void *data, long numFrames, switch_timer_t *timer)
|
|
{
|
|
long bytesRead = 0;
|
|
char *p = (char *) data;
|
|
long avail, totalBytes = 0, neededBytes = aStream->bytesPerFrame * numFrames;
|
|
int max = 5000;
|
|
|
|
switch_core_timer_next(timer);
|
|
|
|
while(totalBytes < neededBytes && --max > 0) {
|
|
|
|
avail = PaUtil_GetRingBufferReadAvailable(&aStream->inFIFO);
|
|
//printf("AVAILABLE BYTES %ld , neededBytes %ld, pass %d\n", avail, neededBytes, 5000 - max);
|
|
if (avail >= neededBytes * 6) {
|
|
PaUtil_FlushRingBuffer(&aStream->inFIFO);
|
|
printf("3HEEEEEEEEEEEj\n");
|
|
speex_echo_state_reset(echo_state);
|
|
avail = 0;
|
|
} else {
|
|
|
|
bytesRead = 0;
|
|
|
|
if (totalBytes < neededBytes && avail >= neededBytes) {
|
|
bytesRead = PaUtil_ReadRingBuffer(&aStream->inFIFO, p, neededBytes);
|
|
totalBytes += bytesRead;
|
|
}
|
|
|
|
if (bytesRead) {
|
|
p += bytesRead;
|
|
} else {
|
|
switch_cond_next();
|
|
}
|
|
}
|
|
}
|
|
|
|
//printf("return=%ld\n", totalBytes / aStream->bytesPerFrame);
|
|
return totalBytes / aStream->bytesPerFrame;
|
|
}
|
|
|
|
/************************************************************
|
|
* Return the number of frames that could be written to the stream without
|
|
* having to wait.
|
|
*/
|
|
long GetAudioStreamWriteable(PABLIO_Stream * aStream)
|
|
{
|
|
int bytesEmpty = PaUtil_GetRingBufferWriteAvailable(&aStream->outFIFO);
|
|
return bytesEmpty / aStream->bytesPerFrame;
|
|
}
|
|
|
|
/************************************************************
|
|
* Return the number of frames that are available to be read from the
|
|
* stream without having to wait.
|
|
*/
|
|
long GetAudioStreamReadable(PABLIO_Stream * aStream)
|
|
{
|
|
int bytesFull = PaUtil_GetRingBufferReadAvailable(&aStream->inFIFO);
|
|
return bytesFull / aStream->bytesPerFrame;
|
|
}
|
|
|
|
/***********************************************************/
|
|
static unsigned long RoundUpToNextPowerOf2(unsigned long n)
|
|
{
|
|
long numBits = 0;
|
|
if (((n - 1) & n) == 0)
|
|
return n;
|
|
while (n > 0) {
|
|
n = n >> 1;
|
|
numBits++;
|
|
}
|
|
return (1 << numBits);
|
|
}
|
|
|
|
|
|
|
|
/************************************************************
|
|
* Opens a PortAudio stream with default characteristics.
|
|
* Allocates PABLIO_Stream structure.
|
|
*
|
|
*/
|
|
PaError OpenAudioStream(PABLIO_Stream ** rwblPtr,
|
|
const PaStreamParameters * inputParameters,
|
|
const PaStreamParameters * outputParameters,
|
|
double sampleRate, PaStreamFlags streamFlags,
|
|
long samples_per_packet,
|
|
int do_dual)
|
|
{
|
|
long bytesPerSample = 2;
|
|
PaError err;
|
|
PABLIO_Stream *aStream;
|
|
long numFrames;
|
|
//long numBytes;
|
|
int channels = 1;
|
|
#ifdef WANT_SPEEX
|
|
int ciapa;
|
|
float level;
|
|
int tmp;
|
|
#endif //WANT_SPEEX
|
|
|
|
|
|
if (!(inputParameters || outputParameters)) {
|
|
return -1;
|
|
}
|
|
|
|
/* Allocate PABLIO_Stream structure for caller. */
|
|
aStream = (PABLIO_Stream *) malloc(sizeof(PABLIO_Stream));
|
|
switch_assert(aStream);
|
|
memset(aStream, 0, sizeof(PABLIO_Stream));
|
|
|
|
if (inputParameters) {
|
|
channels = inputParameters->channelCount;
|
|
} else if (outputParameters) {
|
|
channels = outputParameters->channelCount;
|
|
}
|
|
|
|
numFrames = RoundUpToNextPowerOf2(samples_per_packet * 5);
|
|
aStream->bytesPerFrame = bytesPerSample;
|
|
|
|
/* Initialize Ring Buffers */
|
|
|
|
if (inputParameters) {
|
|
err = PABLIO_InitFIFO(&aStream->inFIFO, numFrames, aStream->bytesPerFrame);
|
|
if (err != paNoError) {
|
|
goto error;
|
|
}
|
|
aStream-> has_in = 1;
|
|
}
|
|
|
|
if (outputParameters) {
|
|
err = PABLIO_InitFIFO(&aStream->outFIFO, numFrames, aStream->bytesPerFrame);
|
|
if (err != paNoError) {
|
|
goto error;
|
|
}
|
|
aStream-> has_out = 1;
|
|
}
|
|
#ifdef WANT_SPEEX
|
|
/* Echo canceller with 100 ms tail length */
|
|
#ifndef GIOVA48
|
|
echo_state = speex_echo_state_init(160, 1600);
|
|
ciapa = 8000;
|
|
#else// GIOVA48
|
|
echo_state = speex_echo_state_init(960, 4800);
|
|
ciapa = 48000;
|
|
#endif // GIOVA48
|
|
speex_echo_ctl(echo_state, SPEEX_ECHO_SET_SAMPLING_RATE, &ciapa);
|
|
|
|
#if 1 //NO MORE
|
|
/* Setup preprocessor and associate with echo canceller for residual echo suppression */
|
|
#ifndef GIOVA48
|
|
preprocess = speex_preprocess_state_init(160, 8000);
|
|
#else// GIOVA48
|
|
preprocess = speex_preprocess_state_init(960, 48000);
|
|
#endif // GIOVA48
|
|
speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_SET_ECHO_STATE,
|
|
echo_state);
|
|
|
|
#if 0
|
|
/* Setup preprocessor various other goodies */
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_SET_AGC, &tmp);
|
|
level=8000.1;
|
|
speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_SET_AGC_LEVEL, &level);
|
|
|
|
tmp = 8000;
|
|
speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_SET_AGC_TARGET, &tmp);
|
|
|
|
//FIXME tmp = 60;
|
|
//FIXME speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_SET_AGC_MAX_GAIN, &tmp);
|
|
//FIXME fprintf(stderr, "SPEEX_PREPROCESS_GET_AGC_MAX_GAIN is: %d\n", tmp);
|
|
//FIXME tmp = 40;
|
|
//FIXME speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_SET_AGC_INCREMENT, &tmp);
|
|
//FIXME fprintf(stderr, "SPEEX_PREPROCESS_GET_AGC_INCREMENT is: %d\n", tmp);
|
|
//FIXME tmp = -40;
|
|
//FIXME speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_SET_AGC_DECREMENT, &tmp);
|
|
//FIXME fprintf(stderr, "SPEEX_PREPROCESS_GET_AGC_DECREMENT is: %d\n", tmp);
|
|
|
|
#if 0
|
|
// Let's turn off all of the 'denoisers' (eg denoise and dereverb, and vad too) because they start automatic gain on mic input on cm108 usb, also if it (the agc on usb) disbled through mixer
|
|
tmp = 0;
|
|
speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_SET_DENOISE, &tmp);
|
|
tmp = 0;
|
|
speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_SET_DEREVERB, &tmp);
|
|
tmp = 0;
|
|
speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_SET_VAD, &tmp);
|
|
#endif
|
|
|
|
//tmp = 0;
|
|
//speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_SET_DENOISE, &tmp);
|
|
tmp = 1;
|
|
#endif //0
|
|
speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_GET_AGC, &tmp);
|
|
fprintf(stderr, "AGC is: %d\n", tmp);
|
|
level = 1.0;
|
|
speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_GET_AGC_LEVEL, &level);
|
|
fprintf(stderr, "AGC_LEVEL is: %f\n", level);
|
|
//tmp=1;
|
|
//speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_GET_AGC_TARGET, &tmp);
|
|
//fprintf( stderr, "AGC_TARGET is: %d\n", tmp );
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_GET_DENOISE, &tmp);
|
|
fprintf(stderr, "DENOISE is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_GET_DEREVERB, &tmp);
|
|
fprintf(stderr, "DEREVERB is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_GET_VAD, &tmp);
|
|
fprintf(stderr, "VAD is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_GET_AGC_MAX_GAIN, &tmp);
|
|
fprintf(stderr, "SPEEX_PREPROCESS_GET_AGC_MAX_GAIN is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_GET_AGC_INCREMENT, &tmp);
|
|
fprintf(stderr, "SPEEX_PREPROCESS_GET_AGC_INCREMENT is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_GET_AGC_DECREMENT, &tmp);
|
|
fprintf(stderr, "SPEEX_PREPROCESS_GET_AGC_DECREMENT is: %d\n", tmp);
|
|
|
|
#if 0
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_GET_NOISE_SUPPRESS, &tmp);
|
|
fprintf(stderr, "SPEEX_PREPROCESS_GET_NOISE_SUPPRESS is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_GET_ECHO_SUPPRESS, &tmp);
|
|
fprintf(stderr, "SPEEX_PREPROCESS_GET_ECHO_SUPPRESS is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_GET_ECHO_SUPPRESS_ACTIVE,
|
|
&tmp);
|
|
fprintf(stderr, "SPEEX_PREPROCESS_GET_ECHO_SUPPRESS_ACTIVE is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_GET_AGC_MAX_GAIN, &tmp);
|
|
fprintf(stderr, "SPEEX_PREPROCESS_GET_AGC_MAX_GAIN is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_GET_AGC_INCREMENT, &tmp);
|
|
fprintf(stderr, "SPEEX_PREPROCESS_GET_AGC_INCREMENT is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_GET_AGC_DECREMENT, &tmp);
|
|
fprintf(stderr, "SPEEX_PREPROCESS_GET_AGC_DECREMENT is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_GET_PROB_START, &tmp);
|
|
fprintf(stderr, "SPEEX_PREPROCESS_GET_PROB_START is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess, SPEEX_PREPROCESS_GET_PROB_CONTINUE, &tmp);
|
|
fprintf(stderr, "SPEEX_PREPROCESS_GET_PROB_CONTINUE is: %d\n", tmp);
|
|
#endif //0
|
|
#endif// 0 //NO MORE
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if 1 //NO MORE
|
|
/* Setup preprocessor and associate with echo canceller for residual echo suppression */
|
|
#ifndef GIOVA48
|
|
preprocess2 = speex_preprocess_state_init(160, 8000);
|
|
#else// GIOVA48
|
|
preprocess = speex_preprocess_state_init(960, 48000);
|
|
#endif // GIOVA48
|
|
|
|
/* Setup preprocessor various other goodies */
|
|
tmp = 0;
|
|
speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_SET_AGC, &tmp);
|
|
|
|
tmp = 24000;
|
|
speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_SET_AGC_TARGET, &tmp);
|
|
|
|
//tmp = 60;
|
|
//speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_SET_AGC_MAX_GAIN, &tmp);
|
|
tmp = 40;
|
|
speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_SET_AGC_INCREMENT, &tmp);
|
|
tmp = -40;
|
|
speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_SET_AGC_DECREMENT, &tmp);
|
|
|
|
#if 0
|
|
// Let's turn off all of the 'denoisers' (eg denoise and dereverb, and vad too) because they start automatic gain on mic input on cm108 usb, also if it (the agc on usb) disbled through mixer
|
|
tmp = 0;
|
|
speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_SET_DENOISE, &tmp);
|
|
tmp = 0;
|
|
speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_SET_DEREVERB, &tmp);
|
|
tmp = 0;
|
|
speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_SET_VAD, &tmp);
|
|
#endif
|
|
|
|
//tmp = 0;
|
|
//speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_SET_DENOISE, &tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_GET_AGC, &tmp);
|
|
fprintf(stderr, "AGC is: %d\n", tmp);
|
|
level = 1.0;
|
|
speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_GET_AGC_LEVEL, &level);
|
|
fprintf(stderr, "AGC_LEVEL is: %f\n", level);
|
|
//tmp=1;
|
|
//speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_GET_AGC_TARGET, &tmp);
|
|
//fprintf( stderr, "AGC_TARGET is: %d\n", tmp );
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_GET_DENOISE, &tmp);
|
|
fprintf(stderr, "DENOISE is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_GET_DEREVERB, &tmp);
|
|
fprintf(stderr, "DEREVERB is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_GET_VAD, &tmp);
|
|
fprintf(stderr, "VAD is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_GET_AGC_MAX_GAIN, &tmp);
|
|
fprintf(stderr, "SPEEX_PREPROCESS_GET_AGC_MAX_GAIN is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_GET_AGC_INCREMENT, &tmp);
|
|
fprintf(stderr, "SPEEX_PREPROCESS_GET_AGC_INCREMENT is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_GET_AGC_DECREMENT, &tmp);
|
|
fprintf(stderr, "SPEEX_PREPROCESS_GET_AGC_DECREMENT is: %d\n", tmp);
|
|
|
|
#if 0
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_GET_NOISE_SUPPRESS, &tmp);
|
|
fprintf(stderr, "SPEEX_PREPROCESS_GET_NOISE_SUPPRESS is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_GET_ECHO_SUPPRESS, &tmp);
|
|
fprintf(stderr, "SPEEX_PREPROCESS_GET_ECHO_SUPPRESS is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_GET_ECHO_SUPPRESS_ACTIVE,
|
|
&tmp);
|
|
fprintf(stderr, "SPEEX_PREPROCESS_GET_ECHO_SUPPRESS_ACTIVE is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_GET_AGC_MAX_GAIN, &tmp);
|
|
fprintf(stderr, "SPEEX_PREPROCESS_GET_AGC_MAX_GAIN is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_GET_AGC_INCREMENT, &tmp);
|
|
fprintf(stderr, "SPEEX_PREPROCESS_GET_AGC_INCREMENT is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_GET_AGC_DECREMENT, &tmp);
|
|
fprintf(stderr, "SPEEX_PREPROCESS_GET_AGC_DECREMENT is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_GET_PROB_START, &tmp);
|
|
fprintf(stderr, "SPEEX_PREPROCESS_GET_PROB_START is: %d\n", tmp);
|
|
tmp = 1;
|
|
speex_preprocess_ctl(preprocess2, SPEEX_PREPROCESS_GET_PROB_CONTINUE, &tmp);
|
|
fprintf(stderr, "SPEEX_PREPROCESS_GET_PROB_CONTINUE is: %d\n", tmp);
|
|
#endif //0
|
|
#endif// 0 //NO MORE
|
|
|
|
|
|
|
|
|
|
#endif // WANT_SPEEX
|
|
|
|
|
|
/* Open a PortAudio stream that we will use to communicate with the underlying
|
|
* audio drivers. */
|
|
|
|
aStream->do_dual = do_dual;
|
|
|
|
if (aStream->do_dual) {
|
|
err = Pa_OpenStream(&aStream->istream, inputParameters, NULL, sampleRate, samples_per_packet, streamFlags, iblockingIOCallback, aStream);
|
|
if (err != paNoError) {
|
|
goto error;
|
|
}
|
|
err = Pa_OpenStream(&aStream->ostream, NULL, outputParameters, sampleRate, samples_per_packet, streamFlags, oblockingIOCallback, aStream);
|
|
if (err != paNoError) {
|
|
goto error;
|
|
}
|
|
} else {
|
|
err = Pa_OpenStream(&aStream->iostream, inputParameters, outputParameters, sampleRate, samples_per_packet, streamFlags, ioblockingIOCallback, aStream);
|
|
}
|
|
|
|
if (err != paNoError) {
|
|
goto error;
|
|
}
|
|
|
|
if (aStream->do_dual) {
|
|
err = Pa_StartStream(aStream->istream);
|
|
|
|
if (err != paNoError) {
|
|
goto error;
|
|
}
|
|
|
|
err = Pa_StartStream(aStream->ostream);
|
|
|
|
if (err != paNoError) {
|
|
goto error;
|
|
}
|
|
|
|
} else {
|
|
err = Pa_StartStream(aStream->iostream);
|
|
}
|
|
|
|
if (err != paNoError) {
|
|
goto error;
|
|
}
|
|
|
|
*rwblPtr = aStream;
|
|
|
|
//switch_yield(500000);
|
|
|
|
return paNoError;
|
|
|
|
error:
|
|
|
|
CloseAudioStream(aStream);
|
|
|
|
*rwblPtr = NULL;
|
|
return err;
|
|
}
|
|
|
|
/************************************************************/
|
|
PaError CloseAudioStream(PABLIO_Stream * aStream)
|
|
{
|
|
int bytesEmpty;
|
|
int byteSize;
|
|
|
|
|
|
byteSize = aStream->outFIFO.bufferSize;
|
|
|
|
if (aStream->has_out) {
|
|
/* If we are writing data, make sure we play everything written. */
|
|
if (byteSize > 0) {
|
|
bytesEmpty = PaUtil_GetRingBufferWriteAvailable(&aStream->outFIFO);
|
|
while (bytesEmpty < byteSize) {
|
|
Pa_Sleep(10);
|
|
bytesEmpty = PaUtil_GetRingBufferWriteAvailable(&aStream->outFIFO);
|
|
}
|
|
}
|
|
}
|
|
|
|
if (aStream->do_dual) {
|
|
if (aStream->has_in && aStream->istream) {
|
|
if (Pa_IsStreamActive(aStream->istream)) {
|
|
Pa_StopStream(aStream->istream);
|
|
}
|
|
|
|
Pa_CloseStream(aStream->istream);
|
|
aStream->istream = NULL;
|
|
}
|
|
|
|
if (aStream->has_out && aStream->ostream) {
|
|
if (Pa_IsStreamActive(aStream->ostream)) {
|
|
Pa_StopStream(aStream->ostream);
|
|
}
|
|
|
|
Pa_CloseStream(aStream->ostream);
|
|
aStream->ostream = NULL;
|
|
}
|
|
|
|
} else {
|
|
if (aStream->iostream) {
|
|
if (Pa_IsStreamActive(aStream->iostream)) {
|
|
Pa_StopStream(aStream->iostream);
|
|
}
|
|
|
|
Pa_CloseStream(aStream->iostream);
|
|
aStream->iostream = NULL;
|
|
}
|
|
}
|
|
|
|
if (aStream->has_in) {
|
|
PABLIO_TermFIFO(&aStream->inFIFO);
|
|
}
|
|
|
|
if (aStream->has_out) {
|
|
PABLIO_TermFIFO(&aStream->outFIFO);
|
|
}
|
|
|
|
free(aStream);
|
|
//switch_yield(500000);
|
|
|
|
return paNoError;
|
|
}
|
|
|