New test cast native application for opening/closing a port
This commit is contained in:
hedgecrw85
parent
9122adccea
commit
1d297ca610
|
|
@ -0,0 +1,481 @@
|
|||
#include <errno.h>
|
||||
#include <fcntl.h>
|
||||
#include <poll.h>
|
||||
#include <stdbool.h>
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
#include <sys/file.h>
|
||||
#include <sys/time.h>
|
||||
#include <unistd.h>
|
||||
#if defined(__linux__)
|
||||
#include <linux/serial.h>
|
||||
#define termios asmtermios
|
||||
#define termio asmtermio
|
||||
#define winsize asmwinsize
|
||||
#include <asm/ioctls.h>
|
||||
#include <asm/termios.h>
|
||||
#undef termio
|
||||
#undef termios
|
||||
#undef winsize
|
||||
#elif defined(__APPLE__)
|
||||
#include <CoreFoundation/CoreFoundation.h>
|
||||
#include <IOKit/IOKitLib.h>
|
||||
#include <IOKit/serial/IOSerialKeys.h>
|
||||
#include <IOKit/serial/ioss.h>
|
||||
#endif
|
||||
#include <sys/ioctl.h>
|
||||
#include <termios.h>
|
||||
|
||||
|
||||
// OS-specific functionality
|
||||
#ifndef CMSPAR
|
||||
#define CMSPAR 010000000000
|
||||
#endif
|
||||
|
||||
#if defined(__linux__)
|
||||
typedef int baud_rate;
|
||||
#ifdef __ANDROID__
|
||||
extern int ioctl(int __fd, int __request, ...);
|
||||
#else
|
||||
extern int ioctl(int __fd, unsigned long int __request, ...);
|
||||
#endif
|
||||
#elif defined(__APPLE__)
|
||||
#define fdatasync(a) fsync(a)
|
||||
#include <termios.h>
|
||||
typedef speed_t baud_rate;
|
||||
#endif
|
||||
|
||||
#if defined(__linux__)
|
||||
baud_rate getBaudRateCode(baud_rate baudRate)
|
||||
{
|
||||
// Translate a raw baud rate into a system-specified one
|
||||
switch (baudRate)
|
||||
{
|
||||
case 50:
|
||||
return B50;
|
||||
case 75:
|
||||
return B75;
|
||||
case 110:
|
||||
return B110;
|
||||
case 134:
|
||||
return B134;
|
||||
case 150:
|
||||
return B150;
|
||||
case 200:
|
||||
return B200;
|
||||
case 300:
|
||||
return B300;
|
||||
case 600:
|
||||
return B600;
|
||||
case 1200:
|
||||
return B1200;
|
||||
case 1800:
|
||||
return B1800;
|
||||
case 2400:
|
||||
return B2400;
|
||||
case 4800:
|
||||
return B4800;
|
||||
case 9600:
|
||||
return B9600;
|
||||
case 19200:
|
||||
return B19200;
|
||||
case 38400:
|
||||
return B38400;
|
||||
case 57600:
|
||||
#ifdef B57600
|
||||
return B57600;
|
||||
#else
|
||||
return 0;
|
||||
#endif
|
||||
case 115200:
|
||||
#ifdef B115200
|
||||
return B115200;
|
||||
#else
|
||||
return 0;
|
||||
#endif
|
||||
case 230400:
|
||||
#ifdef B230400
|
||||
return B230400;
|
||||
#else
|
||||
return 0;
|
||||
#endif
|
||||
case 460800:
|
||||
#ifdef B460800
|
||||
return B460800;
|
||||
#else
|
||||
return 0;
|
||||
#endif
|
||||
case 500000:
|
||||
#ifdef B500000
|
||||
return B500000;
|
||||
#else
|
||||
return 0;
|
||||
#endif
|
||||
case 576000:
|
||||
#ifdef B576000
|
||||
return B576000;
|
||||
#else
|
||||
return 0;
|
||||
#endif
|
||||
case 921600:
|
||||
#ifdef B921600
|
||||
return B921600;
|
||||
#else
|
||||
return 0;
|
||||
#endif
|
||||
default:
|
||||
return 0;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
int setBaudRateCustom(int portFD, baud_rate baudRate)
|
||||
{
|
||||
#ifdef TCSETS2
|
||||
struct termios2 options = { 0 };
|
||||
ioctl(portFD, TCGETS2, &options);
|
||||
options.c_cflag &= ~CBAUD;
|
||||
options.c_cflag |= BOTHER;
|
||||
options.c_ispeed = baudRate;
|
||||
options.c_ospeed = baudRate;
|
||||
int retVal = ioctl(portFD, TCSETS2, &options);
|
||||
#else
|
||||
struct serial_struct serInfo;
|
||||
int retVal = ioctl(portFD, TIOCGSERIAL, &serInfo);
|
||||
if (retVal == 0)
|
||||
{
|
||||
serInfo.flags &= ~ASYNC_SPD_MASK;
|
||||
serInfo.flags |= ASYNC_SPD_CUST | ASYNC_LOW_LATENCY;
|
||||
serInfo.custom_divisor = serInfo.baud_base / baudRate;
|
||||
if (sersInfo.custom_divisor == 0)
|
||||
serInfo.custom_divisor = 1;
|
||||
retVal = ioctl(portFD, TIOCSSERIAL, &serInfo);
|
||||
}
|
||||
#endif
|
||||
return (retVal == 0);
|
||||
}
|
||||
#elif defined(__APPLE__)
|
||||
baud_rate getBaudRateCode(baud_rate baudRate)
|
||||
{
|
||||
// Translate a raw baud rate into a system-specified one
|
||||
switch (baudRate)
|
||||
{
|
||||
case 50:
|
||||
return B50;
|
||||
case 75:
|
||||
return B75;
|
||||
case 110:
|
||||
return B110;
|
||||
case 134:
|
||||
return B134;
|
||||
case 150:
|
||||
return B150;
|
||||
case 200:
|
||||
return B200;
|
||||
case 300:
|
||||
return B300;
|
||||
case 600:
|
||||
return B600;
|
||||
case 1200:
|
||||
return B1200;
|
||||
case 1800:
|
||||
return B1800;
|
||||
case 2400:
|
||||
return B2400;
|
||||
case 4800:
|
||||
return B4800;
|
||||
case 9600:
|
||||
return B9600;
|
||||
case 19200:
|
||||
return B19200;
|
||||
case 38400:
|
||||
return B38400;
|
||||
default:
|
||||
return 0;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
int setBaudRateCustom(int portFD, baud_rate baudRate)
|
||||
{
|
||||
// Use OSX-specific ioctls to set a custom baud rate
|
||||
unsigned long microseconds = 1000;
|
||||
int retVal = ioctl(portFD, IOSSIOSPEED, &baudRate);
|
||||
ioctl(portFD, IOSSDATALAT, µseconds);
|
||||
return (retVal == 0);
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
// Global static variables
|
||||
static long portHandle = -1;
|
||||
static char* comPort = NULL;
|
||||
|
||||
|
||||
// JNI functionality
|
||||
bool configTimeouts(long serialPortFD)
|
||||
{
|
||||
// Get port timeouts from Java class
|
||||
if (serialPortFD <= 0)
|
||||
return false;
|
||||
baud_rate baudRate = 9600;
|
||||
baud_rate baudRateCode = getBaudRateCode(baudRate);
|
||||
int timeoutMode = 0;
|
||||
int readTimeout = 0;
|
||||
|
||||
// Retrieve existing port configuration
|
||||
struct termios options = {0};
|
||||
tcgetattr(serialPortFD, &options);
|
||||
int flags = fcntl(serialPortFD, F_GETFL);
|
||||
if (flags == -1)
|
||||
return false;
|
||||
|
||||
// Set updated port timeouts
|
||||
if (((timeoutMode & 0x1) > 0) && (readTimeout > 0)) // Read Semi-blocking with timeout
|
||||
{
|
||||
flags &= ~O_NONBLOCK;
|
||||
options.c_cc[VMIN] = 0;
|
||||
options.c_cc[VTIME] = readTimeout / 100;
|
||||
}
|
||||
else if ((timeoutMode & 0x1) > 0) // Read Semi-blocking without timeout
|
||||
{
|
||||
flags &= ~O_NONBLOCK;
|
||||
options.c_cc[VMIN] = 1;
|
||||
options.c_cc[VTIME] = 0;
|
||||
}
|
||||
else if (((timeoutMode & 0x10) > 0) && (readTimeout > 0)) // Read Blocking with timeout
|
||||
{
|
||||
flags &= ~O_NONBLOCK;
|
||||
options.c_cc[VMIN] = 0;
|
||||
options.c_cc[VTIME] = readTimeout / 100;
|
||||
}
|
||||
else if ((timeoutMode & 0x10) > 0) // Read Blocking without timeout
|
||||
{
|
||||
flags &= ~O_NONBLOCK;
|
||||
options.c_cc[VMIN] = 1;
|
||||
options.c_cc[VTIME] = 0;
|
||||
}
|
||||
else if ((timeoutMode & 0x1000) > 0) // Scanner Mode
|
||||
{
|
||||
flags &= ~O_NONBLOCK;
|
||||
options.c_cc[VMIN] = 1;
|
||||
options.c_cc[VTIME] = 1;
|
||||
}
|
||||
else // Non-blocking
|
||||
{
|
||||
flags |= O_NONBLOCK;
|
||||
options.c_cc[VMIN] = 0;
|
||||
options.c_cc[VTIME] = 0;
|
||||
}
|
||||
|
||||
// Apply changes
|
||||
int retVal = fcntl(serialPortFD, F_SETFL, flags);
|
||||
if (retVal != -1)
|
||||
retVal = tcsetattr(serialPortFD, TCSANOW, &options);
|
||||
if (baudRateCode == 0)
|
||||
setBaudRateCustom(serialPortFD, baudRate);
|
||||
return ((retVal == 0) ? true : false);
|
||||
}
|
||||
|
||||
bool configPort(long serialPortFD)
|
||||
{
|
||||
if (serialPortFD <= 0)
|
||||
return false;
|
||||
struct termios options = {0};
|
||||
|
||||
// Get port parameters from Java class
|
||||
baud_rate baudRate = 9600;
|
||||
int byteSizeInt = 8;
|
||||
int stopBitsInt = 1;
|
||||
int parityInt = 0;
|
||||
int flowControl = 0;
|
||||
int sendDeviceQueueSize = 4096;
|
||||
int receiveDeviceQueueSize = 4096;
|
||||
int rs485DelayBefore = 0;
|
||||
int rs485DelayAfter = 0;
|
||||
unsigned char configDisabled = false;
|
||||
unsigned char rs485ModeEnabled = false;
|
||||
unsigned char rs485ActiveHigh = true;
|
||||
unsigned char isDtrEnabled = true;
|
||||
unsigned char isRtsEnabled = true;
|
||||
tcflag_t byteSize = (byteSizeInt == 5) ? CS5 : (byteSizeInt == 6) ? CS6 : (byteSizeInt == 7) ? CS7 : CS8;
|
||||
tcflag_t stopBits = ((stopBitsInt == 1) || (stopBitsInt == 2)) ? 0 : CSTOPB;
|
||||
tcflag_t parity = (parityInt == 0) ? 0 : (parityInt == 1) ? (PARENB | PARODD) : (parityInt == 2) ? PARENB : (parityInt == 3) ? (PARENB | CMSPAR | PARODD) : (PARENB | CMSPAR);
|
||||
tcflag_t CTSRTSEnabled = (((flowControl & 0x10) > 0) || ((flowControl & 0x1) > 0)) ? CRTSCTS : 0;
|
||||
tcflag_t XonXoffInEnabled = ((flowControl & 0x10000) > 0) ? IXOFF : 0;
|
||||
tcflag_t XonXoffOutEnabled = ((flowControl & 0x100000) > 0) ? IXON : 0;
|
||||
|
||||
// Set updated port parameters
|
||||
tcgetattr(serialPortFD, &options);
|
||||
options.c_cflag = (byteSize | stopBits | parity | CLOCAL | CREAD | CTSRTSEnabled);
|
||||
if (parityInt == 4)
|
||||
options.c_cflag &= ~PARODD;
|
||||
if (!isDtrEnabled || !isRtsEnabled)
|
||||
options.c_cflag &= ~HUPCL;
|
||||
options.c_iflag &= ~(INPCK | IGNPAR | PARMRK | ISTRIP);
|
||||
if (byteSizeInt < 8)
|
||||
options.c_iflag |= ISTRIP;
|
||||
if (parityInt != 0)
|
||||
options.c_iflag |= (INPCK | IGNPAR);
|
||||
options.c_iflag |= (XonXoffInEnabled | XonXoffOutEnabled);
|
||||
|
||||
// Set baud rate and apply changes
|
||||
baud_rate baudRateCode = getBaudRateCode(baudRate);
|
||||
unsigned char nonStandardBaudRate = (baudRateCode == 0);
|
||||
if (nonStandardBaudRate)
|
||||
baudRateCode = B38400;
|
||||
cfsetispeed(&options, baudRateCode);
|
||||
cfsetospeed(&options, baudRateCode);
|
||||
int retVal = configDisabled ? 0 : tcsetattr(serialPortFD, TCSANOW, &options);
|
||||
|
||||
// Attempt to set the transmit buffer size and any necessary custom baud rates
|
||||
#if defined(__linux__)
|
||||
struct serial_struct serInfo = {0};
|
||||
if (ioctl(serialPortFD, TIOCGSERIAL, &serInfo) == 0)
|
||||
{
|
||||
serInfo.xmit_fifo_size = sendDeviceQueueSize;
|
||||
ioctl(serialPortFD, TIOCSSERIAL, &serInfo);
|
||||
}
|
||||
#else
|
||||
sendDeviceQueueSize = sysconf(_SC_PAGESIZE);
|
||||
#endif
|
||||
receiveDeviceQueueSize, sysconf(_SC_PAGESIZE);
|
||||
if (nonStandardBaudRate)
|
||||
setBaudRateCustom(serialPortFD, baudRate);
|
||||
|
||||
// Attempt to set the requested RS-485 mode
|
||||
#if defined(__linux__)
|
||||
struct serial_rs485 rs485Conf = {0};
|
||||
if (ioctl(serialPortFD, TIOCGRS485, &rs485Conf) == 0)
|
||||
{
|
||||
if (rs485ModeEnabled)
|
||||
rs485Conf.flags |= SER_RS485_ENABLED;
|
||||
else
|
||||
rs485Conf.flags &= ~SER_RS485_ENABLED;
|
||||
if (rs485ActiveHigh)
|
||||
{
|
||||
rs485Conf.flags |= SER_RS485_RTS_ON_SEND;
|
||||
rs485Conf.flags &= ~(SER_RS485_RTS_AFTER_SEND);
|
||||
}
|
||||
else
|
||||
{
|
||||
rs485Conf.flags &= ~(SER_RS485_RTS_ON_SEND);
|
||||
rs485Conf.flags |= SER_RS485_RTS_AFTER_SEND;
|
||||
}
|
||||
rs485Conf.delay_rts_before_send = rs485DelayBefore;
|
||||
rs485Conf.delay_rts_after_send = rs485DelayAfter;
|
||||
ioctl(serialPortFD, TIOCSRS485, &rs485Conf);
|
||||
}
|
||||
#endif
|
||||
return ((retVal == 0) && configTimeouts(serialPortFD) ? true : false);
|
||||
}
|
||||
|
||||
long openPortNative(void)
|
||||
{
|
||||
const char *portName = comPort;
|
||||
unsigned char isDtrEnabled = true;
|
||||
unsigned char isRtsEnabled = true;
|
||||
|
||||
// Try to open existing serial port with read/write access
|
||||
int serialPortFD = -1;
|
||||
if ((serialPortFD = open(portName, O_RDWR | O_NOCTTY | O_NONBLOCK)) > 0)
|
||||
{
|
||||
// Ensure that multiple root users cannot access the device simultaneously
|
||||
if (flock(serialPortFD, LOCK_EX | LOCK_NB) == -1)
|
||||
{
|
||||
tcdrain(serialPortFD);
|
||||
while ((close(serialPortFD) == -1) && (errno == EINTR))
|
||||
errno = 0;
|
||||
serialPortFD = -1;
|
||||
}
|
||||
else
|
||||
{
|
||||
// Clear any serial port flags and set up raw, non-canonical port parameters
|
||||
struct termios options = {0};
|
||||
fcntl(serialPortFD, F_SETFL, 0);
|
||||
tcgetattr(serialPortFD, &options);
|
||||
cfmakeraw(&options);
|
||||
if (!isDtrEnabled || !isRtsEnabled)
|
||||
options.c_cflag &= ~HUPCL;
|
||||
options.c_iflag |= BRKINT;
|
||||
tcsetattr(serialPortFD, TCSANOW, &options);
|
||||
|
||||
// Configure the port parameters and timeouts
|
||||
if (configPort(serialPortFD))
|
||||
portHandle = serialPortFD;
|
||||
else
|
||||
{
|
||||
// Close the port if there was a problem setting the parameters
|
||||
tcdrain(serialPortFD);
|
||||
while ((close(serialPortFD) == -1) && (errno == EINTR))
|
||||
errno = 0;
|
||||
serialPortFD = -1;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
return serialPortFD;
|
||||
}
|
||||
|
||||
bool closePortNative(long serialPortFD)
|
||||
{
|
||||
// Ensure that the port is open
|
||||
if (serialPortFD <= 0)
|
||||
return true;
|
||||
|
||||
// Force the port to enter non-blocking mode to ensure that any current reads return
|
||||
struct termios options = {0};
|
||||
tcgetattr(serialPortFD, &options);
|
||||
int flags = fcntl(serialPortFD, F_GETFL);
|
||||
flags |= O_NONBLOCK;
|
||||
options.c_cc[VMIN] = 0;
|
||||
options.c_cc[VTIME] = 0;
|
||||
int retVal = fcntl(serialPortFD, F_SETFL, flags);
|
||||
tcsetattr(serialPortFD, TCSANOW, &options);
|
||||
tcdrain(serialPortFD);
|
||||
|
||||
// Close the port
|
||||
int closeResult = 0;
|
||||
flock(serialPortFD, LOCK_UN | LOCK_NB);
|
||||
fdatasync(serialPortFD);
|
||||
while (((closeResult = close(serialPortFD)) == -1) && (errno == EINTR))
|
||||
{
|
||||
printf("CLOSE INTERRUPTED, ERROR CODE: %d\n", closeResult);
|
||||
errno = 0;
|
||||
}
|
||||
if (closeResult == -1)
|
||||
printf("CLOSE FAILED, ERROR CODE: %d\n", closeResult);
|
||||
portHandle = -1l;
|
||||
return true;
|
||||
}
|
||||
|
||||
int main(int argc, char *argv[])
|
||||
{
|
||||
// Check for correct input parameters
|
||||
if (argc != 2)
|
||||
{
|
||||
printf("USAGE: ./testClose [PORT_FILE_NAME]\n");
|
||||
return -1;
|
||||
}
|
||||
comPort = argv[1];
|
||||
|
||||
// Open the serial port
|
||||
if ((portHandle = openPortNative()) <= 0)
|
||||
{
|
||||
printf("ERROR: Could not open port: %s\n", comPort);
|
||||
return -2;
|
||||
}
|
||||
printf("Port opened\n");
|
||||
|
||||
// Close the serial port
|
||||
closePortNative(portHandle);
|
||||
if (portHandle > 0)
|
||||
{
|
||||
printf("ERROR: Could not close port: %s\n", comPort);
|
||||
return -3;
|
||||
}
|
||||
printf("Port closed\n");
|
||||
|
||||
return 0;
|
||||
}
|
||||
Loading…
Reference in New Issue