/* * sio.c * * serial port routines * * (C)1999 Stefano Busti * */#include <stdio.h>#include "sio.h"#if defined(SIO_TTY)#  include <unistd.h>#  include <termios.h>#elif defined(SIO_WIN32)#  include <io.h>#endif#include <sys/types.h>#include <sys/stat.h>#include <fcntl.h>int sio_init(sio_s *sio){	sio->fd = 0;	sio->info.port = 1;	sio->info.baud = 9600;	sio->info.parity = SIO_PARITY_NONE;	sio->info.stopbits = 1;	sio->info.databits = 8;	return 0;}void sio_cleanup(sio_s *sio){	if (sio_isopen(sio))		sio_close(sio);}int sio_open(sio_s *sio){	char filename[20];	#if defined(SIO_TTY)	struct termios t;	int fd, c_stop, c_data, i_parity, c_parity;	speed_t speed;
	int     status;		if (sio_isopen(sio))		return -1;					 	sprintf(filename, "/dev/ttyS%hd", sio->info.port - 1);	fd = open(filename, O_RDWR);	if (fd == -1)		return -1;	
	status=tcgetattr(fd, &t);	if (status !=0)	{
		perror("tcgetattr()");		close(fd);		return -1;	}		switch(sio->info.baud)	{	case 0: speed = B0; break;	case 50: speed = B50; break;	case 75: speed = B75; break;	case 110: speed = B110; break;	case 134: speed = B134; break;	case 150: speed = B150; break;	case 300: speed = B300; break;	case 600: speed = B600; break;	case 1200: speed = B1200; break;	case 1800: speed = B1800; break;	case 2400: speed = B2400; break;	case 4800: speed = B4800; break;	case 9600: speed = B9600; break;	case 19200: speed = B19200; break;	case 38400: speed = B38400; break;	case 57600: speed = B57600; break;	case 115200: speed = B115200; break;	case 230400: speed = B230400; break;	default: speed = B0; break;	}	if (speed == B0)	{		close(fd);		return -1;	}	
	tcflush(fd,TCIOFLUSH);	if (cfsetospeed(&t, speed))	{		close(fd);		return -1;	}	if (cfsetispeed(&t, speed))	{		close(fd);		return -1;	}		switch(sio->info.stopbits)	{	case 1: c_stop = 0; break;	case 2: c_stop = CSTOPB; break;	default: close(fd); return -1;	}	switch(sio->info.databits)	{	case 5: c_data = CS5; break;	case 6: c_data = CS6; break;	case 7: c_data = CS7; break;	case 8: c_data = CS8; break;	default: close(fd); return -1;	}	switch(sio->info.parity)	{	case SIO_PARITY_NONE:		i_parity = IGNPAR;		c_parity = 0;		break;			case SIO_PARITY_EVEN:		i_parity = INPCK;		c_parity = PARENB;		break;	case SIO_PARITY_ODD:		i_parity = INPCK;		c_parity = PARENB | PARODD;		break;	default:		close(fd);		return -1;	}
	status = tcsetattr(fd, TCSANOW, &t);	if (status !=0)	{
		perror("tcsetattr fd");		close(fd);		return -1;	}
	tcflush(fd,TCIOFLUSH);		sio->fd = fd;		return 0;#elif defined(SIO_WIN32)	int fd;	HANDLE hComm;	DCB dcb;	COMMTIMEOUTS cto = { MAXDWORD, 0, 0, 4, 4 }; 		if (sio_isopen(sio))		return -1;					 	sprintf(filename, "COM%hd", sio->info.port);	fd = _open(filename, _O_RDWR);	if (fd == -1)		return -1;	/* Grab the fd's windows handle */	hComm = (HANDLE)_get_osfhandle(fd);	if (!SetCommTimeouts(hComm, &cto))	{		_close(fd);		return -1;	}	dcb.DCBlength = sizeof(dcb);	memset(&dcb, sizeof(dcb), 0);	if (!GetCommState(hComm, &dcb))	{		_close(fd);		return -1;	}	dcb.BaudRate = sio->info.baud;	//dcb.fBinary = TRUE;	dcb.fParity = (sio->info.parity == SIO_PARITY_NONE) ? FALSE : TRUE;	dcb.fOutxCtsFlow = FALSE;	dcb.fOutxDsrFlow = FALSE;	dcb.fDtrControl = DTR_CONTROL_DISABLE;	dcb.fDsrSensitivity = FALSE;	dcb.fTXContinueOnXoff = FALSE;	dcb.fOutX = FALSE;	dcb.fInX = FALSE;	dcb.fErrorChar = FALSE;	dcb.fNull = FALSE;	dcb.fRtsControl = RTS_CONTROL_DISABLE;	dcb.fAbortOnError = FALSE;	dcb.ByteSize = sio->info.databits;	switch (sio->info.parity)	{	case SIO_PARITY_NONE: dcb.Parity = 0; break;	case SIO_PARITY_ODD: dcb.Parity = 1; break;	case SIO_PARITY_EVEN: dcb.Parity = 2; break;			default: _close(fd); return -1;	}	switch (sio->info.stopbits)	{	case 1: dcb.StopBits = 0; break;	case 2: dcb.StopBits = 2; break;	default: _close(fd); return -1;	}	if (!SetCommState(hComm, &dcb))	{		_close(fd);		return -1;	}		sio->fd = fd;	sio->hComm = hComm;	return 0;#endif}void sio_close(sio_s *sio){#if defined(SIO_TTY)	close(sio->fd);	sio->fd = 0;#elif defined(SIO_WIN32)	_close(sio->fd);	sio->fd = 0;	sio->hComm = INVALID_HANDLE_VALUE;#endif}#ifdef SIO_TTY__inline#endifint sio_read(sio_s *sio, void *buf, size_t count){#if defined(SIO_TTY)	return read(sio->fd, buf, count);#elif defined(SIO_WIN32)	int res;	if (!ReadFile(sio->hComm, buf, count, &res, NULL))		return -1;	return res;#endif}#ifdef SIO_TTY__inline#endifint sio_write(sio_s *sio, void *buf, size_t count){#if defined(SIO_TTY)	return write(sio->fd, buf, count);#elif defined(SIO_WIN32)	int res;	if (!WriteFile(sio->hComm, buf, count, &res, NULL))		return -1;	return res;	#endif}int sio_isopen(sio_s *sio){	return (sio->fd != 0);}int sio_setinfo(sio_s *sio, serialinfo_s *info){	sio->info = *info;	return 0;}	void sio_flush(sio_s *sio, int dir){	if (sio_isopen(sio))	{#if defined(SIO_TTY)		switch(dir)		{		case SIO_IN: tcflush(sio->fd, TCIFLUSH); break;		case SIO_OUT: tcflush(sio->fd, TCOFLUSH); break;		case SIO_IN | SIO_OUT: tcflush(sio->fd, TCIOFLUSH); break;		}#elif defined(SIO_WIN32)		DWORD flags = 0;		if (sio_isopen(sio))		{			if (dir & SIO_IN)				flags |= PURGE_RXCLEAR | PURGE_RXABORT;			if (dir & SIO_OUT)				flags |= PURGE_TXCLEAR | PURGE_TXABORT;		}				PurgeComm(sio->hComm, flags);#endif	}}void sio_drain(sio_s *sio){	if (sio_isopen(sio))	{#if defined(SIO_TTY)		tcdrain(sio->fd);#elif defined(SIO_WIN32)		FlushFileBuffers(sio->hComm);#endif	}}void sio_debug(sio_s *sio, FILE *f){	fprintf(f, "sio {\n");	fprintf(f, "\tfd = %d\n", sio_isopen(sio) ? sio->fd : 0);	fprintf(f, "\tport = %d\n", sio->info.port);		fprintf(f, "\tbaud = %ld\n", sio->info.baud);		fprintf(f, "\tparity = %d\n", sio->info.parity);		fprintf(f, "\tstopbits = %d\n", sio->info.stopbits);	fprintf(f, "\tdatabits = %d\n", sio->info.databits);		fprintf(f, "\topen = %d\n", sio_isopen(sio));		fprintf(f, "}\n\n");}