cannam@162: /*
cannam@162:  * $Id$
cannam@162:  * pablio.c
cannam@162:  * Portable Audio Blocking Input/Output utility.
cannam@162:  *
cannam@162:  * Author: Phil Burk, http://www.softsynth.com
cannam@162:  *
cannam@162:  * This program uses the PortAudio Portable Audio Library.
cannam@162:  * For more information see: http://www.portaudio.com
cannam@162:  * Copyright (c) 1999-2000 Ross Bencina and Phil Burk
cannam@162:  *
cannam@162:  * Permission is hereby granted, free of charge, to any person obtaining
cannam@162:  * a copy of this software and associated documentation files
cannam@162:  * (the "Software"), to deal in the Software without restriction,
cannam@162:  * including without limitation the rights to use, copy, modify, merge,
cannam@162:  * publish, distribute, sublicense, and/or sell copies of the Software,
cannam@162:  * and to permit persons to whom the Software is furnished to do so,
cannam@162:  * subject to the following conditions:
cannam@162:  *
cannam@162:  * The above copyright notice and this permission notice shall be
cannam@162:  * included in all copies or substantial portions of the Software.
cannam@162:  *
cannam@162:  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
cannam@162:  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
cannam@162:  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
cannam@162:  * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR
cannam@162:  * ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF
cannam@162:  * CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
cannam@162:  * WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
cannam@162:  */
cannam@162: 
cannam@162: /*
cannam@162:  * The text above constitutes the entire PortAudio license; however, 
cannam@162:  * the PortAudio community also makes the following non-binding requests:
cannam@162:  *
cannam@162:  * Any person wishing to distribute modifications to the Software is
cannam@162:  * requested to send the modifications to the original developer so that
cannam@162:  * they can be incorporated into the canonical version. It is also 
cannam@162:  * requested that these non-binding requests be included along with the 
cannam@162:  * license above.
cannam@162:  */
cannam@162: 
cannam@162: #include <stdio.h>
cannam@162: #include <stdlib.h>
cannam@162: #include <math.h>
cannam@162: #include "portaudio.h"
cannam@162: #include "pa_ringbuffer.h"
cannam@162: #include "pablio.h"
cannam@162: #include <string.h>
cannam@162: 
cannam@162: /************************************************************************/
cannam@162: /******** Constants *****************************************************/
cannam@162: /************************************************************************/
cannam@162: 
cannam@162: #define FRAMES_PER_BUFFER    (256)
cannam@162: 
cannam@162: /************************************************************************/
cannam@162: /******** Prototypes ****************************************************/
cannam@162: /************************************************************************/
cannam@162: 
cannam@162: static int blockingIOCallback( void *inputBuffer, void *outputBuffer,
cannam@162:                                unsigned long framesPerBuffer,
cannam@162:                                PaTimestamp outTime, void *userData );
cannam@162: static PaError PABLIO_InitFIFO( RingBuffer *rbuf, long numFrames, long bytesPerFrame );
cannam@162: static PaError PABLIO_TermFIFO( RingBuffer *rbuf );
cannam@162: 
cannam@162: /************************************************************************/
cannam@162: /******** Functions *****************************************************/
cannam@162: /************************************************************************/
cannam@162: 
cannam@162: /* Called from PortAudio.
cannam@162:  * Read and write data only if there is room in FIFOs.
cannam@162:  */
cannam@162: static int blockingIOCallback( void *inputBuffer, void *outputBuffer,
cannam@162:                                unsigned long framesPerBuffer,
cannam@162:                                PaTimestamp outTime, void *userData )
cannam@162: {
cannam@162:     PABLIO_Stream *data = (PABLIO_Stream*)userData;
cannam@162:     long numBytes = data->bytesPerFrame * framesPerBuffer;
cannam@162:     (void) outTime;
cannam@162: 
cannam@162:     /* This may get called with NULL inputBuffer during initial setup. */
cannam@162:     if( inputBuffer != NULL )
cannam@162:     {
cannam@162:         PaUtil_WriteRingBuffer( &data->inFIFO, inputBuffer, numBytes );
cannam@162:     }
cannam@162:     if( outputBuffer != NULL )
cannam@162:     {
cannam@162:         int i;
cannam@162:         int numRead = PaUtil_ReadRingBuffer( &data->outFIFO, outputBuffer, numBytes );
cannam@162:         /* Zero out remainder of buffer if we run out of data. */
cannam@162:         for( i=numRead; i<numBytes; i++ )
cannam@162:         {
cannam@162:             ((char *)outputBuffer)[i] = 0;
cannam@162:         }
cannam@162:     }
cannam@162: 
cannam@162:     return 0;
cannam@162: }
cannam@162: 
cannam@162: /* Allocate buffer. */
cannam@162: static PaError PABLIO_InitFIFO( RingBuffer *rbuf, long numFrames, long bytesPerFrame )
cannam@162: {
cannam@162:     long numBytes = numFrames * bytesPerFrame;
cannam@162:     char *buffer = (char *) malloc( numBytes );
cannam@162:     if( buffer == NULL ) return paInsufficientMemory;
cannam@162:     memset( buffer, 0, numBytes );
cannam@162:     return (PaError) PaUtil_InitializeRingBuffer( rbuf, numBytes, buffer );
cannam@162: }
cannam@162: 
cannam@162: /* Free buffer. */
cannam@162: static PaError PABLIO_TermFIFO( RingBuffer *rbuf )
cannam@162: {
cannam@162:     if( rbuf->buffer ) free( rbuf->buffer );
cannam@162:     rbuf->buffer = NULL;
cannam@162:     return paNoError;
cannam@162: }
cannam@162: 
cannam@162: /************************************************************
cannam@162:  * Write data to ring buffer.
cannam@162:  * Will not return until all the data has been written.
cannam@162:  */
cannam@162: long WriteAudioStream( PABLIO_Stream *aStream, void *data, long numFrames )
cannam@162: {
cannam@162:     long bytesWritten;
cannam@162:     char *p = (char *) data;
cannam@162:     long numBytes = aStream->bytesPerFrame * numFrames;
cannam@162:     while( numBytes > 0)
cannam@162:     {
cannam@162:         bytesWritten = PaUtil_WriteRingBuffer( &aStream->outFIFO, p, numBytes );
cannam@162:         numBytes -= bytesWritten;
cannam@162:         p += bytesWritten;
cannam@162:         if( numBytes > 0) Pa_Sleep(10);
cannam@162:     }
cannam@162:     return numFrames;
cannam@162: }
cannam@162: 
cannam@162: /************************************************************
cannam@162:  * Read data from ring buffer.
cannam@162:  * Will not return until all the data has been read.
cannam@162:  */
cannam@162: long ReadAudioStream( PABLIO_Stream *aStream, void *data, long numFrames )
cannam@162: {
cannam@162:     long bytesRead;
cannam@162:     char *p = (char *) data;
cannam@162:     long numBytes = aStream->bytesPerFrame * numFrames;
cannam@162:     while( numBytes > 0)
cannam@162:     {
cannam@162:         bytesRead = PaUtil_ReadRingBuffer( &aStream->inFIFO, p, numBytes );
cannam@162:         numBytes -= bytesRead;
cannam@162:         p += bytesRead;
cannam@162:         if( numBytes > 0) Pa_Sleep(10);
cannam@162:     }
cannam@162:     return numFrames;
cannam@162: }
cannam@162: 
cannam@162: /************************************************************
cannam@162:  * Return the number of frames that could be written to the stream without
cannam@162:  * having to wait.
cannam@162:  */
cannam@162: long GetAudioStreamWriteable( PABLIO_Stream *aStream )
cannam@162: {
cannam@162:     int bytesEmpty = PaUtil_GetRingBufferWriteAvailable( &aStream->outFIFO );
cannam@162:     return bytesEmpty / aStream->bytesPerFrame;
cannam@162: }
cannam@162: 
cannam@162: /************************************************************
cannam@162:  * Return the number of frames that are available to be read from the
cannam@162:  * stream without having to wait.
cannam@162:  */
cannam@162: long GetAudioStreamReadable( PABLIO_Stream *aStream )
cannam@162: {
cannam@162:     int bytesFull = PaUtil_GetRingBufferReadAvailable( &aStream->inFIFO );
cannam@162:     return bytesFull / aStream->bytesPerFrame;
cannam@162: }
cannam@162: 
cannam@162: /************************************************************/
cannam@162: static unsigned long RoundUpToNextPowerOf2( unsigned long n )
cannam@162: {
cannam@162:     long numBits = 0;
cannam@162:     if( ((n-1) & n) == 0) return n; /* Already Power of two. */
cannam@162:     while( n > 0 )
cannam@162:     {
cannam@162:         n= n>>1;
cannam@162:         numBits++;
cannam@162:     }
cannam@162:     return (1<<numBits);
cannam@162: }
cannam@162: 
cannam@162: /************************************************************
cannam@162:  * Opens a PortAudio stream with default characteristics.
cannam@162:  * Allocates PABLIO_Stream structure.
cannam@162:  *
cannam@162:  * flags parameter can be an ORed combination of:
cannam@162:  *    PABLIO_READ, PABLIO_WRITE, or PABLIO_READ_WRITE,
cannam@162:  *    and either PABLIO_MONO or PABLIO_STEREO
cannam@162:  */
cannam@162: PaError OpenAudioStream( PABLIO_Stream **rwblPtr, double sampleRate,
cannam@162:                          PaSampleFormat format, long flags )
cannam@162: {
cannam@162:     long   bytesPerSample;
cannam@162:     long   doRead = 0;
cannam@162:     long   doWrite = 0;
cannam@162:     PaError err;
cannam@162:     PABLIO_Stream *aStream;
cannam@162:     long   minNumBuffers;
cannam@162:     long   numFrames;
cannam@162: 
cannam@162:     /* Allocate PABLIO_Stream structure for caller. */
cannam@162:     aStream = (PABLIO_Stream *) malloc( sizeof(PABLIO_Stream) );
cannam@162:     if( aStream == NULL ) return paInsufficientMemory;
cannam@162:     memset( aStream, 0, sizeof(PABLIO_Stream) );
cannam@162: 
cannam@162:     /* Determine size of a sample. */
cannam@162:     bytesPerSample = Pa_GetSampleSize( format );
cannam@162:     if( bytesPerSample < 0 )
cannam@162:     {
cannam@162:         err = (PaError) bytesPerSample;
cannam@162:         goto error;
cannam@162:     }
cannam@162:     aStream->samplesPerFrame = ((flags&PABLIO_MONO) != 0) ? 1 : 2;
cannam@162:     aStream->bytesPerFrame = bytesPerSample * aStream->samplesPerFrame;
cannam@162: 
cannam@162:     /* Initialize PortAudio  */
cannam@162:     err = Pa_Initialize();
cannam@162:     if( err != paNoError ) goto error;
cannam@162: 
cannam@162:     /* Warning: numFrames must be larger than amount of data processed per interrupt
cannam@162:      *    inside PA to prevent glitches. Just to be safe, adjust size upwards.
cannam@162:      */
cannam@162:     minNumBuffers = 2 * Pa_GetMinNumBuffers( FRAMES_PER_BUFFER, sampleRate );
cannam@162:     numFrames = minNumBuffers * FRAMES_PER_BUFFER;
cannam@162:     numFrames = RoundUpToNextPowerOf2( numFrames );
cannam@162: 
cannam@162:     /* Initialize Ring Buffers */
cannam@162:     doRead = ((flags & PABLIO_READ) != 0);
cannam@162:     doWrite = ((flags & PABLIO_WRITE) != 0);
cannam@162:     if(doRead)
cannam@162:     {
cannam@162:         err = PABLIO_InitFIFO( &aStream->inFIFO, numFrames, aStream->bytesPerFrame );
cannam@162:         if( err != paNoError ) goto error;
cannam@162:     }
cannam@162:     if(doWrite)
cannam@162:     {
cannam@162:         long numBytes;
cannam@162:         err = PABLIO_InitFIFO( &aStream->outFIFO, numFrames, aStream->bytesPerFrame );
cannam@162:         if( err != paNoError ) goto error;
cannam@162:         /* Make Write FIFO appear full initially. */
cannam@162:         numBytes = PaUtil_GetRingBufferWriteAvailable( &aStream->outFIFO );
cannam@162:         PaUtil_AdvanceRingBufferWriteIndex( &aStream->outFIFO, numBytes );
cannam@162:     }
cannam@162: 
cannam@162:     /* Open a PortAudio stream that we will use to communicate with the underlying
cannam@162:      * audio drivers. */
cannam@162:     err = Pa_OpenStream(
cannam@162:               &aStream->stream,
cannam@162:               (doRead ? Pa_GetDefaultInputDeviceID() : paNoDevice),
cannam@162:               (doRead ? aStream->samplesPerFrame : 0 ),
cannam@162:               format,
cannam@162:               NULL,
cannam@162:               (doWrite ? Pa_GetDefaultOutputDeviceID() : paNoDevice),
cannam@162:               (doWrite ? aStream->samplesPerFrame : 0 ),
cannam@162:               format,
cannam@162:               NULL,
cannam@162:               sampleRate,
cannam@162:               FRAMES_PER_BUFFER,
cannam@162:               minNumBuffers,
cannam@162:               paClipOff,       /* we won't output out of range samples so don't bother clipping them */
cannam@162:               blockingIOCallback,
cannam@162:               aStream );
cannam@162:     if( err != paNoError ) goto error;
cannam@162: 
cannam@162:     err = Pa_StartStream( aStream->stream );
cannam@162:     if( err != paNoError ) goto error;
cannam@162: 
cannam@162:     *rwblPtr = aStream;
cannam@162:     return paNoError;
cannam@162: 
cannam@162: error:
cannam@162:     CloseAudioStream( aStream );
cannam@162:     *rwblPtr = NULL;
cannam@162:     return err;
cannam@162: }
cannam@162: 
cannam@162: /************************************************************/
cannam@162: PaError CloseAudioStream( PABLIO_Stream *aStream )
cannam@162: {
cannam@162:     PaError err;
cannam@162:     int bytesEmpty;
cannam@162:     int byteSize = aStream->outFIFO.bufferSize;
cannam@162: 
cannam@162:     /* If we are writing data, make sure we play everything written. */
cannam@162:     if( byteSize > 0 )
cannam@162:     {
cannam@162:         bytesEmpty = PaUtil_GetRingBufferWriteAvailable( &aStream->outFIFO );
cannam@162:         while( bytesEmpty < byteSize )
cannam@162:         {
cannam@162:             Pa_Sleep( 10 );
cannam@162:             bytesEmpty = PaUtil_GetRingBufferWriteAvailable( &aStream->outFIFO );
cannam@162:         }
cannam@162:     }
cannam@162: 
cannam@162:     err = Pa_StopStream( aStream->stream );
cannam@162:     if( err != paNoError ) goto error;
cannam@162:     err = Pa_CloseStream( aStream->stream );
cannam@162:     if( err != paNoError ) goto error;
cannam@162:     Pa_Terminate();
cannam@162: 
cannam@162: error:
cannam@162:     PABLIO_TermFIFO( &aStream->inFIFO );
cannam@162:     PABLIO_TermFIFO( &aStream->outFIFO );
cannam@162:     free( aStream );
cannam@162:     return err;
cannam@162: }