cmSerialPort.h/c : Initial commit.
This commit is contained in:
kevin.larke
parent
e0a683e8b1
commit
575db4382d
562
cmSerialPort.c
Normal file
562
cmSerialPort.c
Normal file
@ -0,0 +1,562 @@
|
|||||||
|
#include "cmPrefix.h"
|
||||||
|
#include "cmGlobal.h"
|
||||||
|
#include "cmRpt.h"
|
||||||
|
#include "cmErr.h"
|
||||||
|
#include "cmCtx.h"
|
||||||
|
#include "cmMem.h"
|
||||||
|
#include "cmMallocDebug.h"
|
||||||
|
#include "cmSerialPort.h"
|
||||||
|
#include "cmThread.h"
|
||||||
|
|
||||||
|
#include <poll.h>
|
||||||
|
#include <termios.h>
|
||||||
|
#include <unistd.h> // close()
|
||||||
|
#include <fcntl.h> // O_RDWR
|
||||||
|
#include <sys/ioctl.h> // TIOCEXCL
|
||||||
|
|
||||||
|
typedef struct cmSerialPort_str
|
||||||
|
{
|
||||||
|
cmErr_t _err;
|
||||||
|
cmThreadH_t _thH;
|
||||||
|
const char* _deviceStr;
|
||||||
|
int _deviceH;
|
||||||
|
unsigned _baudRate;
|
||||||
|
unsigned _cfgFlags;
|
||||||
|
cmSeCallbackFunc_t _cbFunc;
|
||||||
|
void* _cbArg;
|
||||||
|
struct termios _ttyAttrs;
|
||||||
|
struct pollfd _pollfd;
|
||||||
|
unsigned _pollPeriodMs;
|
||||||
|
} cmSerialPort_t;
|
||||||
|
|
||||||
|
cmSerialPort_t* _cmSePtrFromHandle( cmSeH_t h )
|
||||||
|
{
|
||||||
|
cmSerialPort_t* p = (cmSerialPort_t*)h.h;
|
||||||
|
assert(p!=NULL);
|
||||||
|
return p;
|
||||||
|
}
|
||||||
|
|
||||||
|
void _cmSeSetClosedState( cmSerialPort_t* p )
|
||||||
|
{
|
||||||
|
if( p->_deviceStr != NULL )
|
||||||
|
cmMemFree((char*)(p->_deviceStr));
|
||||||
|
|
||||||
|
p->_deviceH = -1;
|
||||||
|
p->_deviceStr = NULL;
|
||||||
|
p->_baudRate = 0;
|
||||||
|
p->_cfgFlags = 0;
|
||||||
|
p->_cbFunc = NULL;
|
||||||
|
p->_cbArg = NULL;
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
cmSeRC_t _cmSeGetAttributes( cmSerialPort_t* p, struct termios* attr )
|
||||||
|
{
|
||||||
|
if( tcgetattr(p->_deviceH, attr) == -1 )
|
||||||
|
return cmErrSysMsg(&p->_err,kGetAttrFailSeRC,errno,"Error getting tty attributes from %s.",p->_deviceStr);
|
||||||
|
|
||||||
|
return kOkSeRC;
|
||||||
|
}
|
||||||
|
|
||||||
|
cmSeRC_t _cmSePoll( cmSerialPort_t* p, unsigned timeOutMs )
|
||||||
|
{
|
||||||
|
cmSeRC_t rc = kOkSeRC;
|
||||||
|
int sysRC;
|
||||||
|
|
||||||
|
if((sysRC = poll(&p->_pollfd,1,timeOutMs)) == 0)
|
||||||
|
rc = kTimeOutSeRC;
|
||||||
|
else
|
||||||
|
{
|
||||||
|
if( sysRC < 0 )
|
||||||
|
rc = cmErrSysMsg(&p->_err,kReadFailSeRC,errno,"Poll failed on serial port.");
|
||||||
|
}
|
||||||
|
|
||||||
|
return rc;
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
bool _cmSeThreadFunc(void* param)
|
||||||
|
{
|
||||||
|
cmSerialPort_t* p = (cmSerialPort_t*)param;
|
||||||
|
cmSeH_t h;
|
||||||
|
h.h = p;
|
||||||
|
unsigned readN;
|
||||||
|
if( cmSeIsOpen(h) )
|
||||||
|
cmSeReceiveCbTimeOut(h,p->_pollPeriodMs,&readN);
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
cmSeRC_t _cmSeDestroy( cmSerialPort_t* p )
|
||||||
|
{
|
||||||
|
cmSeRC_t rc = kOkSeRC;
|
||||||
|
|
||||||
|
|
||||||
|
// stop the thread first
|
||||||
|
if( cmThreadDestroy(&p->_thH) != kOkThRC )
|
||||||
|
{
|
||||||
|
rc = cmErrMsg(&p->_err,kThreadErrSeRC,"Thread destroy failed.");
|
||||||
|
goto errLabel;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Block until all written output has been sent from the device.
|
||||||
|
// Note that this call is simply passed on to the serial device driver.
|
||||||
|
// See tcsendbreak(3) ("man 3 tcsendbreak") for details.
|
||||||
|
if (tcdrain(p->_deviceH) == -1)
|
||||||
|
{
|
||||||
|
rc = cmErrSysMsg(&p->_err,kFlushFailSeRC,errno,"Error waiting for serial device '%s' to drain.", p->_deviceStr );
|
||||||
|
goto errLabel;
|
||||||
|
}
|
||||||
|
|
||||||
|
// It is good practice to reset a serial port back to the state in
|
||||||
|
// which you found it. This is why we saved the original termios struct
|
||||||
|
// The constant TCSANOW (defined in termios.h) indicates that
|
||||||
|
// the change should take effect immediately.
|
||||||
|
|
||||||
|
if (tcsetattr(p->_deviceH, TCSANOW, &p->_ttyAttrs) == -1)
|
||||||
|
{
|
||||||
|
rc = cmErrSysMsg(&p->_err,kSetAttrFailSeRC,errno,"Error resetting tty attributes on serial device '%s'.",p->_deviceStr);
|
||||||
|
goto errLabel;
|
||||||
|
}
|
||||||
|
|
||||||
|
if( p->_deviceH != -1 )
|
||||||
|
{
|
||||||
|
if( close(p->_deviceH ) != 0 )
|
||||||
|
{
|
||||||
|
rc = cmErrSysMsg(&p->_err,kCloseFailSeRC,errno,"Port close failed on serial dvice '%s'.", p->_deviceStr);
|
||||||
|
goto errLabel;
|
||||||
|
}
|
||||||
|
|
||||||
|
_cmSeSetClosedState(p);
|
||||||
|
}
|
||||||
|
|
||||||
|
cmMemPtrFree(&p);
|
||||||
|
|
||||||
|
errLabel:
|
||||||
|
return rc;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
cmSeH_t cmSeCreate( cmCtx_t* ctx, cmSeH_t* hp, const char* deviceStr, unsigned baudRate, unsigned cfgFlags, cmSeCallbackFunc_t cbFunc, void* cbArg, unsigned pollPeriodMs )
|
||||||
|
{
|
||||||
|
cmSeRC_t rc = kOkSeRC;
|
||||||
|
struct termios options;
|
||||||
|
cmSeH_t h;
|
||||||
|
|
||||||
|
// if the port is already open then close it
|
||||||
|
if((rc = cmSeDestroy(hp)) != kOkSeRC )
|
||||||
|
return *hp;
|
||||||
|
|
||||||
|
cmSerialPort_t* p = cmMemAllocZ(cmSerialPort_t,1);
|
||||||
|
|
||||||
|
cmErrSetup(&p->_err,&ctx->rpt,"Serial Port");
|
||||||
|
|
||||||
|
p->_deviceH = -1;
|
||||||
|
|
||||||
|
// open the port
|
||||||
|
if( (p->_deviceH = open(deviceStr, O_RDWR | O_NOCTTY | O_NONBLOCK)) == -1 )
|
||||||
|
{
|
||||||
|
rc = cmErrSysMsg(&p->_err,kOpenFailSeRC,errno,"Error opening serial '%s'",cmStringNullGuard(deviceStr));
|
||||||
|
goto errLabel;;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Note that open() follows POSIX semantics: multiple open() calls to
|
||||||
|
// the same file will succeed unless the TIOCEXCL ioctl is issued.
|
||||||
|
// This will prevent additional opens except by root-owned processes.
|
||||||
|
// See tty(4) ("man 4 tty") and ioctl(2) ("man 2 ioctl") for details.
|
||||||
|
|
||||||
|
if( ioctl(p->_deviceH, TIOCEXCL) == -1 )
|
||||||
|
{
|
||||||
|
rc = cmErrSysMsg(&p->_err,kResourceNotAvailableSeRC,errno,"The serial device '%s' is already in use.", cmStringNullGuard(deviceStr));
|
||||||
|
goto errLabel;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
// Now that the device is open, clear the O_NONBLOCK flag so
|
||||||
|
// subsequent I/O will block.
|
||||||
|
// See fcntl(2) ("man 2 fcntl") for details.
|
||||||
|
/*
|
||||||
|
if (fcntl(_deviceH, F_SETFL, 0) == -1)
|
||||||
|
|
||||||
|
{
|
||||||
|
_error("Error clearing O_NONBLOCK %s - %s(%d).", pr.devFilePath.c_str(), strerror(errno), errno);
|
||||||
|
goto errLabel;
|
||||||
|
}
|
||||||
|
*/
|
||||||
|
|
||||||
|
// Get the current options and save them so we can restore the
|
||||||
|
// default settings later.
|
||||||
|
if (tcgetattr(p->_deviceH, &p->_ttyAttrs) == -1)
|
||||||
|
{
|
||||||
|
rc = cmErrSysMsg(&p->_err,kGetAttrFailSeRC,errno,"Error getting tty attributes from the device '%s'.",deviceStr);
|
||||||
|
goto errLabel;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
// The serial port attributes such as timeouts and baud rate are set by
|
||||||
|
// modifying the termios structure and then calling tcsetattr to
|
||||||
|
// cause the changes to take effect. Note that the
|
||||||
|
// changes will not take effect without the tcsetattr() call.
|
||||||
|
// See tcsetattr(4) ("man 4 tcsetattr") for details.
|
||||||
|
options = p->_ttyAttrs;
|
||||||
|
|
||||||
|
|
||||||
|
// Set raw input (non-canonical) mode, with reads blocking until either
|
||||||
|
// a single character has been received or a 100ms timeout expires.
|
||||||
|
// See tcsetattr(4) ("man 4 tcsetattr") and termios(4) ("man 4 termios")
|
||||||
|
// for details.
|
||||||
|
cfmakeraw(&options);
|
||||||
|
options.c_cc[VMIN] = 1;
|
||||||
|
options.c_cc[VTIME] = 1;
|
||||||
|
|
||||||
|
|
||||||
|
// The baud rate, word length, and handshake options can be set as follows:
|
||||||
|
|
||||||
|
|
||||||
|
// set baud rate
|
||||||
|
cfsetspeed(&options, baudRate);
|
||||||
|
|
||||||
|
options.c_cflag |= CREAD | CLOCAL; // ignore modem controls
|
||||||
|
|
||||||
|
// set data word size
|
||||||
|
cmClrBits(options.c_cflag, CSIZE); // clear the word size bits
|
||||||
|
cmEnaBits(options.c_cflag, CS5, cmIsFlag(cfgFlags, kDataBits5SeFl));
|
||||||
|
cmEnaBits(options.c_cflag, CS6, cmIsFlag(cfgFlags, kDataBits6SeFl));
|
||||||
|
cmEnaBits(options.c_cflag, CS7, cmIsFlag(cfgFlags, kDataBits7SeFl));
|
||||||
|
cmEnaBits(options.c_cflag, CS8, cmIsFlag(cfgFlags, kDataBits8SeFl));
|
||||||
|
|
||||||
|
cmClrBits(options.c_cflag, PARENB); // assume no-parity
|
||||||
|
|
||||||
|
// if the odd or even parity flag is set
|
||||||
|
if( cmIsFlag( cfgFlags, kEvenParitySeFl) || cmIsFlag( cfgFlags, kOddParitySeFl ) )
|
||||||
|
{
|
||||||
|
cmSetBits(options.c_cflag, PARENB);
|
||||||
|
|
||||||
|
if( cmIsFlag(cfgFlags, kOddParitySeFl ) )
|
||||||
|
cmSetBits( options.c_cflag, PARODD);
|
||||||
|
}
|
||||||
|
|
||||||
|
// set two stop bits
|
||||||
|
cmEnaBits( options.c_cflag, CSTOPB, cmIsFlag(cfgFlags, k2StopBitSeFl));
|
||||||
|
|
||||||
|
|
||||||
|
// set hardware flow control
|
||||||
|
//cmEnaBits(options.c_cflag, CCTS_OFLOW, cmIsFlag(cfgFlags, kCTS_OutFlowCtlFl));
|
||||||
|
//cmEnaBits(options.c_cflag, CRTS_IFLOW, cmIsFlag(cfgFlags, kRTS_InFlowCtlFl));
|
||||||
|
//cmEnaBits(options.c_cflag, CDTR_IFLOW, cmIsFlag(cfgFlags, kDTR_InFlowCtlFl));
|
||||||
|
//cmEnaBits(options.c_cflag, CDSR_OFLOW, cmIsFlag(cfgFlags, kDSR_OutFlowCtlFl));
|
||||||
|
//cmEnaBits(options.c_cflag, CCAR_OFLOW, cmIsFlag(cfgFlags, kDCD_OutFlowCtlFl));
|
||||||
|
|
||||||
|
cmClrBits(options.c_cflag,CRTSCTS); // turn-off hardware flow control
|
||||||
|
|
||||||
|
// 7 bit words, enable even parity, CTS out ctl flow, RTS in ctl flow
|
||||||
|
// note: set PARODD and PARENB to enable odd parity)
|
||||||
|
//options.c_cflag |= (CS7 | PARENB | CCTS_OFLOW | CRTS_IFLOW );
|
||||||
|
|
||||||
|
// Cause the new options to take effect immediately.
|
||||||
|
if (tcsetattr(p->_deviceH, TCSANOW, &options) == -1)
|
||||||
|
{
|
||||||
|
|
||||||
|
rc = cmErrSysMsg(&p->_err,kSetAttrFailSeRC,errno,"Error setting tty attributes on serial device %.", deviceStr);
|
||||||
|
goto errLabel;
|
||||||
|
}
|
||||||
|
|
||||||
|
memset(&p->_pollfd,0,sizeof(p->_pollfd));
|
||||||
|
p->_pollfd.fd = p->_deviceH;
|
||||||
|
p->_pollfd.events = POLLIN;
|
||||||
|
|
||||||
|
p->_deviceStr = cmMemAllocStr( deviceStr );
|
||||||
|
p->_baudRate = baudRate;
|
||||||
|
p->_cfgFlags = cfgFlags;
|
||||||
|
p->_cbFunc = cbFunc;
|
||||||
|
p->_cbArg = cbArg;
|
||||||
|
p->_pollPeriodMs = pollPeriodMs;
|
||||||
|
|
||||||
|
// create the listening thread
|
||||||
|
if( cmThreadCreate( &p->_thH, _cmSeThreadFunc, p, &ctx->rpt) != kOkThRC )
|
||||||
|
{
|
||||||
|
rc = cmErrMsg(&p->_err,kThreadErrSeRC,"Thread initialization failed.");
|
||||||
|
goto errLabel;
|
||||||
|
}
|
||||||
|
|
||||||
|
if( cmThreadPause(p->_thH,0) != kOkThRC )
|
||||||
|
{
|
||||||
|
rc = cmErrMsg(&p->_err,kThreadErrSeRC,0,"Thread start failed.");
|
||||||
|
goto errLabel;
|
||||||
|
}
|
||||||
|
|
||||||
|
if( hp != NULL )
|
||||||
|
hp->h = p;
|
||||||
|
else
|
||||||
|
h.h = p;
|
||||||
|
|
||||||
|
errLabel:
|
||||||
|
if( rc != kOkSeRC )
|
||||||
|
{
|
||||||
|
_cmSeDestroy(p);
|
||||||
|
h.h = NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
return hp != NULL ? *hp : h;
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
cmSeRC_t cmSeDestroy(cmSeH_t* hp )
|
||||||
|
{
|
||||||
|
cmSeRC_t rc = kOkSeRC;
|
||||||
|
|
||||||
|
if( hp==NULL || !cmSeIsOpen(*hp) )
|
||||||
|
return kOkSeRC;
|
||||||
|
|
||||||
|
cmSerialPort_t* p = _cmSePtrFromHandle(*hp);
|
||||||
|
|
||||||
|
if((rc = _cmSeDestroy(p)) != kOkSeRC )
|
||||||
|
return rc;
|
||||||
|
|
||||||
|
hp->h = NULL;
|
||||||
|
|
||||||
|
return rc;
|
||||||
|
}
|
||||||
|
|
||||||
|
bool cmSeIsOpen( cmSeH_t h)
|
||||||
|
{
|
||||||
|
if( h.h == NULL )
|
||||||
|
return false;
|
||||||
|
|
||||||
|
cmSerialPort_t* p = _cmSePtrFromHandle(h);
|
||||||
|
return p->_deviceH != -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
cmSeRC_t cmSeSend( cmSeH_t h, const void* byteA, unsigned byteN )
|
||||||
|
{
|
||||||
|
cmSeRC_t rc = kOkSeRC;
|
||||||
|
cmSerialPort_t* p = _cmSePtrFromHandle(h);
|
||||||
|
|
||||||
|
if( !cmSeIsOpen(h) )
|
||||||
|
return cmErrWarnMsg( &p->_err, kResourceNotAvailableSeRC, "An attempt was made to transmit from a closed serial port.");
|
||||||
|
|
||||||
|
if( byteN == 0 )
|
||||||
|
return rc;
|
||||||
|
|
||||||
|
// implement a non blocking write - if less than all the bytes were written then iterate
|
||||||
|
unsigned i = 0;
|
||||||
|
do
|
||||||
|
{
|
||||||
|
int n = 0;
|
||||||
|
if((n = write( p->_deviceH, ((char*)byteA)+i, byteN-i )) == -1 )
|
||||||
|
{
|
||||||
|
rc = cmErrSysMsg(&p->_err,kWriteFailSeRC,errno,"Write failed on serial port '%s'.", p->_deviceStr );
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
i += n;
|
||||||
|
|
||||||
|
|
||||||
|
}while( i<byteN );
|
||||||
|
|
||||||
|
return rc;
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
cmSeRC_t cmSeReceiveCbNb( cmSeH_t h, unsigned* readN_Ref)
|
||||||
|
{
|
||||||
|
cmSeRC_t rc = kOkSeRC;
|
||||||
|
cmSerialPort_t* p = _cmSePtrFromHandle(h);
|
||||||
|
const unsigned bufN = 512;
|
||||||
|
char buf[ bufN ];
|
||||||
|
|
||||||
|
if( readN_Ref != NULL)
|
||||||
|
*readN_Ref = 0;
|
||||||
|
|
||||||
|
if((rc = cmSeReceiveNb(h,buf,bufN,readN_Ref)) == kOkSeRC )
|
||||||
|
if( readN_Ref > 0 && p->_cbFunc != NULL )
|
||||||
|
p->_cbFunc( p->_cbArg, buf, *readN_Ref );
|
||||||
|
|
||||||
|
return rc;
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
cmSeRC_t cmSeReceiveCbTimeOut( cmSeH_t h, unsigned timeOutMs, unsigned* readN_Ref)
|
||||||
|
{
|
||||||
|
cmSeRC_t rc;
|
||||||
|
cmSerialPort_t* p = _cmSePtrFromHandle(h);
|
||||||
|
|
||||||
|
if((rc = _cmSePoll(p,timeOutMs)) == kOkSeRC )
|
||||||
|
rc = cmSeReceiveCbNb(h,readN_Ref);
|
||||||
|
return rc;
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
cmSeRC_t cmSeReceiveNb( cmSeH_t h, void* buf, unsigned bufN, unsigned* readN_Ref)
|
||||||
|
{
|
||||||
|
cmSeRC_t rc = kOkSeRC;
|
||||||
|
cmSerialPort_t* p = _cmSePtrFromHandle(h);
|
||||||
|
|
||||||
|
if( readN_Ref != NULL )
|
||||||
|
*readN_Ref = 0;
|
||||||
|
|
||||||
|
if( !cmSeIsOpen(h) )
|
||||||
|
return cmErrWarnMsg(&p->_err, kResourceNotAvailableSeRC, "An attempt was made to read from a closed serial port.");
|
||||||
|
|
||||||
|
int n = 0;
|
||||||
|
|
||||||
|
// if attempt to read the port succeeded ...
|
||||||
|
if((n =read( p->_deviceH, buf, bufN )) != -1 )
|
||||||
|
*readN_Ref = n;
|
||||||
|
else
|
||||||
|
{
|
||||||
|
// ... or failed and it wasn't because the port was empty
|
||||||
|
if( errno != EAGAIN)
|
||||||
|
rc = cmErrSysMsg(&p->_err,kReadFailSeRC,errno,"An attempt to read the serial port '%s' failed.", p->_deviceStr );
|
||||||
|
}
|
||||||
|
|
||||||
|
return rc;
|
||||||
|
}
|
||||||
|
|
||||||
|
cmSeRC_t cmSeReceive( cmSeH_t h, void* buf, unsigned bufByteN, unsigned timeOutMs, unsigned* readN_Ref )
|
||||||
|
{
|
||||||
|
cmSeRC_t rc = kOkSeRC;
|
||||||
|
cmSerialPort_t* p = _cmSePtrFromHandle(h);
|
||||||
|
|
||||||
|
if((rc = _cmSePoll(p,timeOutMs)) == kOkSeRC )
|
||||||
|
rc = cmSeReceiveNb(h,buf,bufByteN,readN_Ref);
|
||||||
|
|
||||||
|
return rc;
|
||||||
|
}
|
||||||
|
|
||||||
|
const char* cmSeDevice( cmSeH_t h)
|
||||||
|
{
|
||||||
|
cmSerialPort_t* p = _cmSePtrFromHandle(h);
|
||||||
|
return p->_deviceStr;
|
||||||
|
}
|
||||||
|
|
||||||
|
unsigned cmSeBaudRate( cmSeH_t h)
|
||||||
|
{
|
||||||
|
cmSerialPort_t* p = _cmSePtrFromHandle(h);
|
||||||
|
return p->_baudRate;
|
||||||
|
}
|
||||||
|
|
||||||
|
unsigned cmSeCfgFlags( cmSeH_t h)
|
||||||
|
{
|
||||||
|
cmSerialPort_t* p = _cmSePtrFromHandle(h);
|
||||||
|
return p->_cfgFlags;
|
||||||
|
}
|
||||||
|
|
||||||
|
unsigned cmSeReadInBaudRate( cmSeH_t h )
|
||||||
|
{
|
||||||
|
struct termios attr;
|
||||||
|
cmSerialPort_t* p = _cmSePtrFromHandle(h);
|
||||||
|
|
||||||
|
if((_cmSeGetAttributes(p,&attr)) != kOkSeRC )
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
return cfgetispeed(&attr);
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
unsigned cmSeReadOutBaudRate( cmSeH_t h)
|
||||||
|
{
|
||||||
|
struct termios attr;
|
||||||
|
cmSerialPort_t* p = _cmSePtrFromHandle(h);
|
||||||
|
|
||||||
|
if((_cmSeGetAttributes(p,&attr)) != kOkSeRC )
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
return cfgetospeed(&attr);
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
unsigned cmSeReadCfgFlags( cmSeH_t h)
|
||||||
|
{
|
||||||
|
struct termios attr;
|
||||||
|
unsigned result = 0;
|
||||||
|
cmSerialPort_t* p = _cmSePtrFromHandle(h);
|
||||||
|
|
||||||
|
if((_cmSeGetAttributes(p,&attr)) == false )
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
switch( attr.c_cflag & CSIZE )
|
||||||
|
{
|
||||||
|
case CS5:
|
||||||
|
cmSetBits( result, kDataBits5SeFl);
|
||||||
|
break;
|
||||||
|
|
||||||
|
case CS6:
|
||||||
|
cmSetBits( result, kDataBits6SeFl );
|
||||||
|
break;
|
||||||
|
|
||||||
|
case CS7:
|
||||||
|
cmSetBits( result, kDataBits7SeFl);
|
||||||
|
break;
|
||||||
|
|
||||||
|
case CS8:
|
||||||
|
cmSetBits( result, kDataBits8SeFl);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
cmEnaBits( result, k2StopBitSeFl, cmIsFlag( attr.c_cflag, CSTOPB ));
|
||||||
|
cmEnaBits( result, k1StopBitSeFl, !cmIsFlag( attr.c_cflag, CSTOPB ));
|
||||||
|
|
||||||
|
if( cmIsFlag( attr.c_cflag, PARENB ) )
|
||||||
|
{
|
||||||
|
cmEnaBits( result, kOddParitySeFl, cmIsFlag( attr.c_cflag, PARODD ));
|
||||||
|
cmEnaBits( result, kEvenParitySeFl, !cmIsFlag( attr.c_cflag, PARODD ));
|
||||||
|
}
|
||||||
|
|
||||||
|
return result;
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
//====================================================================================================
|
||||||
|
//
|
||||||
|
//
|
||||||
|
|
||||||
|
|
||||||
|
void _cmSePortTestCb( void* arg, const void* byteA, unsigned byteN )
|
||||||
|
{
|
||||||
|
const char* text = (const char*)byteA;
|
||||||
|
|
||||||
|
for(unsigned i=0; i<byteN; ++i)
|
||||||
|
printf("%c:%i ",text[i],(int)text[i]);
|
||||||
|
|
||||||
|
if( byteN )
|
||||||
|
fflush(stdout);
|
||||||
|
}
|
||||||
|
|
||||||
|
cmSeRC_t cmSePortTest(cmCtx_t* ctx)
|
||||||
|
{
|
||||||
|
// Use this test an Arduino running study/serial/arduino_xmt_rcv/main.c
|
||||||
|
cmSeRC_t rc = kOkSeRC;
|
||||||
|
const char* device = "/dev/ttyACM0";
|
||||||
|
unsigned baud = 38400;
|
||||||
|
unsigned serialCfgFlags = kDefaultCfgSeFlags;
|
||||||
|
unsigned pollPeriodMs = 50;
|
||||||
|
cmSeH_t h;
|
||||||
|
|
||||||
|
h.h = NULL;
|
||||||
|
|
||||||
|
h = cmSeCreate(ctx,&h,device,baud,serialCfgFlags,_cmSePortTestCb,NULL,pollPeriodMs);
|
||||||
|
|
||||||
|
bool quitFl = false;
|
||||||
|
printf("q=quit\n");
|
||||||
|
while(!quitFl)
|
||||||
|
{
|
||||||
|
char c = getchar();
|
||||||
|
|
||||||
|
if( c == 'q')
|
||||||
|
quitFl = true;
|
||||||
|
else
|
||||||
|
if( '0' <= c && c <= 'z' )
|
||||||
|
cmSeSend(h,&c,1);
|
||||||
|
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
cmSeDestroy(&h);
|
||||||
|
return rc;
|
||||||
|
}
|
||||||
90
cmSerialPort.h
Normal file
90
cmSerialPort.h
Normal file
@ -0,0 +1,90 @@
|
|||||||
|
#ifndef cmSerialPort_h
|
||||||
|
#define cmSerialPort_h
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
extern "C" {
|
||||||
|
#endif
|
||||||
|
|
||||||
|
typedef unsigned cmSeRC_t;
|
||||||
|
|
||||||
|
enum
|
||||||
|
{
|
||||||
|
kOkSeRC = cmOkRC,
|
||||||
|
kFlushFailSeRC,
|
||||||
|
kSetAttrFailSeRC,
|
||||||
|
kCloseFailSeRC,
|
||||||
|
kOpenFailSeRC,
|
||||||
|
kResourceNotAvailableSeRC,
|
||||||
|
kGetAttrFailSeRC,
|
||||||
|
kWriteFailSeRC,
|
||||||
|
kReadFailSeRC,
|
||||||
|
kTimeOutSeRC,
|
||||||
|
kThreadErrSeRC
|
||||||
|
};
|
||||||
|
|
||||||
|
|
||||||
|
enum
|
||||||
|
{
|
||||||
|
kDataBits5SeFl = 0x0001,
|
||||||
|
kDataBits6SeFl = 0x0002,
|
||||||
|
kDataBits7SeFl = 0x0004,
|
||||||
|
kDataBits8SeFl = 0x0008,
|
||||||
|
kDataBitsSeMask = 0x000f,
|
||||||
|
|
||||||
|
k1StopBitSeFl = 0x0010,
|
||||||
|
k2StopBitSeFl = 0x0020,
|
||||||
|
|
||||||
|
kEvenParitySeFl = 0x0040,
|
||||||
|
kOddParitySeFl = 0x0080,
|
||||||
|
kNoParitySeFl = 0x0000,
|
||||||
|
|
||||||
|
kDefaultCfgSeFlags = kDataBits8SeFl | k1StopBitSeFl | kNoParitySeFl
|
||||||
|
};
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
typedef void (*cmSeCallbackFunc_t)( void* cbArg, const void* byteA, unsigned byteN );
|
||||||
|
|
||||||
|
typedef cmHandle_t cmSeH_t;
|
||||||
|
|
||||||
|
cmSeH_t cmSeCreate( cmCtx_t* ctx, cmSeH_t* hp, const char* device, unsigned baudRate, unsigned cfgFlags, cmSeCallbackFunc_t cbFunc, void* cbArg, unsigned pollPeriodMs );
|
||||||
|
cmSeRC_t cmSeDestroy(cmSeH_t* hp );
|
||||||
|
|
||||||
|
bool cmSeIsOpen( cmSeH_t h);
|
||||||
|
|
||||||
|
cmSeRC_t cmSeSend( cmSeH_t h, const void* byteA, unsigned byteN );
|
||||||
|
|
||||||
|
|
||||||
|
// Make callback to listener with result of read - Non-blocking
|
||||||
|
cmSeRC_t cmSeReceiveCbNb( cmSeH_t h, unsigned* readN_Ref);
|
||||||
|
|
||||||
|
// Make callback to listener with result of read - Block for up to timeOutMs.
|
||||||
|
cmSeRC_t cmSeReceiveCbTimeOut( cmSeH_t h, unsigned timeOutMs, unsigned* readN_Ref);
|
||||||
|
|
||||||
|
// Return result of read in buf[bufByteN] - Non-blocking.
|
||||||
|
cmSeRC_t cmSeReceiveNb( cmSeH_t h, void* buf, unsigned bufByteN, unsigned* readN_Ref);
|
||||||
|
|
||||||
|
// Return result of read in buf[bufByteN] - Block for up to timeOutMs.
|
||||||
|
cmSeRC_t cmSeReceive( cmSeH_t h, void* buf, unsigned bufByteN, unsigned timeOutMs, unsigned* readN_Ref );
|
||||||
|
|
||||||
|
const char* cmSeDevice( cmSeH_t h);
|
||||||
|
|
||||||
|
// Get the baud rate and cfgFlags used to initialize the port
|
||||||
|
unsigned cmSeBaudRate( cmSeH_t h);
|
||||||
|
unsigned cmSeCfgFlags( cmSeH_t h);
|
||||||
|
|
||||||
|
// Get the baud rate and cfg flags by reading the device.
|
||||||
|
// Note the the returned buad rate is a system id rather than the actual baud rate,
|
||||||
|
// however the cfgFlags are converted to the same kXXXFl defined in this class.
|
||||||
|
unsigned cmSeReadInBaudRate( cmSeH_t h );
|
||||||
|
unsigned cmSeReadOutBaudRate( cmSeH_t h);
|
||||||
|
unsigned cmSeReadCfgFlags( cmSeH_t h);
|
||||||
|
|
||||||
|
cmSeRC_t cmSePortTest(cmCtx_t* ctx);
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#endif
|
||||||
Loading…
Reference in New Issue
Block a user