8 #include <msp/strings/formatter.h>
17 using namespace Msp::IO;
20 typedef DCB DeviceState;
22 typedef termios DeviceState;
25 void get_state(Handle handle, DeviceState &state)
28 GetCommState(handle, &state);
30 tcgetattr(handle, &state);
34 void set_state(Handle handle, DeviceState &state)
37 if(SetCommState(handle, &state)==0)
38 throw SystemError("Cannot set serial port parameters", GetLastError());
40 if(tcsetattr(handle, TCSADRAIN, &state)==-1)
41 throw SystemError("Cannot set serial port parameters", errno);
45 void set_baud_rate(DeviceState &state, unsigned baud)
48 state.BaudRate = baud;
53 case 0: speed = B0; break;
54 case 50: speed = B50; break;
55 case 75: speed = B75; break;
56 case 110: speed = B110; break;
57 case 134: speed = B134; break;
58 case 150: speed = B150; break;
59 case 200: speed = B200; break;
60 case 300: speed = B300; break;
61 case 600: speed = B600; break;
62 case 1200: speed = B1200; break;
63 case 1800: speed = B1800; break;
64 case 2400: speed = B2400; break;
65 case 4800: speed = B4800; break;
66 case 9600: speed = B9600; break;
67 case 19200: speed = B19200; break;
68 case 38400: speed = B38400; break;
69 case 57600: speed = B57600; break;
70 case 115200: speed = B115200; break;
71 case 230400: speed = B230400; break;
72 default: throw InvalidParameterValue("Invalid baud rate");
75 cfsetospeed(&state, speed);
76 cfsetispeed(&state, speed);
80 void set_data_bits(DeviceState &state, unsigned bits)
83 state.ByteSize = bits;
88 case 5: flag = CS5; break;
89 case 6: flag = CS6; break;
90 case 7: flag = CS7; break;
91 case 8: flag = CS8; break;
92 default: throw InvalidParameterValue("Invalid data bit count");
95 state.c_cflag = (state.c_cflag&~CSIZE)|flag;
99 void set_parity(DeviceState &state, Serial::Parity par)
104 case Serial::NONE: state.Parity = NOPARITY; break;
105 case Serial::EVEN: state.Parity = EVENPARITY; break;
106 case Serial::ODD: state.Parity = ODDPARITY; break;
107 default: throw InvalidParameterValue("Invalid parity");
113 case Serial::NONE: flag = 0; break;
114 case Serial::EVEN: flag = PARENB; break;
115 case Serial::ODD: flag = PARENB|PARODD; break;
116 default: throw InvalidParameterValue("Invalid parity");
119 state.c_cflag = (state.c_cflag&~(PARENB|PARODD))|flag;
123 void set_stop_bits(DeviceState &state, unsigned bits)
128 case 1: state.StopBits = ONESTOPBIT; break;
129 case 2: state.StopBits = TWOSTOPBITS; break;
130 default: throw InvalidParameterValue("Invalid stop bit count");
136 case 1: flag = 0; break;
137 case 2: flag = CSTOPB; break;
138 default: throw InvalidParameterValue("Invalid stop bit count");
141 state.c_cflag = (state.c_cflag&~CSTOPB)|flag;
151 Serial::Serial(const string &descr)
153 string::size_type comma = descr.find(',');
154 string port = descr.substr(0, comma);
157 port = "\\\\.\\"+port;
159 handle = CreateFile(port.c_str(), GENERIC_READ|GENERIC_WRITE, 0, 0, OPEN_EXISTING, FILE_ATTRIBUTE_NORMAL, 0);
160 if(handle==INVALID_HANDLE_VALUE)
161 throw SystemError(format("Can't open serial port '%s'", port), GetLastError());
162 mode = M_READ|M_WRITE;
164 COMMTIMEOUTS timeouts;
165 timeouts.ReadIntervalTimeout = MAXDWORD;
166 timeouts.ReadTotalTimeoutMultiplier = MAXDWORD;
167 timeouts.ReadTotalTimeoutConstant = MAXDWORD-1;
168 timeouts.WriteTotalTimeoutMultiplier = 0;
169 timeouts.WriteTotalTimeoutConstant = 0;
170 SetCommTimeouts(handle, &timeouts);
172 if(port.compare(0, 5, "/dev/"))
175 handle = open(port.c_str(), O_RDWR);
177 throw SystemError(format("Can't open serial port '%s'", port), errno);
178 mode = M_READ|M_WRITE;
181 tcgetattr(handle, &t);
182 t.c_lflag &= ~(ECHO|ICANON);
184 tcsetattr(handle, TCSADRAIN, &t);
187 if(comma!=string::npos)
191 set_parameters(descr.substr(comma+1));
208 void Serial::set_block(bool b)
211 mode = mode|M_NONBLOCK;
213 mode = mode&~M_NONBLOCK;
216 int flags = fcntl(handle, F_GETFD);
217 fcntl(handle, F_SETFL, (flags&O_NONBLOCK)|(b?0:O_NONBLOCK));
221 void Serial::set_baud_rate(unsigned rate)
224 get_state(handle, state);
225 ::set_baud_rate(state, rate);
226 set_state(handle, state);
229 void Serial::set_data_bits(unsigned bits)
232 get_state(handle, state);
233 ::set_data_bits(state, bits);
234 set_state(handle, state);
237 void Serial::set_parity(Parity par)
240 get_state(handle, state);
241 ::set_parity(state, par);
242 set_state(handle, state);
245 void Serial::set_stop_bits(unsigned bits)
248 get_state(handle, state);
249 ::set_stop_bits(state, bits);
250 set_state(handle, state);
253 void Serial::set_parameters(const string ¶ms)
256 for(i=0; i<params.size() && isdigit(params[i]); ++i) ;
257 if(i+4!=params.size() || params[i]!=',')
258 throw InvalidParameterValue("Invalid parameter string");
259 if(params[i+1]<'5' || params[i+1]>'8')
260 throw InvalidParameterValue("Invalid data bit count");
261 if(params[i+2]!='N' && params[i+2]!='E' && params[i+2]!='O')
262 throw InvalidParameterValue("Invalid parity");
263 if(params[i+3]!='1' && params[i+3]!='2')
264 throw InvalidParameterValue("Invalid stop bit count");
267 get_state(handle, state);
268 ::set_baud_rate(state, lexical_cast<unsigned>(params.substr(0, i)));
269 ::set_data_bits(state, params[i+1]-'0');
270 ::set_parity(state, (params[i+2]=='E' ? EVEN : params[i+2]=='O' ? ODD : NONE));
271 ::set_stop_bits(state, params[i+3]-'0');
272 set_state(handle, state);
275 Handle Serial::get_event_handle()
278 throw Exception("Serial port events not supported on win32 yet");
293 unsigned Serial::do_write(const char *buf, unsigned size)
300 if(WriteFile(handle, buf, size, &ret, 0)==0)
301 throw SystemError("Writing to serial port failed", GetLastError());
303 int ret = ::write(handle, buf, size);
309 throw SystemError("Writing to serial port failed", errno);
316 unsigned Serial::do_read(char *buf, unsigned size)
323 if(ReadFile(handle, buf, size, &ret, 0)==0)
324 throw SystemError("Reading from serial port failed", GetLastError());
326 int ret = ::read(handle, buf, size);
332 throw SystemError("Reading from serial port failed", errno);