#include <fcntl.h>
#include <errno.h>
#endif
-#include <msp/strings/formatter.h>
-#include "except.h"
+#include <msp/strings/format.h>
+#include <msp/core/systemerror.h>
+#include "handle_private.h"
#include "serial.h"
using namespace std;
-namespace {
-
-using namespace Msp;
-using namespace Msp::IO;
+namespace Msp {
+namespace IO {
+struct Serial::DeviceState
+{
#ifdef WIN32
-typedef DCB DeviceState;
+ DCB state;
#else
-typedef termios DeviceState;
+ termios state;
#endif
-void get_state(Handle handle, DeviceState &state)
+ void get_from(const Handle &);
+ void apply_to(const Handle &);
+ void set_baud_rate(unsigned);
+ void set_data_bits(unsigned);
+ void set_parity(Parity);
+ void set_stop_bits(unsigned);
+};
+
+void Serial::DeviceState::get_from(const Handle &handle)
{
#ifdef WIN32
- GetCommState(handle, &state);
+ GetCommState(*handle, &state);
#else
- tcgetattr(handle, &state);
+ tcgetattr(*handle, &state);
#endif
}
-void set_state(Handle handle, DeviceState &state)
+void Serial::DeviceState::apply_to(const Handle &handle)
{
#ifdef WIN32
- if(SetCommState(handle, &state)==0)
- throw SystemError("Cannot set serial port parameters", GetLastError());
+ if(SetCommState(*handle, &state)==0)
+ throw system_error("SetCommState");
#else
- if(tcsetattr(handle, TCSADRAIN, &state)==-1)
- throw SystemError("Cannot set serial port parameters", errno);
+ if(tcsetattr(*handle, TCSADRAIN, &state)==-1)
+ throw system_error("tcsetattr");
#endif
}
-void set_baud_rate(DeviceState &state, unsigned baud)
+void Serial::DeviceState::set_baud_rate(unsigned baud)
{
#ifdef WIN32
state.BaudRate = baud;
case 57600: speed = B57600; break;
case 115200: speed = B115200; break;
case 230400: speed = B230400; break;
- default: throw InvalidParameterValue("Invalid baud rate");
+ default: throw invalid_argument("set_baud_rate");
}
cfsetospeed(&state, speed);
#endif
}
-void set_data_bits(DeviceState &state, unsigned bits)
+void Serial::DeviceState::set_data_bits(unsigned bits)
{
#ifdef WIN32
state.ByteSize = bits;
case 6: flag = CS6; break;
case 7: flag = CS7; break;
case 8: flag = CS8; break;
- default: throw InvalidParameterValue("Invalid data bit count");
+ default: throw invalid_argument("set_data_bits");
}
state.c_cflag = (state.c_cflag&~CSIZE)|flag;
#endif
}
-void set_parity(DeviceState &state, Serial::Parity par)
+void Serial::DeviceState::set_parity(Serial::Parity par)
{
#ifdef WIN32
switch(par)
case Serial::NONE: state.Parity = NOPARITY; break;
case Serial::EVEN: state.Parity = EVENPARITY; break;
case Serial::ODD: state.Parity = ODDPARITY; break;
- default: throw InvalidParameterValue("Invalid parity");
+ default: throw invalid_argument("set_parity");
}
#else
tcflag_t flag;
case Serial::NONE: flag = 0; break;
case Serial::EVEN: flag = PARENB; break;
case Serial::ODD: flag = PARENB|PARODD; break;
- default: throw InvalidParameterValue("Invalid parity");
+ default: throw invalid_argument("set_parity");
}
state.c_cflag = (state.c_cflag&~(PARENB|PARODD))|flag;
#endif
}
-void set_stop_bits(DeviceState &state, unsigned bits)
+void Serial::DeviceState::set_stop_bits(unsigned bits)
{
#ifdef WIN32
switch(bits)
{
case 1: state.StopBits = ONESTOPBIT; break;
case 2: state.StopBits = TWOSTOPBITS; break;
- default: throw InvalidParameterValue("Invalid stop bit count");
+ default: throw invalid_argument("set_stop_bits");
}
#else
tcflag_t flag;
{
case 1: flag = 0; break;
case 2: flag = CSTOPB; break;
- default: throw InvalidParameterValue("Invalid stop bit count");
+ default: throw invalid_argument("set_stop_bits");
}
state.c_cflag = (state.c_cflag&~CSTOPB)|flag;
#endif
}
-}
-
-
-namespace Msp {
-namespace IO {
-Serial::Serial(const string &descr)
+Serial::Serial(const string &descr):
+ reader(handle, 1024)
{
string::size_type comma = descr.find(',');
string port = descr.substr(0, comma);
#ifdef WIN32
port = "\\\\.\\"+port;
- handle = CreateFile(port.c_str(), GENERIC_READ|GENERIC_WRITE, 0, 0, OPEN_EXISTING, FILE_ATTRIBUTE_NORMAL, 0);
- if(handle==INVALID_HANDLE_VALUE)
- throw SystemError(format("Can't open serial port '%s'", port), GetLastError());
+ *handle = CreateFile(port.c_str(), GENERIC_READ|GENERIC_WRITE, 0, 0, OPEN_EXISTING, FILE_ATTRIBUTE_NORMAL|FILE_FLAG_OVERLAPPED, 0);
+ if(!handle)
+ throw system_error(format("CreateFile(%s)", port));
mode = M_READ|M_WRITE;
COMMTIMEOUTS timeouts;
timeouts.ReadTotalTimeoutConstant = MAXDWORD-1;
timeouts.WriteTotalTimeoutMultiplier = 0;
timeouts.WriteTotalTimeoutConstant = 0;
- SetCommTimeouts(handle, &timeouts);
+ SetCommTimeouts(*handle, &timeouts);
#else
if(port.compare(0, 5, "/dev/"))
port = "/dev/"+port;
- handle = open(port.c_str(), O_RDWR);
- if(handle==-1)
- throw SystemError(format("Can't open serial port '%s'", port), errno);
+ *handle = open(port.c_str(), O_RDWR);
+ if(!handle)
+ throw system_error(format("open(%s)", port));
mode = M_READ|M_WRITE;
termios t;
- tcgetattr(handle, &t);
- t.c_lflag &= ~(ECHO|ICANON);
- t.c_oflag &= ~OPOST;
- tcsetattr(handle, TCSADRAIN, &t);
+ tcgetattr(*handle, &t);
+ t.c_iflag &= ~(ISTRIP|INLCR|IGNCR|ICRNL|IXON);
+ t.c_lflag &= ~(ECHO|ICANON|ISIG|IEXTEN);
+ t.c_oflag &= ~(OPOST|OCRNL|ONOCR|ONLRET);
+ t.c_cc[VMIN] = 1;
+ t.c_cc[VTIME] = 0;
+ tcsetattr(*handle, TCSADRAIN, &t);
#endif
if(comma!=string::npos)
void Serial::close()
{
-#ifdef WIN32
- CloseHandle(handle);
-#else
- ::close(handle);
-#endif
+ sys_close(handle);
}
void Serial::set_block(bool b)
mode = mode&~M_NONBLOCK;
#ifndef WIN32
- int flags = fcntl(handle, F_GETFD);
- fcntl(handle, F_SETFL, (flags&O_NONBLOCK)|(b?0:O_NONBLOCK));
+ int flags = fcntl(*handle, F_GETFD);
+ fcntl(*handle, F_SETFL, (flags&O_NONBLOCK)|(b?0:O_NONBLOCK));
#endif
}
void Serial::set_baud_rate(unsigned rate)
{
DeviceState state;
- get_state(handle, state);
- ::set_baud_rate(state, rate);
- set_state(handle, state);
+ state.get_from(handle);
+ state.set_baud_rate(rate);
+ state.apply_to(handle);
}
void Serial::set_data_bits(unsigned bits)
{
DeviceState state;
- get_state(handle, state);
- ::set_data_bits(state, bits);
- set_state(handle, state);
+ state.get_from(handle);
+ state.set_data_bits(bits);
+ state.apply_to(handle);
}
void Serial::set_parity(Parity par)
{
DeviceState state;
- get_state(handle, state);
- ::set_parity(state, par);
- set_state(handle, state);
+ state.get_from(handle);
+ state.set_parity(par);
+ state.apply_to(handle);
}
void Serial::set_stop_bits(unsigned bits)
{
DeviceState state;
- get_state(handle, state);
- ::set_stop_bits(state, bits);
- set_state(handle, state);
+ state.get_from(handle);
+ state.set_stop_bits(bits);
+ state.apply_to(handle);
}
void Serial::set_parameters(const string ¶ms)
unsigned i;
for(i=0; i<params.size() && isdigit(params[i]); ++i) ;
if(i+4!=params.size() || params[i]!=',')
- throw InvalidParameterValue("Invalid parameter string");
+ throw invalid_argument("Serial::set_parameters");
if(params[i+1]<'5' || params[i+1]>'8')
- throw InvalidParameterValue("Invalid data bit count");
+ throw invalid_argument("Serial::set_parameters data_bits");
if(params[i+2]!='N' && params[i+2]!='E' && params[i+2]!='O')
- throw InvalidParameterValue("Invalid parity");
+ throw invalid_argument("Serial::set_parameters parity");
if(params[i+3]!='1' && params[i+3]!='2')
- throw InvalidParameterValue("Invalid stop bit count");
+ throw invalid_argument("Serial::set_parameters stop_bits");
DeviceState state;
- get_state(handle, state);
- ::set_baud_rate(state, lexical_cast<unsigned>(params.substr(0, i)));
- ::set_data_bits(state, params[i+1]-'0');
- ::set_parity(state, (params[i+2]=='E' ? EVEN : params[i+2]=='O' ? ODD : NONE));
- ::set_stop_bits(state, params[i+3]-'0');
- set_state(handle, state);
+ state.get_from(handle);
+ state.set_baud_rate(lexical_cast<unsigned>(params.substr(0, i)));
+ state.set_data_bits(params[i+1]-'0');
+ state.set_parity((params[i+2]=='E' ? EVEN : params[i+2]=='O' ? ODD : NONE));
+ state.set_stop_bits(params[i+3]-'0');
+ state.apply_to(handle);
}
unsigned Serial::do_write(const char *buf, unsigned size)
if(size==0)
return 0;
-#ifdef WIN32
- DWORD ret;
- if(WriteFile(handle, buf, size, &ret, 0)==0)
- throw SystemError("Writing to serial port failed", GetLastError());
-#else
- int ret = ::write(handle, buf, size);
- if(ret==-1)
- {
- if(errno==EAGAIN)
- return 0;
- else
- throw SystemError("Writing to serial port failed", errno);
- }
-#endif
-
- return ret;
+ return sys_write(handle, buf, size);
}
unsigned Serial::do_read(char *buf, unsigned size)
if(size==0)
return 0;
-#ifdef WIN32
- DWORD ret;
- if(ReadFile(handle, buf, size, &ret, 0)==0)
- throw SystemError("Reading from serial port failed", GetLastError());
-#else
- int ret = ::read(handle, buf, size);
- if(ret==-1)
- {
- if(errno==EAGAIN)
- return 0;
- else
- throw SystemError("Reading from serial port failed", errno);
- }
-#endif
+ unsigned ret = reader.read(buf, size);
+ if(ret==0)
+ set_eof();
return ret;
}
-Handle Serial::get_event_handle()
-{
-#ifdef WIN32
- throw Exception("Serial port events not supported on win32 yet");
-#else
- return handle;
-#endif
-}
-
} // namespace IO
} // namespace Msp