git-svn-id: http://svn.freeswitch.org/svn/freeswitch/trunk@418 d0543943-73ff-0310-b7d9-9358b9ac24b2
This commit is contained in:
Anthony Minessale committed 2006-01-20 02:02:03 +00:00
1 parent 1e04eb13b5
commit 0ea203849f
43 files changed
+3940 -4103

No files matched your search

+140 -160
View File
@@ -32,188 +32,168 @@
* CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
* WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
*
*/
*/
#include <stdio.h>
#include <stdlib.h>
#include <math.h>
#include "ringbuffer.h"
#include <string.h>
/***************************************************************************
* Initialize FIFO.
* numBytes must be power of 2, returns -1 if not.
*/
long RingBuffer_Init(RingBuffer * rbuf, long numBytes, void *dataPtr)
{
␍if (((numBytes - 1) & numBytes) != 0)
return -1; /* Not Power of two. */
␍rbuf->bufferSize = numBytes;
␍rbuf->buffer = (char *) dataPtr;
␍RingBuffer_Flush(rbuf);
␍rbuf->bigMask = (numBytes * 2) - 1;
␍rbuf->smallMask = (numBytes) - 1;
␍return 0;
␍}
*/
long RingBuffer_Init( RingBuffer *rbuf, long numBytes, void *dataPtr )
{
if( ((numBytes-1) & numBytes) != 0) return -1; /* Not Power of two. */
rbuf->bufferSize = numBytes;
rbuf->buffer = (char *)dataPtr;
RingBuffer_Flush( rbuf );
rbuf->bigMask = (numBytes*2)-1;
rbuf->smallMask = (numBytes)-1;
return 0;
}
/***************************************************************************
** Return number of bytes available for reading. */
long RingBuffer_GetReadAvailable( RingBuffer *rbuf )
{
return ( (rbuf->writeIndex - rbuf->readIndex) & rbuf->bigMask );
}
/***************************************************************************
** Return number of bytes available for writing. */
long RingBuffer_GetWriteAvailable( RingBuffer *rbuf )
{
return ( rbuf->bufferSize - RingBuffer_GetReadAvailable(rbuf));
}
/***************************************************************************
** Return number of bytes available for reading. */
long RingBuffer_GetReadAvailable(RingBuffer * rbuf)
{
␍return ((rbuf->writeIndex - rbuf->readIndex) & rbuf->bigMask);
␍}
** Clear buffer. Should only be called when buffer is NOT being read. */
void RingBuffer_Flush( RingBuffer *rbuf )
{
rbuf->writeIndex = rbuf->readIndex = 0;
}
/***************************************************************************
** Return number of bytes available for writing. */
long RingBuffer_GetWriteAvailable(RingBuffer * rbuf)
{
␍return (rbuf->bufferSize - RingBuffer_GetReadAvailable(rbuf));
␍}
␍
/***************************************************************************
** Clear buffer. Should only be called when buffer is NOT being read. */
void RingBuffer_Flush(RingBuffer * rbuf)
{
␍rbuf->writeIndex = rbuf->readIndex = 0;
␍} ␍
/***************************************************************************
** Get address of region(s) to which we can write data.
** If the region is contiguous, size2 will be zero.
** If non-contiguous, size2 will be the size of second region.
** Returns room available to be written or numBytes, whichever is smaller.
*/
long RingBuffer_GetWriteRegions(RingBuffer * rbuf, long numBytes, ␍void **dataPtr1, long *sizePtr1, ␍void **dataPtr2,
long *sizePtr2)
{
␍long index;
␍long available = RingBuffer_GetWriteAvailable(rbuf);
␍if (numBytes > available)
numBytes = available;
/* Check to see if write is not contiguous. */
index = rbuf->writeIndex & rbuf->smallMask;
␍if ((index + numBytes) > rbuf->bufferSize)
␍ {
/* Write data in two blocks that wrap the buffer. */
long firstHalf = rbuf->bufferSize - index;
␍*dataPtr1 = &rbuf->buffer[index];
␍*sizePtr1 = firstHalf;
␍*dataPtr2 = &rbuf->buffer[0];
␍*sizePtr2 = numBytes - firstHalf;
␍}
else
␍ {
␍*dataPtr1 = &rbuf->buffer[index];
␍*sizePtr1 = numBytes;
␍*dataPtr2 = NULL;
␍*sizePtr2 = 0;
␍}
␍return numBytes;
␍}
␍␍
*/
long RingBuffer_GetWriteRegions( RingBuffer *rbuf, long numBytes,
void **dataPtr1, long *sizePtr1,
void **dataPtr2, long *sizePtr2 )
{
long index;
long available = RingBuffer_GetWriteAvailable( rbuf );
if( numBytes > available ) numBytes = available;
/* Check to see if write is not contiguous. */
index = rbuf->writeIndex & rbuf->smallMask;
if( (index + numBytes) > rbuf->bufferSize )
{
/* Write data in two blocks that wrap the buffer. */
long firstHalf = rbuf->bufferSize - index;
*dataPtr1 = &rbuf->buffer[index];
*sizePtr1 = firstHalf;
*dataPtr2 = &rbuf->buffer[0];
*sizePtr2 = numBytes - firstHalf;
}
else
{
*dataPtr1 = &rbuf->buffer[index];
*sizePtr1 = numBytes;
*dataPtr2 = NULL;
*sizePtr2 = 0;
}
return numBytes;
}
/***************************************************************************
*/
long RingBuffer_AdvanceWriteIndex(RingBuffer * rbuf, long numBytes)
{
␍return rbuf->writeIndex = (rbuf->writeIndex + numBytes) & rbuf->bigMask;
␍}
␍
*/
long RingBuffer_AdvanceWriteIndex( RingBuffer *rbuf, long numBytes )
{
return rbuf->writeIndex = (rbuf->writeIndex + numBytes) & rbuf->bigMask;
}
/***************************************************************************
** Get address of region(s) from which we can read data.
** If the region is contiguous, size2 will be zero.
** If non-contiguous, size2 will be the size of second region.
** Returns room available to be written or numBytes, whichever is smaller.
*/
long RingBuffer_GetReadRegions(RingBuffer * rbuf, long numBytes, ␍void **dataPtr1, long *sizePtr1, ␍void **dataPtr2,
long *sizePtr2)
{
␍long index;
␍long available = RingBuffer_GetReadAvailable(rbuf);
␍if (numBytes > available)
numBytes = available;
/* Check to see if read is not contiguous. */
index = rbuf->readIndex & rbuf->smallMask;
␍if ((index + numBytes) > rbuf->bufferSize)
␍ {
/* Write data in two blocks that wrap the buffer. */
long firstHalf = rbuf->bufferSize - index;
␍*dataPtr1 = &rbuf->buffer[index];
␍*sizePtr1 = firstHalf;
␍*dataPtr2 = &rbuf->buffer[0];
␍*sizePtr2 = numBytes - firstHalf;
␍}
else
␍ {
␍*dataPtr1 = &rbuf->buffer[index];
␍*sizePtr1 = numBytes;
␍*dataPtr2 = NULL;
␍*sizePtr2 = 0;
␍}
␍return numBytes;
␍}
*/
long RingBuffer_GetReadRegions( RingBuffer *rbuf, long numBytes,
void **dataPtr1, long *sizePtr1,
void **dataPtr2, long *sizePtr2 )
{
long index;
long available = RingBuffer_GetReadAvailable( rbuf );
if( numBytes > available ) numBytes = available;
/* Check to see if read is not contiguous. */
index = rbuf->readIndex & rbuf->smallMask;
if( (index + numBytes) > rbuf->bufferSize )
{
/* Write data in two blocks that wrap the buffer. */
long firstHalf = rbuf->bufferSize - index;
*dataPtr1 = &rbuf->buffer[index];
*sizePtr1 = firstHalf;
*dataPtr2 = &rbuf->buffer[0];
*sizePtr2 = numBytes - firstHalf;
}
else
{
*dataPtr1 = &rbuf->buffer[index];
*sizePtr1 = numBytes;
*dataPtr2 = NULL;
*sizePtr2 = 0;
}
return numBytes;
}
/***************************************************************************
*/
long RingBuffer_AdvanceReadIndex( RingBuffer *rbuf, long numBytes )
{
return rbuf->readIndex = (rbuf->readIndex + numBytes) & rbuf->bigMask;
}
/***************************************************************************
*/
long RingBuffer_AdvanceReadIndex(RingBuffer * rbuf, long numBytes)
{
␍return rbuf->readIndex = (rbuf->readIndex + numBytes) & rbuf->bigMask;
␍}
␍
/***************************************************************************
** Return bytes written. */
long RingBuffer_Write(RingBuffer * rbuf, void *data, long numBytes)
{
␍long size1, size2, numWritten;
␍void *data1, *data2;
␍numWritten = RingBuffer_GetWriteRegions(rbuf, numBytes, &data1, &size1, &data2, &size2);
␍if (size2 > 0)
␍ {
␍␍memcpy(data1, data, size1);
␍data = ((char *) data) + size1;
␍memcpy(data2, data, size2);
␍}
else
␍ {
␍memcpy(data1, data, size1);
␍}
␍RingBuffer_AdvanceWriteIndex(rbuf, numWritten);
␍return numWritten;
␍}
␍
/***************************************************************************
** Return bytes read. */
long RingBuffer_Read(RingBuffer * rbuf, void *data, long numBytes)
{
␍long size1, size2, numRead;
␍void *data1, *data2;
␍numRead = RingBuffer_GetReadRegions(rbuf, numBytes, &data1, &size1, &data2, &size2);
␍if (size2 > 0)
␍ {
␍memcpy(data, data1, size1);
␍data = ((char *) data) + size1;
␍memcpy(data, data2, size2);
␍}
else
␍ {
␍memcpy(data, data1, size1);
␍}
␍RingBuffer_AdvanceReadIndex(rbuf, numRead);
␍return numRead;
␍}
** Return bytes written. */
long RingBuffer_Write( RingBuffer *rbuf, void *data, long numBytes )
{
long size1, size2, numWritten;
void *data1, *data2;
numWritten = RingBuffer_GetWriteRegions( rbuf, numBytes, &data1, &size1, &data2, &size2 );
if( size2 > 0 )
{
memcpy( data1, data, size1 );
data = ((char *)data) + size1;
memcpy( data2, data, size2 );
}
else
{
memcpy( data1, data, size1 );
}
RingBuffer_AdvanceWriteIndex( rbuf, numWritten );
return numWritten;
}
/***************************************************************************
** Return bytes read. */
long RingBuffer_Read( RingBuffer *rbuf, void *data, long numBytes )
{
long size1, size2, numRead;
void *data1, *data2;
numRead = RingBuffer_GetReadRegions( rbuf, numBytes, &data1, &size1, &data2, &size2 );
if( size2 > 0 )
{
memcpy( data, data1, size1 );
data = ((char *)data) + size1;
memcpy( data, data2, size2 );
}
else
{
memcpy( data, data1, size1 );
}
RingBuffer_AdvanceReadIndex( rbuf, numRead );
return numRead;
}