blob: 9c5d68bf58f2389cd2ae6c5cc053f0396180afdb [file] [log] [blame]
cliechti8099bed2009-08-01 23:59:18 +00001#! python
2#
3# Python Serial Port Extension for Win32, Linux, BSD, Jython
4# see __init__.py
5#
6# This module implements a RFC2217 compatible client. RF2217 descibes a
7# protocol to access serial ports over TCP/IP and allows setting the baud rate,
8# modem control lines etc.
9#
Chris Liechti01587b12015-08-05 02:39:32 +020010# (C) 2001-2015 Chris Liechti <cliechti@gmx.net>
Chris Liechtifbdd8a02015-08-09 02:37:45 +020011#
12# SPDX-License-Identifier: BSD-3-Clause
cliechti8099bed2009-08-01 23:59:18 +000013
14# TODO:
15# - setting control line -> answer is not checked (had problems with one of the
16# severs). consider implementing a compatibility mode flag to make check
17# conditional
18# - write timeout not implemented at all
cliechti8099bed2009-08-01 23:59:18 +000019
cliechti81c54762009-08-03 23:53:27 +000020##############################################################################
21# observations and issues with servers
22#=============================================================================
23# sredird V2.2.1
24# - http://www.ibiblio.org/pub/Linux/system/serial/ sredird-2.2.2.tar.gz
25# - does not acknowledge SET_CONTROL (RTS/DTR) correctly, always responding
26# [105 1] instead of the actual value.
27# - SET_BAUDRATE answer contains 4 extra null bytes -> probably for larger
28# numbers than 2**32?
29# - To get the signature [COM_PORT_OPTION 0] has to be sent.
30# - run a server: while true; do nc -l -p 7000 -c "sredird debug /dev/ttyUSB0 /var/lock/sredir"; done
31#=============================================================================
32# telnetcpcd (untested)
33# - http://ftp.wayne.edu/kermit/sredird/telnetcpcd-1.09.tar.gz
34# - To get the signature [COM_PORT_OPTION] w/o data has to be sent.
35#=============================================================================
36# ser2net
37# - does not negotiate BINARY or COM_PORT_OPTION for his side but at least
38# acknowledges that the client activates these options
39# - The configuration may be that the server prints a banner. As this client
40# implementation does a flushInput on connect, this banner is hidden from
41# the user application.
42# - NOTIFY_MODEMSTATE: the poll interval of the server seems to be one
43# second.
44# - To get the signature [COM_PORT_OPTION 0] has to be sent.
45# - run a server: run ser2net daemon, in /etc/ser2net.conf:
46# 2000:telnet:0:/dev/ttyS0:9600 remctl banner
47##############################################################################
48
49# How to identify ports? pySerial might want to support other protocols in the
50# future, so lets use an URL scheme.
51# for RFC2217 compliant servers we will use this:
52# rfc2217://<host>:<port>[/option[/option...]]
53#
54# options:
Chris Liechti01587b12015-08-05 02:39:32 +020055# - "logging" set log level print diagnostic messages (e.g. "logging=debug")
cliechti81c54762009-08-03 23:53:27 +000056# - "ign_set_control": do not look at the answers to SET_CONTROL
cliechti7cb78e82009-08-05 15:47:57 +000057# - "poll_modem": issue NOTIFY_MODEMSTATE requests when CTS/DTR/RI/CD is read.
58# Without this option it expects that the server sends notifications
59# automatically on change (which most servers do and is according to the
60# RFC).
cliechti81c54762009-08-03 23:53:27 +000061# the order of the options is not relevant
62
cliechti5cc3eb12009-08-11 23:04:30 +000063import logging
Chris Liechtic4bca9e2015-08-07 14:40:41 +020064import socket
65import struct
66import threading
67import time
68try:
69 import urlparse
70except ImportError:
71 import urllib.parse as urlparse
Chris Liechtid2146002015-08-04 16:57:16 +020072try:
73 import Queue
74except ImportError:
75 import queue as Queue
76
Chris Liechtib4cda3a2015-08-08 17:12:08 +020077from serial.serialutil import *
78
cliechti8099bed2009-08-01 23:59:18 +000079# port string is expected to be something like this:
80# rfc2217://host:port
81# host may be an IP or including domain, whatever.
82# port is 0...65535
83
cliechti86844e82009-08-12 00:05:33 +000084# map log level names to constants. used in fromURL()
cliechti5cc3eb12009-08-11 23:04:30 +000085LOGGER_LEVELS = {
Chris Liechtic4bca9e2015-08-07 14:40:41 +020086 'debug': logging.DEBUG,
87 'info': logging.INFO,
88 'warning': logging.WARNING,
89 'error': logging.ERROR,
90 }
cliechti5cc3eb12009-08-11 23:04:30 +000091
92
cliechti8099bed2009-08-01 23:59:18 +000093# telnet protocol characters
Chris Liechtib4cda3a2015-08-08 17:12:08 +020094SE = b'\xf0' # Subnegotiation End
95NOP = b'\xf1' # No Operation
96DM = b'\xf2' # Data Mark
97BRK = b'\xf3' # Break
98IP = b'\xf4' # Interrupt process
99AO = b'\xf5' # Abort output
100AYT = b'\xf6' # Are You There
101EC = b'\xf7' # Erase Character
102EL = b'\xf8' # Erase Line
103GA = b'\xf9' # Go Ahead
104SB = b'\xfa' # Subnegotiation Begin
105WILL = b'\xfb'
106WONT = b'\xfc'
107DO = b'\xfd'
108DONT = b'\xfe'
109IAC = b'\xff' # Interpret As Command
110IAC_DOUBLED = b'\xff\xff'
cliechti8099bed2009-08-01 23:59:18 +0000111
112# selected telnet options
Chris Liechtib4cda3a2015-08-08 17:12:08 +0200113BINARY = b'\x00' # 8-bit data path
114ECHO = b'\x01' # echo
115SGA = b'\x03' # suppress go ahead
cliechti8099bed2009-08-01 23:59:18 +0000116
117# RFC2217
Chris Liechtib4cda3a2015-08-08 17:12:08 +0200118COM_PORT_OPTION = b'\x2c'
cliechti8099bed2009-08-01 23:59:18 +0000119
120# Client to Access Server
Chris Liechtib4cda3a2015-08-08 17:12:08 +0200121SET_BAUDRATE = b'\x01'
122SET_DATASIZE = b'\x02'
123SET_PARITY = b'\x03'
124SET_STOPSIZE = b'\x04'
125SET_CONTROL = b'\x05'
126NOTIFY_LINESTATE = b'\x06'
127NOTIFY_MODEMSTATE = b'\x07'
128FLOWCONTROL_SUSPEND = b'\x08'
129FLOWCONTROL_RESUME = b'\x09'
130SET_LINESTATE_MASK = b'\x0a'
131SET_MODEMSTATE_MASK = b'\x0b'
132PURGE_DATA = b'\x0c'
cliechti8099bed2009-08-01 23:59:18 +0000133
Chris Liechtib4cda3a2015-08-08 17:12:08 +0200134SERVER_SET_BAUDRATE = b'\x65'
135SERVER_SET_DATASIZE = b'\x66'
136SERVER_SET_PARITY = b'\x67'
137SERVER_SET_STOPSIZE = b'\x68'
138SERVER_SET_CONTROL = b'\x69'
139SERVER_NOTIFY_LINESTATE = b'\x6a'
140SERVER_NOTIFY_MODEMSTATE = b'\x6b'
141SERVER_FLOWCONTROL_SUSPEND = b'\x6c'
142SERVER_FLOWCONTROL_RESUME = b'\x6d'
143SERVER_SET_LINESTATE_MASK = b'\x6e'
144SERVER_SET_MODEMSTATE_MASK = b'\x6f'
145SERVER_PURGE_DATA = b'\x70'
cliechti8099bed2009-08-01 23:59:18 +0000146
147RFC2217_ANSWER_MAP = {
148 SET_BAUDRATE: SERVER_SET_BAUDRATE,
149 SET_DATASIZE: SERVER_SET_DATASIZE,
150 SET_PARITY: SERVER_SET_PARITY,
151 SET_STOPSIZE: SERVER_SET_STOPSIZE,
152 SET_CONTROL: SERVER_SET_CONTROL,
153 NOTIFY_LINESTATE: SERVER_NOTIFY_LINESTATE,
154 NOTIFY_MODEMSTATE: SERVER_NOTIFY_MODEMSTATE,
155 FLOWCONTROL_SUSPEND: SERVER_FLOWCONTROL_SUSPEND,
156 FLOWCONTROL_RESUME: SERVER_FLOWCONTROL_RESUME,
157 SET_LINESTATE_MASK: SERVER_SET_LINESTATE_MASK,
158 SET_MODEMSTATE_MASK: SERVER_SET_MODEMSTATE_MASK,
159 PURGE_DATA: SERVER_PURGE_DATA,
160}
161
Chris Liechtib4cda3a2015-08-08 17:12:08 +0200162SET_CONTROL_REQ_FLOW_SETTING = b'\x00' # Request Com Port Flow Control Setting (outbound/both)
163SET_CONTROL_USE_NO_FLOW_CONTROL = b'\x01' # Use No Flow Control (outbound/both)
164SET_CONTROL_USE_SW_FLOW_CONTROL = b'\x02' # Use XON/XOFF Flow Control (outbound/both)
165SET_CONTROL_USE_HW_FLOW_CONTROL = b'\x03' # Use HARDWARE Flow Control (outbound/both)
166SET_CONTROL_REQ_BREAK_STATE = b'\x04' # Request BREAK State
167SET_CONTROL_BREAK_ON = b'\x05' # Set BREAK State ON
168SET_CONTROL_BREAK_OFF = b'\x06' # Set BREAK State OFF
169SET_CONTROL_REQ_DTR = b'\x07' # Request DTR Signal State
170SET_CONTROL_DTR_ON = b'\x08' # Set DTR Signal State ON
171SET_CONTROL_DTR_OFF = b'\x09' # Set DTR Signal State OFF
172SET_CONTROL_REQ_RTS = b'\x0a' # Request RTS Signal State
173SET_CONTROL_RTS_ON = b'\x0b' # Set RTS Signal State ON
174SET_CONTROL_RTS_OFF = b'\x0c' # Set RTS Signal State OFF
175SET_CONTROL_REQ_FLOW_SETTING_IN = b'\x0d' # Request Com Port Flow Control Setting (inbound)
176SET_CONTROL_USE_NO_FLOW_CONTROL_IN = b'\x0e' # Use No Flow Control (inbound)
177SET_CONTROL_USE_SW_FLOW_CONTOL_IN = b'\x0f' # Use XON/XOFF Flow Control (inbound)
178SET_CONTROL_USE_HW_FLOW_CONTOL_IN = b'\x10' # Use HARDWARE Flow Control (inbound)
179SET_CONTROL_USE_DCD_FLOW_CONTROL = b'\x11' # Use DCD Flow Control (outbound/both)
180SET_CONTROL_USE_DTR_FLOW_CONTROL = b'\x12' # Use DTR Flow Control (inbound)
181SET_CONTROL_USE_DSR_FLOW_CONTROL = b'\x13' # Use DSR Flow Control (outbound/both)
cliechti8099bed2009-08-01 23:59:18 +0000182
Chris Liechtib4cda3a2015-08-08 17:12:08 +0200183LINESTATE_MASK_TIMEOUT = 128 # Time-out Error
184LINESTATE_MASK_SHIFTREG_EMPTY = 64 # Transfer Shift Register Empty
185LINESTATE_MASK_TRANSREG_EMPTY = 32 # Transfer Holding Register Empty
186LINESTATE_MASK_BREAK_DETECT = 16 # Break-detect Error
187LINESTATE_MASK_FRAMING_ERROR = 8 # Framing Error
188LINESTATE_MASK_PARTIY_ERROR = 4 # Parity Error
189LINESTATE_MASK_OVERRUN_ERROR = 2 # Overrun Error
190LINESTATE_MASK_DATA_READY = 1 # Data Ready
cliechti8099bed2009-08-01 23:59:18 +0000191
Chris Liechtib4cda3a2015-08-08 17:12:08 +0200192MODEMSTATE_MASK_CD = 128 # Receive Line Signal Detect (also known as Carrier Detect)
193MODEMSTATE_MASK_RI = 64 # Ring Indicator
194MODEMSTATE_MASK_DSR = 32 # Data-Set-Ready Signal State
195MODEMSTATE_MASK_CTS = 16 # Clear-To-Send Signal State
196MODEMSTATE_MASK_CD_CHANGE = 8 # Delta Receive Line Signal Detect
197MODEMSTATE_MASK_RI_CHANGE = 4 # Trailing-edge Ring Detector
198MODEMSTATE_MASK_DSR_CHANGE = 2 # Delta Data-Set-Ready
199MODEMSTATE_MASK_CTS_CHANGE = 1 # Delta Clear-To-Send
cliechti8099bed2009-08-01 23:59:18 +0000200
Chris Liechtib4cda3a2015-08-08 17:12:08 +0200201PURGE_RECEIVE_BUFFER = b'\x01' # Purge access server receive data buffer
202PURGE_TRANSMIT_BUFFER = b'\x02' # Purge access server transmit data buffer
203PURGE_BOTH_BUFFERS = b'\x03' # Purge both the access server receive data buffer and the access server transmit data buffer
cliechti8099bed2009-08-01 23:59:18 +0000204
205
206RFC2217_PARITY_MAP = {
207 PARITY_NONE: 1,
208 PARITY_ODD: 2,
209 PARITY_EVEN: 3,
210 PARITY_MARK: 4,
211 PARITY_SPACE: 5,
212}
cliechti130d1f02009-08-04 02:10:58 +0000213RFC2217_REVERSE_PARITY_MAP = dict((v,k) for k,v in RFC2217_PARITY_MAP.items())
cliechti8099bed2009-08-01 23:59:18 +0000214
215RFC2217_STOPBIT_MAP = {
216 STOPBITS_ONE: 1,
217 STOPBITS_ONE_POINT_FIVE: 3,
218 STOPBITS_TWO: 2,
219}
cliechti130d1f02009-08-04 02:10:58 +0000220RFC2217_REVERSE_STOPBIT_MAP = dict((v,k) for k,v in RFC2217_STOPBIT_MAP.items())
cliechti8099bed2009-08-01 23:59:18 +0000221
cliechti130d1f02009-08-04 02:10:58 +0000222# Telnet filter states
223M_NORMAL = 0
224M_IAC_SEEN = 1
225M_NEGOTIATE = 2
cliechti8099bed2009-08-01 23:59:18 +0000226
cliechti130d1f02009-08-04 02:10:58 +0000227# TelnetOption and TelnetSubnegotiation states
cliechtiac205322009-08-02 20:40:21 +0000228REQUESTED = 'REQUESTED'
229ACTIVE = 'ACTIVE'
230INACTIVE = 'INACTIVE'
231REALLY_INACTIVE = 'REALLY_INACTIVE'
232
233class TelnetOption(object):
cliechti1ef7e3e2009-08-03 02:38:43 +0000234 """Manage a single telnet option, keeps track of DO/DONT WILL/WONT."""
235
cliechti86b593e2009-08-05 16:28:12 +0000236 def __init__(self, connection, name, option, send_yes, send_no, ack_yes, ack_no, initial_state, activation_callback=None):
cliechtieada4fd2013-07-31 16:26:07 +0000237 """\
238 Initialize option.
cliechti1ef7e3e2009-08-03 02:38:43 +0000239 :param connection: connection used to transmit answers
240 :param name: a readable name for debug outputs
241 :param send_yes: what to send when option is to be enabled.
242 :param send_no: what to send when option is to be disabled.
243 :param ack_yes: what to expect when remote agrees on option.
244 :param ack_no: what to expect when remote disagrees on option.
245 :param initial_state: options initialized with REQUESTED are tried to
246 be enabled on startup. use INACTIVE for all others.
247 """
cliechti2b929b72009-08-02 23:49:02 +0000248 self.connection = connection
cliechtiac205322009-08-02 20:40:21 +0000249 self.name = name
250 self.option = option
251 self.send_yes = send_yes
252 self.send_no = send_no
253 self.ack_yes = ack_yes
254 self.ack_no = ack_no
255 self.state = initial_state
256 self.active = False
cliechti86b593e2009-08-05 16:28:12 +0000257 self.activation_callback = activation_callback
cliechtiac205322009-08-02 20:40:21 +0000258
259 def __repr__(self):
cliechti1ef7e3e2009-08-03 02:38:43 +0000260 """String for debug outputs"""
cliechtiac205322009-08-02 20:40:21 +0000261 return "%s:%s(%s)" % (self.name, self.active, self.state)
262
cliechti2b929b72009-08-02 23:49:02 +0000263 def process_incoming(self, command):
cliechti7d448562014-08-03 21:57:45 +0000264 """\
265 A DO/DONT/WILL/WONT was received for this option, update state and
266 answer when needed.
267 """
cliechtiac205322009-08-02 20:40:21 +0000268 if command == self.ack_yes:
269 if self.state is REQUESTED:
270 self.state = ACTIVE
271 self.active = True
cliechti86b593e2009-08-05 16:28:12 +0000272 if self.activation_callback is not None:
273 self.activation_callback()
cliechtiac205322009-08-02 20:40:21 +0000274 elif self.state is ACTIVE:
275 pass
276 elif self.state is INACTIVE:
277 self.state = ACTIVE
cliechti1ef7e3e2009-08-03 02:38:43 +0000278 self.connection.telnetSendOption(self.send_yes, self.option)
cliechtiac205322009-08-02 20:40:21 +0000279 self.active = True
cliechti86b593e2009-08-05 16:28:12 +0000280 if self.activation_callback is not None:
281 self.activation_callback()
cliechtiac205322009-08-02 20:40:21 +0000282 elif self.state is REALLY_INACTIVE:
cliechti1ef7e3e2009-08-03 02:38:43 +0000283 self.connection.telnetSendOption(self.send_no, self.option)
cliechtiac205322009-08-02 20:40:21 +0000284 else:
285 raise ValueError('option in illegal state %r' % self)
286 elif command == self.ack_no:
287 if self.state is REQUESTED:
288 self.state = INACTIVE
289 self.active = False
290 elif self.state is ACTIVE:
291 self.state = INACTIVE
cliechti1ef7e3e2009-08-03 02:38:43 +0000292 self.connection.telnetSendOption(self.send_no, self.option)
cliechtiac205322009-08-02 20:40:21 +0000293 self.active = False
294 elif self.state is INACTIVE:
295 pass
296 elif self.state is REALLY_INACTIVE:
297 pass
298 else:
299 raise ValueError('option in illegal state %r' % self)
300
301
cliechti2b929b72009-08-02 23:49:02 +0000302class TelnetSubnegotiation(object):
cliechtieada4fd2013-07-31 16:26:07 +0000303 """\
304 A object to handle subnegotiation of options. In this case actually
305 sub-sub options for RFC 2217. It is used to track com port options.
306 """
cliechti2b929b72009-08-02 23:49:02 +0000307
308 def __init__(self, connection, name, option, ack_option=None):
309 if ack_option is None: ack_option = option
310 self.connection = connection
311 self.name = name
312 self.option = option
313 self.value = None
314 self.ack_option = ack_option
315 self.state = INACTIVE
316
317 def __repr__(self):
cliechti044d8662009-08-11 21:40:31 +0000318 """String for debug outputs."""
cliechti2b929b72009-08-02 23:49:02 +0000319 return "%s:%s" % (self.name, self.state)
320
321 def set(self, value):
cliechtieada4fd2013-07-31 16:26:07 +0000322 """\
cliechti7d448562014-08-03 21:57:45 +0000323 Request a change of the value. a request is sent to the server. if
cliechti2b929b72009-08-02 23:49:02 +0000324 the client needs to know if the change is performed he has to check the
cliechtieada4fd2013-07-31 16:26:07 +0000325 state of this object.
326 """
cliechti2b929b72009-08-02 23:49:02 +0000327 self.value = value
328 self.state = REQUESTED
cliechti1ef7e3e2009-08-03 02:38:43 +0000329 self.connection.rfc2217SendSubnegotiation(self.option, self.value)
cliechti6a300772009-08-12 02:28:56 +0000330 if self.connection.logger:
331 self.connection.logger.debug("SB Requesting %s -> %r" % (self.name, self.value))
cliechti2b929b72009-08-02 23:49:02 +0000332
333 def isReady(self):
cliechtieada4fd2013-07-31 16:26:07 +0000334 """\
cliechti7d448562014-08-03 21:57:45 +0000335 Check if answer from server has been received. when server rejects
cliechtieada4fd2013-07-31 16:26:07 +0000336 the change, raise a ValueError.
337 """
cliechti2b929b72009-08-02 23:49:02 +0000338 if self.state == REALLY_INACTIVE:
339 raise ValueError("remote rejected value for option %r" % (self.name))
340 return self.state == ACTIVE
cliechti1ef7e3e2009-08-03 02:38:43 +0000341 # add property to have a similar interface as TelnetOption
cliechti2b929b72009-08-02 23:49:02 +0000342 active = property(isReady)
343
cliechti044d8662009-08-11 21:40:31 +0000344 def wait(self, timeout=3):
cliechtieada4fd2013-07-31 16:26:07 +0000345 """\
cliechti7d448562014-08-03 21:57:45 +0000346 Wait until the subnegotiation has been acknowledged or timeout. It
cliechti1ef7e3e2009-08-03 02:38:43 +0000347 can also throw a value error when the answer from the server does not
cliechtieada4fd2013-07-31 16:26:07 +0000348 match the value sent.
349 """
cliechti044d8662009-08-11 21:40:31 +0000350 timeout_time = time.time() + timeout
cliechti2b929b72009-08-02 23:49:02 +0000351 while time.time() < timeout_time:
352 time.sleep(0.05) # prevent 100% CPU load
353 if self.isReady():
354 break
355 else:
356 raise SerialException("timeout while waiting for option %r" % (self.name))
357
358 def checkAnswer(self, suboption):
cliechtieada4fd2013-07-31 16:26:07 +0000359 """\
cliechti7d448562014-08-03 21:57:45 +0000360 Check an incoming subnegotiation block. The parameter already has
cliechtieada4fd2013-07-31 16:26:07 +0000361 cut off the header like sub option number and com port option value.
362 """
cliechti2b929b72009-08-02 23:49:02 +0000363 if self.value == suboption[:len(self.value)]:
364 self.state = ACTIVE
365 else:
366 # error propagation done in isReady
367 self.state = REALLY_INACTIVE
cliechti6a300772009-08-12 02:28:56 +0000368 if self.connection.logger:
369 self.connection.logger.debug("SB Answer %s -> %r -> %s" % (self.name, suboption, self.state))
cliechti2b929b72009-08-02 23:49:02 +0000370
371
Chris Liechtief6b7b42015-08-06 22:19:26 +0200372class Serial(SerialBase):
cliechti044d8662009-08-11 21:40:31 +0000373 """Serial port implementation for RFC 2217 remote serial ports."""
cliechti8099bed2009-08-01 23:59:18 +0000374
375 BAUDRATES = (50, 75, 110, 134, 150, 200, 300, 600, 1200, 1800, 2400, 4800,
376 9600, 19200, 38400, 57600, 115200)
377
378 def open(self):
cliechtieada4fd2013-07-31 16:26:07 +0000379 """\
380 Open port with current settings. This may throw a SerialException
381 if the port cannot be opened.
382 """
cliechti6a300772009-08-12 02:28:56 +0000383 self.logger = None
cliechti81c54762009-08-03 23:53:27 +0000384 self._ignore_set_control_answer = False
cliechti7cb78e82009-08-05 15:47:57 +0000385 self._poll_modem_state = False
cliechtidfe2d272009-08-10 22:19:41 +0000386 self._network_timeout = 3
cliechti8099bed2009-08-01 23:59:18 +0000387 if self._port is None:
388 raise SerialException("Port must be configured before it can be used.")
cliechti8f69e702011-03-19 00:22:32 +0000389 if self._isOpen:
390 raise SerialException("Port is already open.")
cliechti8099bed2009-08-01 23:59:18 +0000391 try:
Chris Liechtic4bca9e2015-08-07 14:40:41 +0200392 self._socket = socket.create_connection(self.fromURL(self.portstr))
cliechti6a300772009-08-12 02:28:56 +0000393 self._socket.setsockopt(socket.IPPROTO_TCP, socket.TCP_NODELAY, 1)
Chris Liechti68340d72015-08-03 14:15:48 +0200394 except Exception as msg:
cliechti8099bed2009-08-01 23:59:18 +0000395 self._socket = None
396 raise SerialException("Could not open port %s: %s" % (self.portstr, msg))
397
cliechti1ef7e3e2009-08-03 02:38:43 +0000398 self._socket.settimeout(5) # XXX good value?
cliechti8099bed2009-08-01 23:59:18 +0000399
cliechti1ef7e3e2009-08-03 02:38:43 +0000400 # use a thread save queue as buffer. it also simplifies implementing
401 # the read timeout
cliechti8099bed2009-08-01 23:59:18 +0000402 self._read_buffer = Queue.Queue()
cliechti81c54762009-08-03 23:53:27 +0000403 # to ensure that user writes does not interfere with internal
404 # telnet/rfc2217 options establish a lock
405 self._write_lock = threading.Lock()
cliechtiac205322009-08-02 20:40:21 +0000406 # name the following separately so that, below, a check can be easily done
407 mandadory_options = [
cliechti2b929b72009-08-02 23:49:02 +0000408 TelnetOption(self, 'we-BINARY', BINARY, WILL, WONT, DO, DONT, INACTIVE),
cliechti2b929b72009-08-02 23:49:02 +0000409 TelnetOption(self, 'we-RFC2217', COM_PORT_OPTION, WILL, WONT, DO, DONT, REQUESTED),
cliechtiac205322009-08-02 20:40:21 +0000410 ]
411 # all supported telnet options
412 self._telnet_options = [
cliechtia29275e2009-08-03 00:08:04 +0000413 TelnetOption(self, 'ECHO', ECHO, DO, DONT, WILL, WONT, REQUESTED),
cliechti2b929b72009-08-02 23:49:02 +0000414 TelnetOption(self, 'we-SGA', SGA, WILL, WONT, DO, DONT, REQUESTED),
415 TelnetOption(self, 'they-SGA', SGA, DO, DONT, WILL, WONT, REQUESTED),
cliechti81c54762009-08-03 23:53:27 +0000416 TelnetOption(self, 'they-BINARY', BINARY, DO, DONT, WILL, WONT, INACTIVE),
417 TelnetOption(self, 'they-RFC2217', COM_PORT_OPTION, DO, DONT, WILL, WONT, REQUESTED),
cliechtiac205322009-08-02 20:40:21 +0000418 ] + mandadory_options
cliechti044d8662009-08-11 21:40:31 +0000419 # RFC 2217 specific states
cliechti2b929b72009-08-02 23:49:02 +0000420 # COM port settings
421 self._rfc2217_port_settings = {
422 'baudrate': TelnetSubnegotiation(self, 'baudrate', SET_BAUDRATE, SERVER_SET_BAUDRATE),
423 'datasize': TelnetSubnegotiation(self, 'datasize', SET_DATASIZE, SERVER_SET_DATASIZE),
424 'parity': TelnetSubnegotiation(self, 'parity', SET_PARITY, SERVER_SET_PARITY),
425 'stopsize': TelnetSubnegotiation(self, 'stopsize', SET_STOPSIZE, SERVER_SET_STOPSIZE),
426 }
cliechticb20a4f2011-04-25 02:25:54 +0000427 # There are more subnegotiation objects, combine all in one dictionary
cliechti2b929b72009-08-02 23:49:02 +0000428 # for easy access
429 self._rfc2217_options = {
430 'purge': TelnetSubnegotiation(self, 'purge', PURGE_DATA, SERVER_PURGE_DATA),
cliechti81c54762009-08-03 23:53:27 +0000431 'control': TelnetSubnegotiation(self, 'control', SET_CONTROL, SERVER_SET_CONTROL),
cliechti2b929b72009-08-02 23:49:02 +0000432 }
433 self._rfc2217_options.update(self._rfc2217_port_settings)
434 # cache for line and modem states that the server sends to us
cliechti8099bed2009-08-01 23:59:18 +0000435 self._linestate = 0
cliechti7cb78e82009-08-05 15:47:57 +0000436 self._modemstate = None
437 self._modemstate_expires = 0
cliechti044d8662009-08-11 21:40:31 +0000438 # RFC 2217 flow control between server and client
cliechti672d0292009-08-03 02:01:57 +0000439 self._remote_suspend_flow = False
cliechti8099bed2009-08-01 23:59:18 +0000440
cliechti1ef7e3e2009-08-03 02:38:43 +0000441 self._thread = threading.Thread(target=self._telnetReadLoop)
cliechti8099bed2009-08-01 23:59:18 +0000442 self._thread.setDaemon(True)
cliechti5cc3eb12009-08-11 23:04:30 +0000443 self._thread.setName('pySerial RFC 2217 reader thread for %s' % (self._port,))
cliechti8099bed2009-08-01 23:59:18 +0000444 self._thread.start()
445
cliechti044d8662009-08-11 21:40:31 +0000446 # negotiate Telnet/RFC 2217 -> send initial requests
cliechtiac205322009-08-02 20:40:21 +0000447 for option in self._telnet_options:
448 if option.state is REQUESTED:
cliechti1ef7e3e2009-08-03 02:38:43 +0000449 self.telnetSendOption(option.send_yes, option.option)
cliechtiac205322009-08-02 20:40:21 +0000450 # now wait until important options are negotiated
cliechtidfe2d272009-08-10 22:19:41 +0000451 timeout_time = time.time() + self._network_timeout
cliechtiac205322009-08-02 20:40:21 +0000452 while time.time() < timeout_time:
cliechtiac205322009-08-02 20:40:21 +0000453 time.sleep(0.05) # prevent 100% CPU load
cliechti7c213a92014-07-31 15:29:34 +0000454 if sum(o.active for o in mandadory_options) == sum(o.state != INACTIVE for o in mandadory_options):
cliechti2b929b72009-08-02 23:49:02 +0000455 break
456 else:
457 raise SerialException("Remote does not seem to support RFC2217 or BINARY mode %r" % mandadory_options)
cliechti6a300772009-08-12 02:28:56 +0000458 if self.logger:
459 self.logger.info("Negotiated options: %s" % self._telnet_options)
cliechti8099bed2009-08-01 23:59:18 +0000460
cliechti044d8662009-08-11 21:40:31 +0000461 # fine, go on, set RFC 2271 specific things
cliechti8099bed2009-08-01 23:59:18 +0000462 self._reconfigurePort()
cliechti2b929b72009-08-02 23:49:02 +0000463 # all things set up get, now a clean start
cliechti8099bed2009-08-01 23:59:18 +0000464 self._isOpen = True
465 if not self._rtscts:
466 self.setRTS(True)
467 self.setDTR(True)
468 self.flushInput()
469 self.flushOutput()
470
471 def _reconfigurePort(self):
472 """Set communication parameters on opened port."""
473 if self._socket is None:
474 raise SerialException("Can only operate on open ports")
475
cliechti8099bed2009-08-01 23:59:18 +0000476 # if self._timeout != 0 and self._interCharTimeout is not None:
cliechti8099bed2009-08-01 23:59:18 +0000477 # XXX
478
479 if self._writeTimeout is not None:
480 raise NotImplementedError('writeTimeout is currently not supported')
cliechti2b929b72009-08-02 23:49:02 +0000481 # XXX
cliechti8099bed2009-08-01 23:59:18 +0000482
cliechti2b929b72009-08-02 23:49:02 +0000483 # Setup the connection
cliechti1ef7e3e2009-08-03 02:38:43 +0000484 # to get good performance, all parameter changes are sent first...
Chris Liechti01587b12015-08-05 02:39:32 +0200485 if not 0 < self._baudrate < 2**32:
cliechti81c54762009-08-03 23:53:27 +0000486 raise ValueError("invalid baudrate: %r" % (self._baudrate))
Chris Liechti01587b12015-08-05 02:39:32 +0200487 self._rfc2217_port_settings['baudrate'].set(struct.pack(b'!I', self._baudrate))
488 self._rfc2217_port_settings['datasize'].set(struct.pack(b'!B', self._bytesize))
489 self._rfc2217_port_settings['parity'].set(struct.pack(b'!B', RFC2217_PARITY_MAP[self._parity]))
490 self._rfc2217_port_settings['stopsize'].set(struct.pack(b'!B', RFC2217_STOPBIT_MAP[self._stopbits]))
cliechti8099bed2009-08-01 23:59:18 +0000491
cliechti2b929b72009-08-02 23:49:02 +0000492 # and now wait until parameters are active
493 items = self._rfc2217_port_settings.values()
cliechti6a300772009-08-12 02:28:56 +0000494 if self.logger:
495 self.logger.debug("Negotiating settings: %s" % (items,))
cliechtidfe2d272009-08-10 22:19:41 +0000496 timeout_time = time.time() + self._network_timeout
cliechti2b929b72009-08-02 23:49:02 +0000497 while time.time() < timeout_time:
498 time.sleep(0.05) # prevent 100% CPU load
499 if sum(o.active for o in items) == len(items):
500 break
501 else:
502 raise SerialException("Remote does not accept parameter change (RFC2217): %r" % items)
cliechti6a300772009-08-12 02:28:56 +0000503 if self.logger:
504 self.logger.info("Negotiated settings: %s" % (items,))
cliechti8099bed2009-08-01 23:59:18 +0000505
506 if self._rtscts and self._xonxoff:
cliechti1ef7e3e2009-08-03 02:38:43 +0000507 raise ValueError('xonxoff and rtscts together are not supported')
cliechti8099bed2009-08-01 23:59:18 +0000508 elif self._rtscts:
cliechti1ef7e3e2009-08-03 02:38:43 +0000509 self.rfc2217SetControl(SET_CONTROL_USE_HW_FLOW_CONTROL)
cliechti8099bed2009-08-01 23:59:18 +0000510 elif self._xonxoff:
cliechti1ef7e3e2009-08-03 02:38:43 +0000511 self.rfc2217SetControl(SET_CONTROL_USE_SW_FLOW_CONTROL)
cliechti8099bed2009-08-01 23:59:18 +0000512 else:
cliechti1ef7e3e2009-08-03 02:38:43 +0000513 self.rfc2217SetControl(SET_CONTROL_USE_NO_FLOW_CONTROL)
cliechti8099bed2009-08-01 23:59:18 +0000514
515 def close(self):
516 """Close port"""
517 if self._isOpen:
518 if self._socket:
519 try:
520 self._socket.shutdown(socket.SHUT_RDWR)
521 self._socket.close()
522 except:
523 # ignore errors.
524 pass
525 self._socket = None
526 if self._thread:
527 self._thread.join()
528 self._isOpen = False
529 # in case of quick reconnects, give the server some time
530 time.sleep(0.3)
531
532 def makeDeviceName(self, port):
533 raise SerialException("there is no sensible way to turn numbers into URLs")
534
535 def fromURL(self, url):
cliechti1ef7e3e2009-08-03 02:38:43 +0000536 """extract host and port from an URL string"""
Chris Liechtia4222112015-08-07 01:03:12 +0200537 parts = urlparse.urlsplit(url)
538 if parts.scheme.lower() != "rfc2217":
Chris Liechtic4bca9e2015-08-07 14:40:41 +0200539 raise SerialException('expected a string in the form "rfc2217://<host>:<port>[/option[/option...]]": not starting with rfc2217:// (%r)' % (parts.scheme,))
cliechti8099bed2009-08-01 23:59:18 +0000540 try:
Chris Liechtia4222112015-08-07 01:03:12 +0200541 # process options now, directly altering self
542 for option in parts.path.lower().split('/'):
543 if '=' in option:
544 option, value = option.split('=', 1)
545 else:
546 value = None
547 if not option:
548 pass
549 elif option == 'logging':
550 logging.basicConfig() # XXX is that good to call it here?
551 self.logger = logging.getLogger('pySerial.rfc2217')
552 self.logger.setLevel(LOGGER_LEVELS[value])
553 self.logger.debug('enabled logging')
554 elif option == 'ign_set_control':
555 self._ignore_set_control_answer = True
556 elif option == 'poll_modem':
557 self._poll_modem_state = True
558 elif option == 'timeout':
559 self._network_timeout = float(value)
560 else:
561 raise ValueError('unknown option: %r' % (option,))
cliechti81c54762009-08-03 23:53:27 +0000562 # get host and port
Chris Liechtia4222112015-08-07 01:03:12 +0200563 host, port = parts.hostname, parts.port
cliechti8099bed2009-08-01 23:59:18 +0000564 if not 0 <= port < 65536: raise ValueError("port not in range 0...65535")
Chris Liechti68340d72015-08-03 14:15:48 +0200565 except ValueError as e:
Chris Liechtia4222112015-08-07 01:03:12 +0200566 raise SerialException('expected a string in the form "rfc2217://<host>:<port>[/option[/option...]]": %s' % e)
cliechti8099bed2009-08-01 23:59:18 +0000567 return (host, port)
568
569 # - - - - - - - - - - - - - - - - - - - - - - - -
570
571 def inWaiting(self):
572 """Return the number of characters currently in the input buffer."""
573 if not self._isOpen: raise portNotOpenError
574 return self._read_buffer.qsize()
575
576 def read(self, size=1):
cliechtieada4fd2013-07-31 16:26:07 +0000577 """\
578 Read size bytes from the serial port. If a timeout is set it may
cliechti8099bed2009-08-01 23:59:18 +0000579 return less characters as requested. With no timeout it will block
cliechtieada4fd2013-07-31 16:26:07 +0000580 until the requested number of bytes is read.
581 """
cliechti8099bed2009-08-01 23:59:18 +0000582 if not self._isOpen: raise portNotOpenError
583 data = bytearray()
584 try:
585 while len(data) < size:
cliechti81c54762009-08-03 23:53:27 +0000586 if self._thread is None:
587 raise SerialException('connection failed (reader thread died)')
Chris Liechti01587b12015-08-05 02:39:32 +0200588 data += self._read_buffer.get(True, self._timeout)
cliechti8099bed2009-08-01 23:59:18 +0000589 except Queue.Empty: # -> timeout
590 pass
591 return bytes(data)
592
593 def write(self, data):
cliechtieada4fd2013-07-31 16:26:07 +0000594 """\
595 Output the given string over the serial port. Can block if the
cliechti8099bed2009-08-01 23:59:18 +0000596 connection is blocked. May raise SerialException if the connection is
cliechtieada4fd2013-07-31 16:26:07 +0000597 closed.
598 """
cliechti8099bed2009-08-01 23:59:18 +0000599 if not self._isOpen: raise portNotOpenError
Chris Liechti01587b12015-08-05 02:39:32 +0200600 with self._write_lock:
cliechti81c54762009-08-03 23:53:27 +0000601 try:
cliechti38077122013-10-16 02:57:27 +0000602 self._socket.sendall(to_bytes(data).replace(IAC, IAC_DOUBLED))
Chris Liechti68340d72015-08-03 14:15:48 +0200603 except socket.error as e:
cliechticb20a4f2011-04-25 02:25:54 +0000604 raise SerialException("connection failed (socket error): %s" % e) # XXX what exception if socket connection fails
cliechti8099bed2009-08-01 23:59:18 +0000605 return len(data)
606
607 def flushInput(self):
608 """Clear input buffer, discarding all that is in the buffer."""
609 if not self._isOpen: raise portNotOpenError
cliechti1ef7e3e2009-08-03 02:38:43 +0000610 self.rfc2217SendPurge(PURGE_RECEIVE_BUFFER)
cliechti8099bed2009-08-01 23:59:18 +0000611 # empty read buffer
612 while self._read_buffer.qsize():
613 self._read_buffer.get(False)
614
615 def flushOutput(self):
cliechtieada4fd2013-07-31 16:26:07 +0000616 """\
617 Clear output buffer, aborting the current output and
618 discarding all that is in the buffer.
619 """
cliechti8099bed2009-08-01 23:59:18 +0000620 if not self._isOpen: raise portNotOpenError
cliechti1ef7e3e2009-08-03 02:38:43 +0000621 self.rfc2217SendPurge(PURGE_TRANSMIT_BUFFER)
cliechti8099bed2009-08-01 23:59:18 +0000622
623 def sendBreak(self, duration=0.25):
cliechti7d448562014-08-03 21:57:45 +0000624 """\
625 Send break condition. Timed, returns to idle state after given
626 duration.
627 """
cliechti8099bed2009-08-01 23:59:18 +0000628 if not self._isOpen: raise portNotOpenError
629 self.setBreak(True)
630 time.sleep(duration)
631 self.setBreak(False)
632
633 def setBreak(self, level=True):
cliechtieada4fd2013-07-31 16:26:07 +0000634 """\
635 Set break: Controls TXD. When active, to transmitting is
636 possible.
637 """
cliechti8099bed2009-08-01 23:59:18 +0000638 if not self._isOpen: raise portNotOpenError
cliechti6a300772009-08-12 02:28:56 +0000639 if self.logger:
640 self.logger.info('set BREAK to %s' % ('inactive', 'active')[bool(level)])
cliechti8099bed2009-08-01 23:59:18 +0000641 if level:
cliechti1ef7e3e2009-08-03 02:38:43 +0000642 self.rfc2217SetControl(SET_CONTROL_BREAK_ON)
cliechti8099bed2009-08-01 23:59:18 +0000643 else:
cliechti1ef7e3e2009-08-03 02:38:43 +0000644 self.rfc2217SetControl(SET_CONTROL_BREAK_OFF)
cliechti8099bed2009-08-01 23:59:18 +0000645
646 def setRTS(self, level=True):
cliechti044d8662009-08-11 21:40:31 +0000647 """Set terminal status line: Request To Send."""
cliechti8099bed2009-08-01 23:59:18 +0000648 if not self._isOpen: raise portNotOpenError
cliechti6a300772009-08-12 02:28:56 +0000649 if self.logger:
650 self.logger.info('set RTS to %s' % ('inactive', 'active')[bool(level)])
cliechti8099bed2009-08-01 23:59:18 +0000651 if level:
cliechti1ef7e3e2009-08-03 02:38:43 +0000652 self.rfc2217SetControl(SET_CONTROL_RTS_ON)
cliechti8099bed2009-08-01 23:59:18 +0000653 else:
cliechti1ef7e3e2009-08-03 02:38:43 +0000654 self.rfc2217SetControl(SET_CONTROL_RTS_OFF)
cliechti8099bed2009-08-01 23:59:18 +0000655
656 def setDTR(self, level=True):
cliechti044d8662009-08-11 21:40:31 +0000657 """Set terminal status line: Data Terminal Ready."""
cliechti8099bed2009-08-01 23:59:18 +0000658 if not self._isOpen: raise portNotOpenError
cliechti6a300772009-08-12 02:28:56 +0000659 if self.logger:
660 self.logger.info('set DTR to %s' % ('inactive', 'active')[bool(level)])
cliechti8099bed2009-08-01 23:59:18 +0000661 if level:
cliechti1ef7e3e2009-08-03 02:38:43 +0000662 self.rfc2217SetControl(SET_CONTROL_DTR_ON)
cliechti8099bed2009-08-01 23:59:18 +0000663 else:
cliechti1ef7e3e2009-08-03 02:38:43 +0000664 self.rfc2217SetControl(SET_CONTROL_DTR_OFF)
cliechti8099bed2009-08-01 23:59:18 +0000665
666 def getCTS(self):
cliechti044d8662009-08-11 21:40:31 +0000667 """Read terminal status line: Clear To Send."""
cliechti8099bed2009-08-01 23:59:18 +0000668 if not self._isOpen: raise portNotOpenError
cliechti7cb78e82009-08-05 15:47:57 +0000669 return bool(self.getModemState() & MODEMSTATE_MASK_CTS)
cliechti8099bed2009-08-01 23:59:18 +0000670
671 def getDSR(self):
cliechti044d8662009-08-11 21:40:31 +0000672 """Read terminal status line: Data Set Ready."""
cliechti8099bed2009-08-01 23:59:18 +0000673 if not self._isOpen: raise portNotOpenError
cliechti7cb78e82009-08-05 15:47:57 +0000674 return bool(self.getModemState() & MODEMSTATE_MASK_DSR)
cliechti8099bed2009-08-01 23:59:18 +0000675
676 def getRI(self):
cliechti044d8662009-08-11 21:40:31 +0000677 """Read terminal status line: Ring Indicator."""
cliechti8099bed2009-08-01 23:59:18 +0000678 if not self._isOpen: raise portNotOpenError
cliechti7cb78e82009-08-05 15:47:57 +0000679 return bool(self.getModemState() & MODEMSTATE_MASK_RI)
cliechti8099bed2009-08-01 23:59:18 +0000680
681 def getCD(self):
cliechti044d8662009-08-11 21:40:31 +0000682 """Read terminal status line: Carrier Detect."""
cliechti8099bed2009-08-01 23:59:18 +0000683 if not self._isOpen: raise portNotOpenError
cliechti7cb78e82009-08-05 15:47:57 +0000684 return bool(self.getModemState() & MODEMSTATE_MASK_CD)
cliechti8099bed2009-08-01 23:59:18 +0000685
686 # - - - platform specific - - -
687 # None so far
688
689 # - - - RFC2217 specific - - -
690
cliechti1ef7e3e2009-08-03 02:38:43 +0000691 def _telnetReadLoop(self):
cliechti7d448562014-08-03 21:57:45 +0000692 """Read loop for the socket."""
cliechti8099bed2009-08-01 23:59:18 +0000693 mode = M_NORMAL
694 suboption = None
cliechti81c54762009-08-03 23:53:27 +0000695 try:
696 while self._socket is not None:
697 try:
698 data = self._socket.recv(1024)
699 except socket.timeout:
700 # just need to get out of recv form time to time to check if
701 # still alive
702 continue
Chris Liechti68340d72015-08-03 14:15:48 +0200703 except socket.error as e:
cliechti81c54762009-08-03 23:53:27 +0000704 # connection fails -> terminate loop
cliechticb20a4f2011-04-25 02:25:54 +0000705 if self.logger:
706 self.logger.debug("socket error in reader thread: %s" % (e,))
cliechti81c54762009-08-03 23:53:27 +0000707 break
cliechticb20a4f2011-04-25 02:25:54 +0000708 if not data: break # lost connection
Chris Liechtif99cd5c2015-08-13 22:54:16 +0200709 for byte in iterbytes(data):
cliechti81c54762009-08-03 23:53:27 +0000710 if mode == M_NORMAL:
711 # interpret as command or as data
712 if byte == IAC:
713 mode = M_IAC_SEEN
cliechti8099bed2009-08-01 23:59:18 +0000714 else:
cliechti81c54762009-08-03 23:53:27 +0000715 # store data in read buffer or sub option buffer
716 # depending on state
717 if suboption is not None:
Chris Liechti01587b12015-08-05 02:39:32 +0200718 suboption += byte
cliechti81c54762009-08-03 23:53:27 +0000719 else:
720 self._read_buffer.put(byte)
721 elif mode == M_IAC_SEEN:
722 if byte == IAC:
723 # interpret as command doubled -> insert character
724 # itself
cliechtif325c032009-12-25 16:09:49 +0000725 if suboption is not None:
Chris Liechti01587b12015-08-05 02:39:32 +0200726 suboption += IAC
cliechtif325c032009-12-25 16:09:49 +0000727 else:
728 self._read_buffer.put(IAC)
cliechti81c54762009-08-03 23:53:27 +0000729 mode = M_NORMAL
730 elif byte == SB:
731 # sub option start
732 suboption = bytearray()
733 mode = M_NORMAL
734 elif byte == SE:
735 # sub option end -> process it now
736 self._telnetProcessSubnegotiation(bytes(suboption))
737 suboption = None
738 mode = M_NORMAL
739 elif byte in (DO, DONT, WILL, WONT):
740 # negotiation
741 telnet_command = byte
742 mode = M_NEGOTIATE
743 else:
744 # other telnet commands
745 self._telnetProcessCommand(byte)
746 mode = M_NORMAL
747 elif mode == M_NEGOTIATE: # DO, DONT, WILL, WONT was received, option now following
748 self._telnetNegotiateOption(telnet_command, byte)
cliechti8099bed2009-08-01 23:59:18 +0000749 mode = M_NORMAL
cliechti81c54762009-08-03 23:53:27 +0000750 finally:
751 self._thread = None
cliechti6a300772009-08-12 02:28:56 +0000752 if self.logger:
753 self.logger.debug("read thread terminated")
cliechti8099bed2009-08-01 23:59:18 +0000754
755 # - incoming telnet commands and options
756
cliechti1ef7e3e2009-08-03 02:38:43 +0000757 def _telnetProcessCommand(self, command):
cliechti044d8662009-08-11 21:40:31 +0000758 """Process commands other than DO, DONT, WILL, WONT."""
cliechti1ef7e3e2009-08-03 02:38:43 +0000759 # Currently none. RFC2217 only uses negotiation and subnegotiation.
cliechti6a300772009-08-12 02:28:56 +0000760 if self.logger:
761 self.logger.warning("ignoring Telnet command: %r" % (command,))
cliechti8099bed2009-08-01 23:59:18 +0000762
cliechti1ef7e3e2009-08-03 02:38:43 +0000763 def _telnetNegotiateOption(self, command, option):
cliechti044d8662009-08-11 21:40:31 +0000764 """Process incoming DO, DONT, WILL, WONT."""
cliechti2b929b72009-08-02 23:49:02 +0000765 # check our registered telnet options and forward command to them
766 # they know themselves if they have to answer or not
cliechtiac205322009-08-02 20:40:21 +0000767 known = False
768 for item in self._telnet_options:
cliechti2b929b72009-08-02 23:49:02 +0000769 # can have more than one match! as some options are duplicated for
770 # 'us' and 'them'
cliechtiac205322009-08-02 20:40:21 +0000771 if item.option == option:
cliechti2b929b72009-08-02 23:49:02 +0000772 item.process_incoming(command)
cliechtiac205322009-08-02 20:40:21 +0000773 known = True
774 if not known:
775 # handle unknown options
776 # only answer to positive requests and deny them
777 if command == WILL or command == DO:
cliechti1ef7e3e2009-08-03 02:38:43 +0000778 self.telnetSendOption((command == WILL and DONT or WONT), option)
cliechti6a300772009-08-12 02:28:56 +0000779 if self.logger:
780 self.logger.warning("rejected Telnet option: %r" % (option,))
cliechtiac205322009-08-02 20:40:21 +0000781
cliechti8099bed2009-08-01 23:59:18 +0000782
cliechti1ef7e3e2009-08-03 02:38:43 +0000783 def _telnetProcessSubnegotiation(self, suboption):
cliechti044d8662009-08-11 21:40:31 +0000784 """Process subnegotiation, the data between IAC SB and IAC SE."""
cliechti8099bed2009-08-01 23:59:18 +0000785 if suboption[0:1] == COM_PORT_OPTION:
786 if suboption[1:2] == SERVER_NOTIFY_LINESTATE and len(suboption) >= 3:
cliechti672d0292009-08-03 02:01:57 +0000787 self._linestate = ord(suboption[2:3]) # ensure it is a number
cliechti6a300772009-08-12 02:28:56 +0000788 if self.logger:
789 self.logger.info("NOTIFY_LINESTATE: %s" % self._linestate)
cliechti8099bed2009-08-01 23:59:18 +0000790 elif suboption[1:2] == SERVER_NOTIFY_MODEMSTATE and len(suboption) >= 3:
cliechti672d0292009-08-03 02:01:57 +0000791 self._modemstate = ord(suboption[2:3]) # ensure it is a number
cliechti6a300772009-08-12 02:28:56 +0000792 if self.logger:
793 self.logger.info("NOTIFY_MODEMSTATE: %s" % self._modemstate)
cliechti7cb78e82009-08-05 15:47:57 +0000794 # update time when we think that a poll would make sense
795 self._modemstate_expires = time.time() + 0.3
cliechti672d0292009-08-03 02:01:57 +0000796 elif suboption[1:2] == FLOWCONTROL_SUSPEND:
797 self._remote_suspend_flow = True
798 elif suboption[1:2] == FLOWCONTROL_RESUME:
799 self._remote_suspend_flow = False
cliechti8099bed2009-08-01 23:59:18 +0000800 else:
cliechti2b929b72009-08-02 23:49:02 +0000801 for item in self._rfc2217_options.values():
802 if item.ack_option == suboption[1:2]:
cliechti81c54762009-08-03 23:53:27 +0000803 #~ print "processing COM_PORT_OPTION: %r" % list(suboption[1:])
cliechti2b929b72009-08-02 23:49:02 +0000804 item.checkAnswer(bytes(suboption[2:]))
805 break
806 else:
cliechti6a300772009-08-12 02:28:56 +0000807 if self.logger:
808 self.logger.warning("ignoring COM_PORT_OPTION: %r" % (suboption,))
cliechti8099bed2009-08-01 23:59:18 +0000809 else:
cliechti6a300772009-08-12 02:28:56 +0000810 if self.logger:
811 self.logger.warning("ignoring subnegotiation: %r" % (suboption,))
cliechti8099bed2009-08-01 23:59:18 +0000812
813 # - outgoing telnet commands and options
814
cliechti81c54762009-08-03 23:53:27 +0000815 def _internal_raw_write(self, data):
cliechti044d8662009-08-11 21:40:31 +0000816 """internal socket write with no data escaping. used to send telnet stuff."""
Chris Liechti01587b12015-08-05 02:39:32 +0200817 with self._write_lock:
cliechti81c54762009-08-03 23:53:27 +0000818 self._socket.sendall(data)
cliechti81c54762009-08-03 23:53:27 +0000819
cliechti1ef7e3e2009-08-03 02:38:43 +0000820 def telnetSendOption(self, action, option):
cliechti044d8662009-08-11 21:40:31 +0000821 """Send DO, DONT, WILL, WONT."""
cliechti81c54762009-08-03 23:53:27 +0000822 self._internal_raw_write(to_bytes([IAC, action, option]))
cliechti8099bed2009-08-01 23:59:18 +0000823
Chris Liechtib4cda3a2015-08-08 17:12:08 +0200824 def rfc2217SendSubnegotiation(self, option, value=b''):
cliechti044d8662009-08-11 21:40:31 +0000825 """Subnegotiation of RFC2217 parameters."""
cliechtif325c032009-12-25 16:09:49 +0000826 value = value.replace(IAC, IAC_DOUBLED)
cliechti81c54762009-08-03 23:53:27 +0000827 self._internal_raw_write(to_bytes([IAC, SB, COM_PORT_OPTION, option] + list(value) + [IAC, SE]))
cliechti2b929b72009-08-02 23:49:02 +0000828
cliechti1ef7e3e2009-08-03 02:38:43 +0000829 def rfc2217SendPurge(self, value):
cliechti2b929b72009-08-02 23:49:02 +0000830 item = self._rfc2217_options['purge']
cliechti672d0292009-08-03 02:01:57 +0000831 item.set(value) # transmit desired purge type
cliechtidfe2d272009-08-10 22:19:41 +0000832 item.wait(self._network_timeout) # wait for acknowledge from the server
cliechti2b929b72009-08-02 23:49:02 +0000833
cliechti1ef7e3e2009-08-03 02:38:43 +0000834 def rfc2217SetControl(self, value):
cliechti81c54762009-08-03 23:53:27 +0000835 item = self._rfc2217_options['control']
cliechticb20a4f2011-04-25 02:25:54 +0000836 item.set(value) # transmit desired control type
cliechti81c54762009-08-03 23:53:27 +0000837 if self._ignore_set_control_answer:
838 # answers are ignored when option is set. compatibility mode for
cliechticb20a4f2011-04-25 02:25:54 +0000839 # servers that answer, but not the expected one... (or no answer
cliechti81c54762009-08-03 23:53:27 +0000840 # at all) i.e. sredird
841 time.sleep(0.1) # this helps getting the unit tests passed
842 else:
cliechtidfe2d272009-08-10 22:19:41 +0000843 item.wait(self._network_timeout) # wait for acknowledge from the server
cliechti8099bed2009-08-01 23:59:18 +0000844
cliechti1ef7e3e2009-08-03 02:38:43 +0000845 def rfc2217FlowServerReady(self):
cliechtieada4fd2013-07-31 16:26:07 +0000846 """\
847 check if server is ready to receive data. block for some time when
848 not.
849 """
cliechti672d0292009-08-03 02:01:57 +0000850 #~ if self._remote_suspend_flow:
851 #~ wait---
852
cliechti7cb78e82009-08-05 15:47:57 +0000853 def getModemState(self):
cliechtieada4fd2013-07-31 16:26:07 +0000854 """\
cliechti7d448562014-08-03 21:57:45 +0000855 get last modem state (cached value. If value is "old", request a new
856 one. This cache helps that we don't issue to many requests when e.g. all
857 status lines, one after the other is queried by the user (getCTS, getDSR
cliechtieada4fd2013-07-31 16:26:07 +0000858 etc.)
859 """
cliechti7cb78e82009-08-05 15:47:57 +0000860 # active modem state polling enabled? is the value fresh enough?
861 if self._poll_modem_state and self._modemstate_expires < time.time():
cliechti6a300772009-08-12 02:28:56 +0000862 if self.logger:
863 self.logger.debug('polling modem state')
cliechti7cb78e82009-08-05 15:47:57 +0000864 # when it is older, request an update
865 self.rfc2217SendSubnegotiation(NOTIFY_MODEMSTATE)
cliechtidfe2d272009-08-10 22:19:41 +0000866 timeout_time = time.time() + self._network_timeout
cliechti7cb78e82009-08-05 15:47:57 +0000867 while time.time() < timeout_time:
868 time.sleep(0.05) # prevent 100% CPU load
869 # when expiration time is updated, it means that there is a new
870 # value
871 if self._modemstate_expires > time.time():
872 break
Chris Liechti01587b12015-08-05 02:39:32 +0200873 else:
874 if self.logger:
875 self.logger.warning('poll for modem state failed')
cliechti7cb78e82009-08-05 15:47:57 +0000876 # even when there is a timeout, do not generate an error just
877 # return the last known value. this way we can support buggy
878 # servers that do not respond to polls, but send automatic
879 # updates.
880 if self._modemstate is not None:
cliechti6a300772009-08-12 02:28:56 +0000881 if self.logger:
882 self.logger.debug('using cached modem state')
cliechti7cb78e82009-08-05 15:47:57 +0000883 return self._modemstate
884 else:
885 # never received a notification from the server
cliechti8fb119c2009-08-05 23:39:45 +0000886 raise SerialException("remote sends no NOTIFY_MODEMSTATE")
cliechti8099bed2009-08-01 23:59:18 +0000887
cliechti5cc3eb12009-08-11 23:04:30 +0000888
cliechti595ed5b2009-08-10 01:43:32 +0000889#############################################################################
cliechti5cc3eb12009-08-11 23:04:30 +0000890# The following is code that helps implementing an RFC 2217 server.
cliechti8099bed2009-08-01 23:59:18 +0000891
cliechti8ccc2ff2009-08-05 12:44:46 +0000892class PortManager(object):
cliechtieada4fd2013-07-31 16:26:07 +0000893 """\
894 This class manages the state of Telnet and RFC 2217. It needs a serial
cliechticb20a4f2011-04-25 02:25:54 +0000895 instance and a connection to work with. Connection is expected to implement
cliechtieada4fd2013-07-31 16:26:07 +0000896 a (thread safe) write function, that writes the string to the network.
897 """
cliechti130d1f02009-08-04 02:10:58 +0000898
cliechti6a300772009-08-12 02:28:56 +0000899 def __init__(self, serial_port, connection, logger=None):
cliechti130d1f02009-08-04 02:10:58 +0000900 self.serial = serial_port
901 self.connection = connection
cliechti6a300772009-08-12 02:28:56 +0000902 self.logger = logger
cliechti86b593e2009-08-05 16:28:12 +0000903 self._client_is_rfc2217 = False
cliechti130d1f02009-08-04 02:10:58 +0000904
905 # filter state machine
906 self.mode = M_NORMAL
907 self.suboption = None
908 self.telnet_command = None
909
910 # states for modem/line control events
911 self.modemstate_mask = 255
912 self.last_modemstate = None
913 self.linstate_mask = 0
914
915 # all supported telnet options
916 self._telnet_options = [
917 TelnetOption(self, 'ECHO', ECHO, WILL, WONT, DO, DONT, REQUESTED),
918 TelnetOption(self, 'we-SGA', SGA, WILL, WONT, DO, DONT, REQUESTED),
919 TelnetOption(self, 'they-SGA', SGA, DO, DONT, WILL, WONT, INACTIVE),
920 TelnetOption(self, 'we-BINARY', BINARY, WILL, WONT, DO, DONT, INACTIVE),
921 TelnetOption(self, 'they-BINARY', BINARY, DO, DONT, WILL, WONT, REQUESTED),
cliechti86b593e2009-08-05 16:28:12 +0000922 TelnetOption(self, 'we-RFC2217', COM_PORT_OPTION, WILL, WONT, DO, DONT, REQUESTED, self._client_ok),
923 TelnetOption(self, 'they-RFC2217', COM_PORT_OPTION, DO, DONT, WILL, WONT, INACTIVE, self._client_ok),
cliechti130d1f02009-08-04 02:10:58 +0000924 ]
925
926 # negotiate Telnet/RFC2217 -> send initial requests
cliechti6a300772009-08-12 02:28:56 +0000927 if self.logger:
928 self.logger.debug("requesting initial Telnet/RFC 2217 options")
cliechti130d1f02009-08-04 02:10:58 +0000929 for option in self._telnet_options:
930 if option.state is REQUESTED:
931 self.telnetSendOption(option.send_yes, option.option)
932 # issue 1st modem state notification
cliechti86b593e2009-08-05 16:28:12 +0000933
934 def _client_ok(self):
cliechtieada4fd2013-07-31 16:26:07 +0000935 """\
cliechti7d448562014-08-03 21:57:45 +0000936 callback of telnet option. It gets called when option is activated.
937 This one here is used to detect when the client agrees on RFC 2217. A
cliechti86b593e2009-08-05 16:28:12 +0000938 flag is set so that other functions like check_modem_lines know if the
cliechti7d448562014-08-03 21:57:45 +0000939 client is OK.
cliechtieada4fd2013-07-31 16:26:07 +0000940 """
cliechti86b593e2009-08-05 16:28:12 +0000941 # The callback is used for we and they so if one party agrees, we're
942 # already happy. it seems not all servers do the negotiation correctly
943 # and i guess there are incorrect clients too.. so be happy if client
944 # answers one or the other positively.
945 self._client_is_rfc2217 = True
cliechti6a300772009-08-12 02:28:56 +0000946 if self.logger:
947 self.logger.info("client accepts RFC 2217")
cliechti8fb119c2009-08-05 23:39:45 +0000948 # this is to ensure that the client gets a notification, even if there
949 # was no change
950 self.check_modem_lines(force_notification=True)
cliechti130d1f02009-08-04 02:10:58 +0000951
952 # - outgoing telnet commands and options
953
954 def telnetSendOption(self, action, option):
cliechti044d8662009-08-11 21:40:31 +0000955 """Send DO, DONT, WILL, WONT."""
cliechti130d1f02009-08-04 02:10:58 +0000956 self.connection.write(to_bytes([IAC, action, option]))
957
Chris Liechtib4cda3a2015-08-08 17:12:08 +0200958 def rfc2217SendSubnegotiation(self, option, value=b''):
cliechti044d8662009-08-11 21:40:31 +0000959 """Subnegotiation of RFC 2217 parameters."""
cliechtif325c032009-12-25 16:09:49 +0000960 value = value.replace(IAC, IAC_DOUBLED)
cliechti130d1f02009-08-04 02:10:58 +0000961 self.connection.write(to_bytes([IAC, SB, COM_PORT_OPTION, option] + list(value) + [IAC, SE]))
962
963 # - check modem lines, needs to be called periodically from user to
964 # establish polling
965
cliechti7cb78e82009-08-05 15:47:57 +0000966 def check_modem_lines(self, force_notification=False):
cliechti130d1f02009-08-04 02:10:58 +0000967 modemstate = (
968 (self.serial.getCTS() and MODEMSTATE_MASK_CTS) |
969 (self.serial.getDSR() and MODEMSTATE_MASK_DSR) |
970 (self.serial.getRI() and MODEMSTATE_MASK_RI) |
971 (self.serial.getCD() and MODEMSTATE_MASK_CD)
972 )
cliechti7cb78e82009-08-05 15:47:57 +0000973 # check what has changed
974 deltas = modemstate ^ (self.last_modemstate or 0) # when last is None -> 0
975 if deltas & MODEMSTATE_MASK_CTS:
976 modemstate |= MODEMSTATE_MASK_CTS_CHANGE
977 if deltas & MODEMSTATE_MASK_DSR:
978 modemstate |= MODEMSTATE_MASK_DSR_CHANGE
979 if deltas & MODEMSTATE_MASK_RI:
980 modemstate |= MODEMSTATE_MASK_RI_CHANGE
981 if deltas & MODEMSTATE_MASK_CD:
982 modemstate |= MODEMSTATE_MASK_CD_CHANGE
983 # if new state is different and the mask allows this change, send
cliechti86b593e2009-08-05 16:28:12 +0000984 # notification. suppress notifications when client is not rfc2217
cliechti7cb78e82009-08-05 15:47:57 +0000985 if modemstate != self.last_modemstate or force_notification:
cliechti8fb119c2009-08-05 23:39:45 +0000986 if (self._client_is_rfc2217 and (modemstate & self.modemstate_mask)) or force_notification:
cliechti7cb78e82009-08-05 15:47:57 +0000987 self.rfc2217SendSubnegotiation(
988 SERVER_NOTIFY_MODEMSTATE,
989 to_bytes([modemstate & self.modemstate_mask])
990 )
cliechti6a300772009-08-12 02:28:56 +0000991 if self.logger:
992 self.logger.info("NOTIFY_MODEMSTATE: %s" % (modemstate,))
cliechti7cb78e82009-08-05 15:47:57 +0000993 # save last state, but forget about deltas.
994 # otherwise it would also notify about changing deltas which is
995 # probably not very useful
996 self.last_modemstate = modemstate & 0xf0
cliechti130d1f02009-08-04 02:10:58 +0000997
cliechti32c10332009-08-05 13:23:43 +0000998 # - outgoing data escaping
999
1000 def escape(self, data):
cliechtieada4fd2013-07-31 16:26:07 +00001001 """\
cliechti7d448562014-08-03 21:57:45 +00001002 This generator function is for the user. All outgoing data has to be
cliechticb20a4f2011-04-25 02:25:54 +00001003 properly escaped, so that no IAC character in the data stream messes up
1004 the Telnet state machine in the server.
cliechti32c10332009-08-05 13:23:43 +00001005
1006 socket.sendall(escape(data))
1007 """
1008 for byte in data:
1009 if byte == IAC:
1010 yield IAC
1011 yield IAC
1012 else:
1013 yield byte
1014
cliechti130d1f02009-08-04 02:10:58 +00001015 # - incoming data filter
1016
1017 def filter(self, data):
cliechtieada4fd2013-07-31 16:26:07 +00001018 """\
cliechti7d448562014-08-03 21:57:45 +00001019 Handle a bunch of incoming bytes. This is a generator. It will yield
cliechti044d8662009-08-11 21:40:31 +00001020 all characters not of interest for Telnet/RFC 2217.
cliechti130d1f02009-08-04 02:10:58 +00001021
1022 The idea is that the reader thread pushes data from the socket through
1023 this filter:
1024
1025 for byte in filter(socket.recv(1024)):
1026 # do things like CR/LF conversion/whatever
1027 # and write data to the serial port
1028 serial.write(byte)
1029
1030 (socket error handling code left as exercise for the reader)
1031 """
Chris Liechtif99cd5c2015-08-13 22:54:16 +02001032 for byte in iterbytes(data):
cliechti130d1f02009-08-04 02:10:58 +00001033 if self.mode == M_NORMAL:
1034 # interpret as command or as data
1035 if byte == IAC:
1036 self.mode = M_IAC_SEEN
1037 else:
1038 # store data in sub option buffer or pass it to our
1039 # consumer depending on state
1040 if self.suboption is not None:
Chris Liechti01587b12015-08-05 02:39:32 +02001041 self.suboption += byte
cliechti130d1f02009-08-04 02:10:58 +00001042 else:
1043 yield byte
1044 elif self.mode == M_IAC_SEEN:
1045 if byte == IAC:
1046 # interpret as command doubled -> insert character
1047 # itself
cliechtif325c032009-12-25 16:09:49 +00001048 if self.suboption is not None:
Chris Liechti01587b12015-08-05 02:39:32 +02001049 self.suboption += byte
cliechtif325c032009-12-25 16:09:49 +00001050 else:
1051 yield byte
cliechti130d1f02009-08-04 02:10:58 +00001052 self.mode = M_NORMAL
1053 elif byte == SB:
1054 # sub option start
1055 self.suboption = bytearray()
1056 self.mode = M_NORMAL
1057 elif byte == SE:
1058 # sub option end -> process it now
1059 self._telnetProcessSubnegotiation(bytes(self.suboption))
1060 self.suboption = None
1061 self.mode = M_NORMAL
1062 elif byte in (DO, DONT, WILL, WONT):
1063 # negotiation
1064 self.telnet_command = byte
1065 self.mode = M_NEGOTIATE
1066 else:
1067 # other telnet commands
1068 self._telnetProcessCommand(byte)
1069 self.mode = M_NORMAL
1070 elif self.mode == M_NEGOTIATE: # DO, DONT, WILL, WONT was received, option now following
1071 self._telnetNegotiateOption(self.telnet_command, byte)
1072 self.mode = M_NORMAL
1073
1074 # - incoming telnet commands and options
1075
1076 def _telnetProcessCommand(self, command):
cliechti044d8662009-08-11 21:40:31 +00001077 """Process commands other than DO, DONT, WILL, WONT."""
cliechti130d1f02009-08-04 02:10:58 +00001078 # Currently none. RFC2217 only uses negotiation and subnegotiation.
cliechti6a300772009-08-12 02:28:56 +00001079 if self.logger:
1080 self.logger.warning("ignoring Telnet command: %r" % (command,))
cliechti130d1f02009-08-04 02:10:58 +00001081
1082 def _telnetNegotiateOption(self, command, option):
cliechti044d8662009-08-11 21:40:31 +00001083 """Process incoming DO, DONT, WILL, WONT."""
cliechti130d1f02009-08-04 02:10:58 +00001084 # check our registered telnet options and forward command to them
1085 # they know themselves if they have to answer or not
1086 known = False
1087 for item in self._telnet_options:
1088 # can have more than one match! as some options are duplicated for
1089 # 'us' and 'them'
1090 if item.option == option:
1091 item.process_incoming(command)
1092 known = True
1093 if not known:
1094 # handle unknown options
1095 # only answer to positive requests and deny them
1096 if command == WILL or command == DO:
1097 self.telnetSendOption((command == WILL and DONT or WONT), option)
cliechti6a300772009-08-12 02:28:56 +00001098 if self.logger:
1099 self.logger.warning("rejected Telnet option: %r" % (option,))
cliechti130d1f02009-08-04 02:10:58 +00001100
1101
1102 def _telnetProcessSubnegotiation(self, suboption):
cliechti044d8662009-08-11 21:40:31 +00001103 """Process subnegotiation, the data between IAC SB and IAC SE."""
cliechti130d1f02009-08-04 02:10:58 +00001104 if suboption[0:1] == COM_PORT_OPTION:
cliechti6a300772009-08-12 02:28:56 +00001105 if self.logger:
1106 self.logger.debug('received COM_PORT_OPTION: %r' % (suboption,))
cliechti130d1f02009-08-04 02:10:58 +00001107 if suboption[1:2] == SET_BAUDRATE:
1108 backup = self.serial.baudrate
1109 try:
Chris Liechti01587b12015-08-05 02:39:32 +02001110 (baudrate,) = struct.unpack(b"!I", suboption[2:6])
cliechtieada4fd2013-07-31 16:26:07 +00001111 if baudrate != 0:
1112 self.serial.baudrate = baudrate
Chris Liechtid2146002015-08-04 16:57:16 +02001113 except ValueError as e:
cliechti6a300772009-08-12 02:28:56 +00001114 if self.logger:
1115 self.logger.error("failed to set baud rate: %s" % (e,))
cliechti130d1f02009-08-04 02:10:58 +00001116 self.serial.baudrate = backup
cliechti5cc3eb12009-08-11 23:04:30 +00001117 else:
cliechti6a300772009-08-12 02:28:56 +00001118 if self.logger:
cliechtieada4fd2013-07-31 16:26:07 +00001119 self.logger.info("%s baud rate: %s" % (baudrate and 'set' or 'get', self.serial.baudrate))
Chris Liechti01587b12015-08-05 02:39:32 +02001120 self.rfc2217SendSubnegotiation(SERVER_SET_BAUDRATE, struct.pack(b"!I", self.serial.baudrate))
cliechti130d1f02009-08-04 02:10:58 +00001121 elif suboption[1:2] == SET_DATASIZE:
1122 backup = self.serial.bytesize
1123 try:
cliechtieada4fd2013-07-31 16:26:07 +00001124 (datasize,) = struct.unpack("!B", suboption[2:3])
1125 if datasize != 0:
1126 self.serial.bytesize = datasize
Chris Liechtid2146002015-08-04 16:57:16 +02001127 except ValueError as e:
cliechti6a300772009-08-12 02:28:56 +00001128 if self.logger:
1129 self.logger.error("failed to set data size: %s" % (e,))
cliechti130d1f02009-08-04 02:10:58 +00001130 self.serial.bytesize = backup
cliechti5cc3eb12009-08-11 23:04:30 +00001131 else:
cliechti6a300772009-08-12 02:28:56 +00001132 if self.logger:
cliechtieada4fd2013-07-31 16:26:07 +00001133 self.logger.info("%s data size: %s" % (datasize and 'set' or 'get', self.serial.bytesize))
Chris Liechti01587b12015-08-05 02:39:32 +02001134 self.rfc2217SendSubnegotiation(SERVER_SET_DATASIZE, struct.pack(b"!B", self.serial.bytesize))
cliechti130d1f02009-08-04 02:10:58 +00001135 elif suboption[1:2] == SET_PARITY:
1136 backup = self.serial.parity
1137 try:
Chris Liechti01587b12015-08-05 02:39:32 +02001138 parity = struct.unpack(b"!B", suboption[2:3])[0]
cliechtieada4fd2013-07-31 16:26:07 +00001139 if parity != 0:
1140 self.serial.parity = RFC2217_REVERSE_PARITY_MAP[parity]
Chris Liechtid2146002015-08-04 16:57:16 +02001141 except ValueError as e:
cliechti6a300772009-08-12 02:28:56 +00001142 if self.logger:
1143 self.logger.error("failed to set parity: %s" % (e,))
cliechti130d1f02009-08-04 02:10:58 +00001144 self.serial.parity = backup
cliechti5cc3eb12009-08-11 23:04:30 +00001145 else:
cliechti6a300772009-08-12 02:28:56 +00001146 if self.logger:
cliechtieada4fd2013-07-31 16:26:07 +00001147 self.logger.info("%s parity: %s" % (parity and 'set' or 'get', self.serial.parity))
cliechti130d1f02009-08-04 02:10:58 +00001148 self.rfc2217SendSubnegotiation(
1149 SERVER_SET_PARITY,
Chris Liechtib4cda3a2015-08-08 17:12:08 +02001150 struct.pack(b"!B", RFC2217_PARITY_MAP[self.serial.parity])
cliechti130d1f02009-08-04 02:10:58 +00001151 )
1152 elif suboption[1:2] == SET_STOPSIZE:
1153 backup = self.serial.stopbits
1154 try:
Chris Liechti01587b12015-08-05 02:39:32 +02001155 stopbits = struct.unpack(b"!B", suboption[2:3])[0]
cliechtieada4fd2013-07-31 16:26:07 +00001156 if stopbits != 0:
1157 self.serial.stopbits = RFC2217_REVERSE_STOPBIT_MAP[stopbits]
Chris Liechtid2146002015-08-04 16:57:16 +02001158 except ValueError as e:
cliechti6a300772009-08-12 02:28:56 +00001159 if self.logger:
1160 self.logger.error("failed to set stop bits: %s" % (e,))
cliechti130d1f02009-08-04 02:10:58 +00001161 self.serial.stopbits = backup
cliechti5cc3eb12009-08-11 23:04:30 +00001162 else:
cliechti6a300772009-08-12 02:28:56 +00001163 if self.logger:
cliechtieada4fd2013-07-31 16:26:07 +00001164 self.logger.info("%s stop bits: %s" % (stopbits and 'set' or 'get', self.serial.stopbits))
cliechti130d1f02009-08-04 02:10:58 +00001165 self.rfc2217SendSubnegotiation(
1166 SERVER_SET_STOPSIZE,
Chris Liechti01587b12015-08-05 02:39:32 +02001167 struct.pack(b"!B", RFC2217_STOPBIT_MAP[self.serial.stopbits])
cliechti130d1f02009-08-04 02:10:58 +00001168 )
1169 elif suboption[1:2] == SET_CONTROL:
1170 if suboption[2:3] == SET_CONTROL_REQ_FLOW_SETTING:
1171 if self.serial.xonxoff:
1172 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_USE_SW_FLOW_CONTROL)
1173 elif self.serial.rtscts:
1174 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_USE_HW_FLOW_CONTROL)
1175 else:
1176 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_USE_NO_FLOW_CONTROL)
1177 elif suboption[2:3] == SET_CONTROL_USE_NO_FLOW_CONTROL:
1178 self.serial.xonxoff = False
1179 self.serial.rtscts = False
cliechti6a300772009-08-12 02:28:56 +00001180 if self.logger:
1181 self.logger.info("changed flow control to None")
cliechti130d1f02009-08-04 02:10:58 +00001182 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_USE_NO_FLOW_CONTROL)
1183 elif suboption[2:3] == SET_CONTROL_USE_SW_FLOW_CONTROL:
1184 self.serial.xonxoff = True
cliechti6a300772009-08-12 02:28:56 +00001185 if self.logger:
1186 self.logger.info("changed flow control to XON/XOFF")
cliechti130d1f02009-08-04 02:10:58 +00001187 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_USE_SW_FLOW_CONTROL)
1188 elif suboption[2:3] == SET_CONTROL_USE_HW_FLOW_CONTROL:
1189 self.serial.rtscts = True
cliechti6a300772009-08-12 02:28:56 +00001190 if self.logger:
1191 self.logger.info("changed flow control to RTS/CTS")
cliechti130d1f02009-08-04 02:10:58 +00001192 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_USE_HW_FLOW_CONTROL)
1193 elif suboption[2:3] == SET_CONTROL_REQ_BREAK_STATE:
cliechti6a300772009-08-12 02:28:56 +00001194 if self.logger:
1195 self.logger.warning("requested break state - not implemented")
cliechti130d1f02009-08-04 02:10:58 +00001196 pass # XXX needs cached value
1197 elif suboption[2:3] == SET_CONTROL_BREAK_ON:
1198 self.serial.setBreak(True)
cliechti6a300772009-08-12 02:28:56 +00001199 if self.logger:
1200 self.logger.info("changed BREAK to active")
cliechti130d1f02009-08-04 02:10:58 +00001201 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_BREAK_ON)
1202 elif suboption[2:3] == SET_CONTROL_BREAK_OFF:
1203 self.serial.setBreak(False)
cliechti6a300772009-08-12 02:28:56 +00001204 if self.logger:
1205 self.logger.info("changed BREAK to inactive")
cliechti130d1f02009-08-04 02:10:58 +00001206 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_BREAK_OFF)
1207 elif suboption[2:3] == SET_CONTROL_REQ_DTR:
cliechti6a300772009-08-12 02:28:56 +00001208 if self.logger:
1209 self.logger.warning("requested DTR state - not implemented")
cliechti130d1f02009-08-04 02:10:58 +00001210 pass # XXX needs cached value
1211 elif suboption[2:3] == SET_CONTROL_DTR_ON:
1212 self.serial.setDTR(True)
cliechti6a300772009-08-12 02:28:56 +00001213 if self.logger:
1214 self.logger.info("changed DTR to active")
cliechti130d1f02009-08-04 02:10:58 +00001215 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_DTR_ON)
1216 elif suboption[2:3] == SET_CONTROL_DTR_OFF:
1217 self.serial.setDTR(False)
cliechti6a300772009-08-12 02:28:56 +00001218 if self.logger:
1219 self.logger.info("changed DTR to inactive")
cliechti130d1f02009-08-04 02:10:58 +00001220 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_DTR_OFF)
1221 elif suboption[2:3] == SET_CONTROL_REQ_RTS:
cliechti6a300772009-08-12 02:28:56 +00001222 if self.logger:
1223 self.logger.warning("requested RTS state - not implemented")
cliechti130d1f02009-08-04 02:10:58 +00001224 pass # XXX needs cached value
1225 #~ self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_RTS_ON)
1226 elif suboption[2:3] == SET_CONTROL_RTS_ON:
1227 self.serial.setRTS(True)
cliechti6a300772009-08-12 02:28:56 +00001228 if self.logger:
1229 self.logger.info("changed RTS to active")
cliechti130d1f02009-08-04 02:10:58 +00001230 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_RTS_ON)
1231 elif suboption[2:3] == SET_CONTROL_RTS_OFF:
1232 self.serial.setRTS(False)
cliechti6a300772009-08-12 02:28:56 +00001233 if self.logger:
1234 self.logger.info("changed RTS to inactive")
cliechti130d1f02009-08-04 02:10:58 +00001235 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_RTS_OFF)
1236 #~ elif suboption[2:3] == SET_CONTROL_REQ_FLOW_SETTING_IN:
1237 #~ elif suboption[2:3] == SET_CONTROL_USE_NO_FLOW_CONTROL_IN:
1238 #~ elif suboption[2:3] == SET_CONTROL_USE_SW_FLOW_CONTOL_IN:
1239 #~ elif suboption[2:3] == SET_CONTROL_USE_HW_FLOW_CONTOL_IN:
1240 #~ elif suboption[2:3] == SET_CONTROL_USE_DCD_FLOW_CONTROL:
1241 #~ elif suboption[2:3] == SET_CONTROL_USE_DTR_FLOW_CONTROL:
1242 #~ elif suboption[2:3] == SET_CONTROL_USE_DSR_FLOW_CONTROL:
1243 elif suboption[1:2] == NOTIFY_LINESTATE:
cliechti7cb78e82009-08-05 15:47:57 +00001244 # client polls for current state
1245 self.rfc2217SendSubnegotiation(
1246 SERVER_NOTIFY_LINESTATE,
cliechti6a300772009-08-12 02:28:56 +00001247 to_bytes([0]) # sorry, nothing like that implemented
cliechti7cb78e82009-08-05 15:47:57 +00001248 )
cliechti130d1f02009-08-04 02:10:58 +00001249 elif suboption[1:2] == NOTIFY_MODEMSTATE:
cliechti6a300772009-08-12 02:28:56 +00001250 if self.logger:
1251 self.logger.info("request for modem state")
cliechti7cb78e82009-08-05 15:47:57 +00001252 # client polls for current state
1253 self.check_modem_lines(force_notification=True)
cliechti130d1f02009-08-04 02:10:58 +00001254 elif suboption[1:2] == FLOWCONTROL_SUSPEND:
cliechti6a300772009-08-12 02:28:56 +00001255 if self.logger:
1256 self.logger.info("suspend")
cliechti130d1f02009-08-04 02:10:58 +00001257 self._remote_suspend_flow = True
1258 elif suboption[1:2] == FLOWCONTROL_RESUME:
cliechti6a300772009-08-12 02:28:56 +00001259 if self.logger:
1260 self.logger.info("resume")
cliechti130d1f02009-08-04 02:10:58 +00001261 self._remote_suspend_flow = False
1262 elif suboption[1:2] == SET_LINESTATE_MASK:
1263 self.linstate_mask = ord(suboption[2:3]) # ensure it is a number
cliechti6a300772009-08-12 02:28:56 +00001264 if self.logger:
cliechtif325c032009-12-25 16:09:49 +00001265 self.logger.info("line state mask: 0x%02x" % (self.linstate_mask,))
cliechti130d1f02009-08-04 02:10:58 +00001266 elif suboption[1:2] == SET_MODEMSTATE_MASK:
1267 self.modemstate_mask = ord(suboption[2:3]) # ensure it is a number
cliechti6a300772009-08-12 02:28:56 +00001268 if self.logger:
cliechtif325c032009-12-25 16:09:49 +00001269 self.logger.info("modem state mask: 0x%02x" % (self.modemstate_mask,))
cliechti130d1f02009-08-04 02:10:58 +00001270 elif suboption[1:2] == PURGE_DATA:
1271 if suboption[2:3] == PURGE_RECEIVE_BUFFER:
1272 self.serial.flushInput()
cliechti6a300772009-08-12 02:28:56 +00001273 if self.logger:
1274 self.logger.info("purge in")
cliechti130d1f02009-08-04 02:10:58 +00001275 self.rfc2217SendSubnegotiation(SERVER_PURGE_DATA, PURGE_RECEIVE_BUFFER)
1276 elif suboption[2:3] == PURGE_TRANSMIT_BUFFER:
1277 self.serial.flushOutput()
cliechti6a300772009-08-12 02:28:56 +00001278 if self.logger:
1279 self.logger.info("purge out")
cliechti130d1f02009-08-04 02:10:58 +00001280 self.rfc2217SendSubnegotiation(SERVER_PURGE_DATA, PURGE_TRANSMIT_BUFFER)
1281 elif suboption[2:3] == PURGE_BOTH_BUFFERS:
1282 self.serial.flushInput()
1283 self.serial.flushOutput()
cliechti6a300772009-08-12 02:28:56 +00001284 if self.logger:
1285 self.logger.info("purge both")
cliechti130d1f02009-08-04 02:10:58 +00001286 self.rfc2217SendSubnegotiation(SERVER_PURGE_DATA, PURGE_BOTH_BUFFERS)
1287 else:
cliechti6a300772009-08-12 02:28:56 +00001288 if self.logger:
1289 self.logger.error("undefined PURGE_DATA: %r" % list(suboption[2:]))
cliechti130d1f02009-08-04 02:10:58 +00001290 else:
cliechti6a300772009-08-12 02:28:56 +00001291 if self.logger:
1292 self.logger.error("undefined COM_PORT_OPTION: %r" % list(suboption[1:]))
cliechti130d1f02009-08-04 02:10:58 +00001293 else:
cliechti6a300772009-08-12 02:28:56 +00001294 if self.logger:
1295 self.logger.warning("unknown subnegotiation: %r" % (suboption,))
cliechti130d1f02009-08-04 02:10:58 +00001296
1297
1298# simple client test
cliechti8099bed2009-08-01 23:59:18 +00001299if __name__ == '__main__':
1300 import sys
1301 s = Serial('rfc2217://localhost:7000', 115200)
1302 sys.stdout.write('%s\n' % s)
1303
cliechti2b929b72009-08-02 23:49:02 +00001304 #~ s.baudrate = 1898
1305
cliechti8099bed2009-08-01 23:59:18 +00001306 sys.stdout.write("write...\n")
Chris Liechtib4cda3a2015-08-08 17:12:08 +02001307 s.write(b"hello\n")
cliechti8099bed2009-08-01 23:59:18 +00001308 s.flush()
cliechti8099bed2009-08-01 23:59:18 +00001309 sys.stdout.write("read: %s\n" % s.read(5))
1310
1311 #~ s.baudrate = 19200
1312 #~ s.databits = 7
1313 s.close()