8 #include <msp/strings/format.h>
9 #include <msp/core/systemerror.h>
10 #include "handle_private.h"
18 struct Serial::DeviceState
26 void get_from(const Handle &);
27 void apply_to(const Handle &);
28 void set_baud_rate(unsigned);
29 void set_data_bits(unsigned);
30 void set_parity(Parity);
31 void set_stop_bits(unsigned);
34 void Serial::DeviceState::get_from(const Handle &handle)
37 GetCommState(*handle, &state);
39 tcgetattr(*handle, &state);
43 void Serial::DeviceState::apply_to(const Handle &handle)
46 if(SetCommState(*handle, &state)==0)
47 throw system_error("SetCommState");
49 if(tcsetattr(*handle, TCSADRAIN, &state)==-1)
50 throw system_error("tcsetattr");
54 void Serial::DeviceState::set_baud_rate(unsigned baud)
57 state.BaudRate = baud;
62 case 0: speed = B0; break;
63 case 50: speed = B50; break;
64 case 75: speed = B75; break;
65 case 110: speed = B110; break;
66 case 134: speed = B134; break;
67 case 150: speed = B150; break;
68 case 200: speed = B200; break;
69 case 300: speed = B300; break;
70 case 600: speed = B600; break;
71 case 1200: speed = B1200; break;
72 case 1800: speed = B1800; break;
73 case 2400: speed = B2400; break;
74 case 4800: speed = B4800; break;
75 case 9600: speed = B9600; break;
76 case 19200: speed = B19200; break;
77 case 38400: speed = B38400; break;
78 case 57600: speed = B57600; break;
79 case 115200: speed = B115200; break;
80 case 230400: speed = B230400; break;
81 default: throw invalid_argument("set_baud_rate");
84 cfsetospeed(&state, speed);
85 cfsetispeed(&state, speed);
89 void Serial::DeviceState::set_data_bits(unsigned bits)
92 state.ByteSize = bits;
97 case 5: flag = CS5; break;
98 case 6: flag = CS6; break;
99 case 7: flag = CS7; break;
100 case 8: flag = CS8; break;
101 default: throw invalid_argument("set_data_bits");
104 state.c_cflag = (state.c_cflag&~CSIZE)|flag;
108 void Serial::DeviceState::set_parity(Serial::Parity par)
113 case Serial::NONE: state.Parity = NOPARITY; break;
114 case Serial::EVEN: state.Parity = EVENPARITY; break;
115 case Serial::ODD: state.Parity = ODDPARITY; break;
116 default: throw invalid_argument("set_parity");
122 case Serial::NONE: flag = 0; break;
123 case Serial::EVEN: flag = PARENB; break;
124 case Serial::ODD: flag = PARENB|PARODD; break;
125 default: throw invalid_argument("set_parity");
128 state.c_cflag = (state.c_cflag&~(PARENB|PARODD))|flag;
132 void Serial::DeviceState::set_stop_bits(unsigned bits)
137 case 1: state.StopBits = ONESTOPBIT; break;
138 case 2: state.StopBits = TWOSTOPBITS; break;
139 default: throw invalid_argument("set_stop_bits");
145 case 1: flag = 0; break;
146 case 2: flag = CSTOPB; break;
147 default: throw invalid_argument("set_stop_bits");
150 state.c_cflag = (state.c_cflag&~CSTOPB)|flag;
155 Serial::Serial(const string &descr):
158 string::size_type comma = descr.find(',');
159 string port = descr.substr(0, comma);
162 port = "\\\\.\\"+port;
164 *handle = CreateFile(port.c_str(), GENERIC_READ|GENERIC_WRITE, 0, 0, OPEN_EXISTING, FILE_ATTRIBUTE_NORMAL|FILE_FLAG_OVERLAPPED, 0);
166 throw system_error(format("CreateFile(%s)", port));
167 mode = M_READ|M_WRITE;
169 COMMTIMEOUTS timeouts;
170 timeouts.ReadIntervalTimeout = MAXDWORD;
171 timeouts.ReadTotalTimeoutMultiplier = MAXDWORD;
172 timeouts.ReadTotalTimeoutConstant = MAXDWORD-1;
173 timeouts.WriteTotalTimeoutMultiplier = 0;
174 timeouts.WriteTotalTimeoutConstant = 0;
175 SetCommTimeouts(*handle, &timeouts);
177 if(port.compare(0, 5, "/dev/"))
180 *handle = open(port.c_str(), O_RDWR);
182 throw system_error(format("open(%s)", port));
183 mode = M_READ|M_WRITE;
186 tcgetattr(*handle, &t);
187 t.c_iflag &= ~(ISTRIP|INLCR|IGNCR|ICRNL|IXON);
188 t.c_lflag &= ~(ECHO|ICANON|ISIG|IEXTEN);
189 t.c_oflag &= ~(OPOST|OCRNL|ONOCR|ONLRET);
192 tcsetattr(*handle, TCSADRAIN, &t);
195 if(comma!=string::npos)
199 set_parameters(descr.substr(comma+1));
221 void Serial::set_block(bool b)
224 mode = mode|M_NONBLOCK;
226 mode = mode&~M_NONBLOCK;
229 int flags = fcntl(*handle, F_GETFD);
230 fcntl(*handle, F_SETFL, (flags&O_NONBLOCK)|(b?0:O_NONBLOCK));
234 void Serial::set_baud_rate(unsigned rate)
237 state.get_from(handle);
238 state.set_baud_rate(rate);
239 state.apply_to(handle);
242 void Serial::set_data_bits(unsigned bits)
245 state.get_from(handle);
246 state.set_data_bits(bits);
247 state.apply_to(handle);
250 void Serial::set_parity(Parity par)
253 state.get_from(handle);
254 state.set_parity(par);
255 state.apply_to(handle);
258 void Serial::set_stop_bits(unsigned bits)
261 state.get_from(handle);
262 state.set_stop_bits(bits);
263 state.apply_to(handle);
266 void Serial::set_parameters(const string ¶ms)
269 for(i=0; i<params.size() && isdigit(params[i]); ++i) ;
270 if(i+4!=params.size() || params[i]!=',')
271 throw invalid_argument("Serial::set_parameters");
272 if(params[i+1]<'5' || params[i+1]>'8')
273 throw invalid_argument("Serial::set_parameters data_bits");
274 if(params[i+2]!='N' && params[i+2]!='E' && params[i+2]!='O')
275 throw invalid_argument("Serial::set_parameters parity");
276 if(params[i+3]!='1' && params[i+3]!='2')
277 throw invalid_argument("Serial::set_parameters stop_bits");
280 state.get_from(handle);
281 state.set_baud_rate(lexical_cast<unsigned>(params.substr(0, i)));
282 state.set_data_bits(params[i+1]-'0');
283 state.set_parity((params[i+2]=='E' ? EVEN : params[i+2]=='O' ? ODD : NONE));
284 state.set_stop_bits(params[i+3]-'0');
285 state.apply_to(handle);
288 unsigned Serial::do_write(const char *buf, unsigned size)
293 return sys_write(handle, buf, size);
296 unsigned Serial::do_read(char *buf, unsigned size)
301 unsigned ret = reader.read(buf, size);