static void callback(SLBufferQueueItf bufq, void *param)
{
assert(NULL == param);
if (!eof) {
void *buffer = (char *)buffers + framesPerBuffer * sfframesize * which;
ssize_t count = audio_utils_fifo_read(&fifo, buffer, framesPerBuffer);
// on underrun from pipe, substitute silence
if (0 >= count) {
memset(buffer, 0, framesPerBuffer * sfframesize);
count = framesPerBuffer;
++underruns;
}
if (count > 0) {
SLuint32 nbytes = count * sfframesize;
nbytes = squeeze(buffer, nbytes);
SLresult result = (*bufq)->Enqueue(bufq, buffer, nbytes);
assert(SL_RESULT_SUCCESS == result);
if (++which >= numBuffers)
which = 0;
}
}
}
// Called after audio player empties a buffer of data
static void playerCallback(SLBufferQueueItf caller __unused, void *context) {
sles_data *pSles = (sles_data*) context;
if (pSles != NULL) {
collectPlayerBufferPeriod(pSles);
SLresult result;
pthread_mutex_lock(&(pSles->mutex));
//ee SLES_PRINTF("<P");
// Get the buffer that just finished playing
assert(pSles->txFront <= pSles->txBufCount);
assert(pSles->txRear <= pSles->txBufCount);
assert(pSles->txFront != pSles->txRear);
char *buffer = pSles->txBuffers[pSles->txFront];
if (++pSles->txFront > pSles->txBufCount) {
pSles->txFront = 0;
}
if (pSles->testType == TEST_TYPE_LATENCY) {
ssize_t actual = audio_utils_fifo_read(&(pSles->fifo), buffer, pSles->bufSizeInFrames);
if (actual != (ssize_t) pSles->bufSizeInFrames) {
write(1, "/", 1);
// on underrun from pipe, substitute silence
memset(buffer, 0, pSles->bufSizeInFrames * pSles->channels * sizeof(short));
}
if (pSles->injectImpulse == -1) { // here we inject pulse
// Experimentally, a single frame impulse was insufficient to trigger feedback.
// Also a Nyquist frequency signal was also insufficient, probably because
// the response of output and/or input path was not adequate at high frequencies.
// This short burst of a few cycles of square wave at Nyquist/4 found to work well.
for (unsigned i = 0; i < pSles->bufSizeInFrames / 8; i += 8) {
for (int j = 0; j < 8; j++) {
for (unsigned k = 0; k < pSles->channels; k++) {
((short *) buffer)[(i + j) * pSles->channels + k] =
j < 4 ? 0x7FFF : 0x8000;
}
}
}
pSles->injectImpulse = 0;
}
} else if (pSles->testType == TEST_TYPE_BUFFER_PERIOD) {
double twoPi = M_PI * 2;
int maxShort = 32767;
float amplitude = 0.8;
short value;
double phaseIncrement = pSles->frequency1 / pSles->sampleRate;
bool isGlitchEnabled = false;
for (unsigned i = 0; i < pSles->bufSizeInFrames; i++) {
value = (short) (sin(pSles->bufferTestPhase1) * maxShort * amplitude);
((short *) buffer)[i] = value;
pSles->bufferTestPhase1 += twoPi * phaseIncrement;
// insert glitches if isGlitchEnabled == true, and insert it for every second
if (isGlitchEnabled && (pSles->count % pSles->sampleRate == 0)) {
pSles->bufferTestPhase1 += twoPi * phaseIncrement;
}
pSles->count++;
while (pSles->bufferTestPhase1 > twoPi) {
pSles->bufferTestPhase1 -= twoPi;
}
}
}
// Enqueue the filled buffer for playing
result = (*(pSles->playerBufferQueue))->Enqueue(pSles->playerBufferQueue, buffer,
pSles->bufSizeInBytes);
ASSERT_EQ(SL_RESULT_SUCCESS, result);
// Update our model of the player queue
assert(pSles->txFront <= pSles->txBufCount);
assert(pSles->txRear <= pSles->txBufCount);
SLuint32 txRearNext = pSles->txRear + 1;
if (txRearNext > pSles->txBufCount) {
txRearNext = 0;
}
assert(txRearNext != pSles->txFront);
pSles->txBuffers[pSles->txRear] = buffer;
pSles->txRear = txRearNext;
pthread_mutex_unlock(&(pSles->mutex));
} //pSles not null
}
// Read data from fifo2Buffer and store into pSamples.
int slesProcessNext(sles_data *pSles, double *pSamples, long maxSamples) {
//int status = SLES_FAIL;
SLES_PRINTF("slesProcessNext: pSles = %p, currentSample: %p, maxSamples = %d",
pSles, pSamples, maxSamples);
int samplesRead = 0;
int currentSample = 0;
double *pCurrentSample = pSamples;
int maxValue = 32768;
if (pSles != NULL) {
SLresult result;
for (int i = 0; i < 10; i++) {
usleep(100000); // sleep for 0.1s
if (pSles->fifo2Buffer != NULL) {
for (;;) {
short buffer[pSles->bufSizeInFrames * pSles->channels];
ssize_t actual = audio_utils_fifo_read(&(pSles->fifo2), buffer,
pSles->bufSizeInFrames);
if (actual <= 0)
break;
{
for (int jj = 0; jj < actual && currentSample < maxSamples; jj++) {
*(pCurrentSample++) = ((double) buffer[jj]) / maxValue;
currentSample++;
}
}
samplesRead += actual;
}
}
if (pSles->injectImpulse > 0) {
if (pSles->injectImpulse <= 100) {
pSles->injectImpulse = -1;
write(1, "I", 1);
} else {
if ((pSles->injectImpulse % 1000) < 100) {
write(1, "i", 1);
}
pSles->injectImpulse -= 100;
}
} else if (i == 9) {
write(1, ".", 1);
}
}
SLBufferQueueState playerBQState;
result = (*(pSles->playerBufferQueue))->GetState(pSles->playerBufferQueue,
&playerBQState);
ASSERT_EQ(SL_RESULT_SUCCESS, result);
SLAndroidSimpleBufferQueueState recorderBQState;
result = (*(pSles->recorderBufferQueue))->GetState(pSles->recorderBufferQueue,
&recorderBQState);
ASSERT_EQ(SL_RESULT_SUCCESS, result);
SLES_PRINTF("End of slesProcessNext: pSles = %p, samplesRead = %d, maxSamples = %d",
pSles, samplesRead, maxSamples);
}
return samplesRead;
}
int main(int argc, char **argv)
{
size_t frameCount = 256;
size_t maxFramesPerRead = 1;
size_t maxFramesPerWrite = 1;
int i;
for (i = 1; i < argc; i++) {
char *arg = argv[i];
if (arg[0] != '-')
break;
switch (arg[1]) {
case 'c': // FIFO frame count
frameCount = atoi(&arg[2]);
break;
case 'r': // maximum frame count per read from FIFO
maxFramesPerRead = atoi(&arg[2]);
break;
case 'w': // maximum frame count per write to FIFO
maxFramesPerWrite = atoi(&arg[2]);
break;
default:
fprintf(stderr, "%s: unknown option %s\n", argv[0], arg);
goto usage;
}
}
if (argc - i != 2) {
usage:
fprintf(stderr, "usage: %s [-c#] in.wav out.wav\n", argv[0]);
return EXIT_FAILURE;
}
char *inputFile = argv[i];
char *outputFile = argv[i+1];
SF_INFO sfinfoin;
memset(&sfinfoin, 0, sizeof(sfinfoin));
SNDFILE *sfin = sf_open(inputFile, SFM_READ, &sfinfoin);
if (sfin == NULL) {
perror(inputFile);
return EXIT_FAILURE;
}
// sf_readf_short() does conversion, so not strictly necessary to check the file format.
// But I want to do "cmp" on input and output files afterwards,
// and it is easier if they are all the same format.
// Enforcing that everything is 16-bit is convenient for this.
if ((sfinfoin.format & (SF_FORMAT_TYPEMASK | SF_FORMAT_SUBMASK)) !=
(SF_FORMAT_WAV | SF_FORMAT_PCM_16)) {
fprintf(stderr, "%s: unsupported format\n", inputFile);
sf_close(sfin);
return EXIT_FAILURE;
}
size_t frameSize = sizeof(short) * sfinfoin.channels;
short *inputBuffer = new short[sfinfoin.frames * sfinfoin.channels];
sf_count_t actualRead = sf_readf_short(sfin, inputBuffer, sfinfoin.frames);
if (actualRead != sfinfoin.frames) {
fprintf(stderr, "%s: unexpected EOF or error\n", inputFile);
sf_close(sfin);
return EXIT_FAILURE;
}
sf_close(sfin);
short *outputBuffer = new short[sfinfoin.frames * sfinfoin.channels];
size_t framesWritten = 0;
size_t framesRead = 0;
struct audio_utils_fifo fifo;
short *fifoBuffer = new short[frameCount * sfinfoin.channels];
audio_utils_fifo_init(&fifo, frameCount, frameSize, fifoBuffer);
int fifoWriteCount = 0, fifoReadCount = 0;
int fifoFillLevel = 0, minFillLevel = INT_MAX, maxFillLevel = INT_MIN;
for (;;) {
size_t framesToWrite = sfinfoin.frames - framesWritten;
size_t framesToRead = sfinfoin.frames - framesRead;
if (framesToWrite == 0 && framesToRead == 0) {
break;
}
if (framesToWrite > maxFramesPerWrite) {
framesToWrite = maxFramesPerWrite;
}
framesToWrite = rand() % (framesToWrite + 1);
ssize_t actualWritten = audio_utils_fifo_write(&fifo,
&inputBuffer[framesWritten * sfinfoin.channels], framesToWrite);
if (actualWritten < 0 || (size_t) actualWritten > framesToWrite) {
fprintf(stderr, "write to FIFO failed\n");
break;
}
framesWritten += actualWritten;
if (actualWritten > 0) {
fifoWriteCount++;
}
fifoFillLevel += actualWritten;
if (fifoFillLevel > maxFillLevel) {
maxFillLevel = fifoFillLevel;
if (maxFillLevel > (int) frameCount)
abort();
}
if (framesToRead > maxFramesPerRead) {
framesToRead = maxFramesPerRead;
}
framesToRead = rand() % (framesToRead + 1);
ssize_t actualRead = audio_utils_fifo_read(&fifo,
&outputBuffer[framesRead * sfinfoin.channels], framesToRead);
if (actualRead < 0 || (size_t) actualRead > framesToRead) {
fprintf(stderr, "read from FIFO failed\n");
break;
}
framesRead += actualRead;
if (actualRead > 0) {
fifoReadCount++;
}
fifoFillLevel -= actualRead;
if (fifoFillLevel < minFillLevel) {
minFillLevel = fifoFillLevel;
if (minFillLevel < 0)
abort();
}
}
printf("FIFO non-empty writes: %d, non-empty reads: %d\n", fifoWriteCount, fifoReadCount);
printf("fill=%d, min=%d, max=%d\n", fifoFillLevel, minFillLevel, maxFillLevel);
audio_utils_fifo_deinit(&fifo);
delete[] fifoBuffer;
SF_INFO sfinfoout;
memset(&sfinfoout, 0, sizeof(sfinfoout));
sfinfoout.samplerate = sfinfoin.samplerate;
sfinfoout.channels = sfinfoin.channels;
sfinfoout.format = sfinfoin.format;
SNDFILE *sfout = sf_open(outputFile, SFM_WRITE, &sfinfoout);
if (sfout == NULL) {
perror(outputFile);
return EXIT_FAILURE;
}
sf_count_t actualWritten = sf_writef_short(sfout, outputBuffer, framesRead);
delete[] inputBuffer;
delete[] outputBuffer;
delete[] fifoBuffer;
if (actualWritten != (sf_count_t) framesRead) {
fprintf(stderr, "%s: unexpected error\n", outputFile);
sf_close(sfout);
return EXIT_FAILURE;
}
sf_close(sfout);
return EXIT_SUCCESS;
}
