added inital serial port flush, serial handeling changes. rate display bugfix
This commit is contained in:
@ -1,7 +1,5 @@
|
||||
#include "serial_io.h"
|
||||
|
||||
struct termios toptions;
|
||||
|
||||
void sWrite(int port, char string[], size_t length)
|
||||
{
|
||||
if(port != -1) write(port, string, length);
|
||||
@ -18,9 +16,35 @@ ssize_t sRead(int port, void *buf, size_t count)
|
||||
return (port != -1) ? read(port, buf, count) : 0;
|
||||
}
|
||||
|
||||
#ifdef __cplusplus
|
||||
void printRates()
|
||||
{
|
||||
std::cout<<"Rates:\n"\
|
||||
<<"B50 "<<B50<<'\n'\
|
||||
<<"B75 "<<B75<<'\n'\
|
||||
<<"B110 "<<B110<<'\n'\
|
||||
<<"B134 "<<B134<<'\n'\
|
||||
<<"B150 "<<B150<<'\n'\
|
||||
<<"B200 "<<B200<<'\n'\
|
||||
<<"B300 "<<B300<<'\n'\
|
||||
<<"B600 "<<B600<<'\n'\
|
||||
<<"B1200 "<<B1200<<'\n'\
|
||||
<<"B1800 "<<B1800<<'\n'\
|
||||
<<"B2400 "<<B2400<<'\n'\
|
||||
<<"B4800 "<<B4800<<'\n'\
|
||||
<<"B9600 "<<B9600<<'\n'\
|
||||
<<"B19200 "<<B19200<<'\n'\
|
||||
<<"B38400 "<<B38400<<'\n'\
|
||||
<<"B57600 "<<B57600<<'\n'\
|
||||
<<"B115200 "<<B115200<<'\n'\
|
||||
<<"B230400 "<<B230400<<'\n';
|
||||
}
|
||||
#endif
|
||||
|
||||
int serialport_init(const char* device, int baud)
|
||||
{
|
||||
int fd;
|
||||
struct termios toptions;
|
||||
fd = open(device, O_RDWR | O_NOCTTY | O_NDELAY);
|
||||
if (fd == -1)
|
||||
{
|
||||
@ -44,19 +68,20 @@ int serialport_init(const char* device, int baud)
|
||||
|
||||
//Make Raw
|
||||
toptions.c_iflag &= ~(IGNBRK | BRKINT | PARMRK | ISTRIP | INLCR | IGNCR | ICRNL | IXON);
|
||||
toptions.c_oflag &= ~OPOST;
|
||||
toptions.c_oflag &= ~OPOST; //hmm examine
|
||||
toptions.c_lflag &= ~(ECHO | ECHONL | ICANON | ISIG | IEXTEN);
|
||||
toptions.c_cflag &= ~(CSIZE | PARENB);
|
||||
toptions.c_cflag |= CS8;
|
||||
|
||||
cfsetispeed(&toptions, baud);
|
||||
cfsetospeed(&toptions, baud);
|
||||
|
||||
if(cfsetispeed(&toptions, baud) < 0 || cfsetospeed(&toptions, baud) < 0)
|
||||
{
|
||||
perror("init_serialport: Couldn't set baud rate");
|
||||
return -1;
|
||||
}
|
||||
// see: http://unixwiz.net/techtips/termios-vmin-vtime.html
|
||||
toptions.c_cc[VMIN] = 0;
|
||||
toptions.c_cc[VTIME] = 40;
|
||||
fcntl(fd, F_SETFL, FNDELAY);
|
||||
|
||||
if( tcsetattr(fd, TCSANOW, &toptions) < 0)
|
||||
{
|
||||
perror("init_serialport: Couldn't set term attributes");
|
||||
|
Reference in New Issue
Block a user