pcas/src/ca/comBuf.cpp

/*************************************************************************\
* Copyright (c) 2002 The University of Chicago, as Operator of Argonne
*     National Laboratory.
* Copyright (c) 2002 The Regents of the University of California, as
*     Operator of Los Alamos National Laboratory.
* EPICS BASE Versions 3.13.7
* and higher are distributed subject to a Software License Agreement found
* in file LICENSE that is included with this distribution. 
\*************************************************************************/
/*  
 *  $Id$
 *
 *                              
 *                    L O S  A L A M O S
 *              Los Alamos National Laboratory
 *               Los Alamos, New Mexico 87545
 *                                  
 *  Copyright, 1986, The Regents of the University of California.
 *                                  
 *           
 *	Author Jeffrey O. Hill
 *	johill@lanl.gov
 */

#include <stdexcept>

#define epicsAssertAuthor "Jeff Hill johill@lanl.gov"

#include "comBuf.h"
#include "errlog.h"

bool comBuf::flushToWire ( wireSendAdapter & wire, const epicsTime & currentTime )
{
    unsigned index = this->nextReadIndex;
    unsigned finalIndex = this->commitIndex;
    while ( index < finalIndex ) {
        unsigned nBytes = wire.sendBytes ( 
            &this->buf[index], finalIndex - index, currentTime );
        if ( nBytes == 0u ) {
            this->nextReadIndex = index;
            return false;
        }
        index += nBytes;
    }
    this->nextReadIndex = index;
    return true;
}

unsigned comBuf::push ( const epicsInt16 * pValue, unsigned nElem )
{
    unsigned index = this->nextWriteIndex;
    unsigned available = sizeof ( this->buf ) - index;
    unsigned nBytes = sizeof ( *pValue ) * nElem;
    if ( nBytes > available ) {
        nElem = available / sizeof ( *pValue );
    }
    for ( unsigned i = 0u; i < nElem; i++ ) {
        this->buf[ index + 0 ] = 
            static_cast < epicsUInt8 > ( pValue[i] >> 8u );
        this->buf[ index + 1 ] = 
            static_cast < epicsUInt8 > ( pValue[i] >> 0u );
        index += sizeof ( *pValue );
    }
    this->nextWriteIndex = index;
    return nElem;
}

unsigned comBuf::push ( const epicsUInt16 * pValue, unsigned nElem )
{
    unsigned index = this->nextWriteIndex;
    unsigned available = sizeof ( this->buf ) - index;
    unsigned nBytes = sizeof ( *pValue ) * nElem;
    if ( nBytes > available ) {
        nElem = available / sizeof ( *pValue );
    }
    for ( unsigned i = 0u; i < nElem; i++ ) {
        this->buf[ index + 0 ] = 
            static_cast < epicsUInt8 > ( pValue[i] >> 8u );
        this->buf[ index + 1 ] = 
            static_cast < epicsUInt8 > ( pValue[i] >> 0u );
        index += sizeof ( *pValue );
    }
    this->nextWriteIndex = index;
    return nElem;
}

unsigned comBuf::push ( const epicsInt32 * pValue, unsigned nElem )
{
    unsigned index = this->nextWriteIndex;
    unsigned available = sizeof ( this->buf ) - index;
    unsigned nBytes = sizeof ( *pValue ) * nElem;
    if ( nBytes > available ) {
        nElem = available / sizeof ( *pValue );
    }
    for ( unsigned i = 0u; i < nElem; i++ ) {
        this->buf[ index + 0 ] = 
            static_cast < epicsUInt8 > ( pValue[i] >> 24u );
        this->buf[ index + 1 ] = 
            static_cast < epicsUInt8 > ( pValue[i] >> 16u );
        this->buf[ index + 2 ] = 
            static_cast < epicsUInt8 > ( pValue[i] >> 8u );
        this->buf[ index + 3 ] = 
            static_cast < epicsUInt8 > ( pValue[i] >> 0u );
        index += sizeof ( *pValue );
    }
    this->nextWriteIndex = index;
    return nElem;
}

unsigned comBuf::push ( const epicsUInt32 * pValue, unsigned nElem )
{
    unsigned index = this->nextWriteIndex;
    unsigned available = sizeof ( this->buf ) - index;
    unsigned nBytes = sizeof ( *pValue ) * nElem;
    if ( nBytes > available ) {
        nElem = available / sizeof ( *pValue );
    }
    for ( unsigned i = 0u; i < nElem; i++ ) {
        this->buf[ index + 0 ] = 
            static_cast < epicsUInt8 > ( pValue[i] >> 24u );
        this->buf[ index + 1 ] = 
            static_cast < epicsUInt8 > ( pValue[i] >> 16u );
        this->buf[ index + 2 ] = 
            static_cast < epicsUInt8 > ( pValue[i] >> 8u );
        this->buf[ index + 3 ] = 
            static_cast < epicsUInt8 > ( pValue[i] >> 0u );
        index += sizeof ( *pValue );
    }
    this->nextWriteIndex = index;
    return nElem;
}

unsigned comBuf::push ( const epicsFloat32 * pValue, unsigned nElem )
{
    unsigned index = this->nextWriteIndex;
    unsigned available = sizeof ( this->buf ) - index;
    unsigned nBytes = sizeof ( *pValue ) * nElem;
    if ( nBytes > available ) {
        nElem = available / sizeof ( *pValue );
    }
    for ( unsigned i = 0u; i < nElem; i++ ) {
        // allow native floating point formats to be converted to IEEE
        osiConvertToWireFormat ( pValue[i], &this->buf[index] );
        index += sizeof ( *pValue );
    }
    this->nextWriteIndex = index;
    return nElem;
}

unsigned comBuf::push ( const epicsFloat64 * pValue, unsigned nElem )
{
    unsigned index = this->nextWriteIndex;
    unsigned available = sizeof ( this->buf ) - index;
    unsigned nBytes = sizeof ( *pValue ) * nElem;
    if ( nBytes > available ) {
        nElem = available / sizeof ( *pValue );
    }
    for ( unsigned i = 0u; i < nElem; i++ ) {
        // allow native floating point formats to be converted to IEEE
        osiConvertToWireFormat ( pValue[i], &this->buf[index] );
        index += sizeof ( *pValue );
    }
    this->nextWriteIndex = index;
    return nElem;
}

// throwing the exception from a function that isnt inline 
// shrinks the GNU compiled object code
void comBuf::throwInsufficentBytesException () 
{
    throw comBuf::insufficentBytesAvailable ();
}

void comBuf::operator delete ( void * )
{
    // Visual C++ .net appears to require operator delete if
    // placement operator delete is defined? I smell a ms rat
    // because if I declare placement new and delete, but
    // comment out the placement delete definition there are
    // no undefined symbols.
    errlogPrintf ( "%s:%d this compiler is confused about placement delete - memory was probably leaked",
        __FILE__, __LINE__ );
}

comBufMemoryManager::~comBufMemoryManager () {}