blob: 119f039eff0412bccd5e5ef1634b345ff20d6623 [file] [log] [blame]
cliechti8099bed2009-08-01 23:59:18 +00001#! python
2#
cliechti8099bed2009-08-01 23:59:18 +00003# This module implements a RFC2217 compatible client. RF2217 descibes a
4# protocol to access serial ports over TCP/IP and allows setting the baud rate,
5# modem control lines etc.
6#
Chris Liechti3e02f702015-12-16 23:06:04 +01007# This file is part of pySerial. https://github.com/pyserial/pyserial
Chris Liechti01587b12015-08-05 02:39:32 +02008# (C) 2001-2015 Chris Liechti <cliechti@gmx.net>
Chris Liechtifbdd8a02015-08-09 02:37:45 +02009#
10# SPDX-License-Identifier: BSD-3-Clause
cliechti8099bed2009-08-01 23:59:18 +000011
12# TODO:
13# - setting control line -> answer is not checked (had problems with one of the
14# severs). consider implementing a compatibility mode flag to make check
15# conditional
16# - write timeout not implemented at all
cliechti8099bed2009-08-01 23:59:18 +000017
Chris Liechti033f17c2015-08-30 21:28:04 +020018# ###########################################################################
cliechti81c54762009-08-03 23:53:27 +000019# observations and issues with servers
Chris Liechti033f17c2015-08-30 21:28:04 +020020# ===========================================================================
cliechti81c54762009-08-03 23:53:27 +000021# sredird V2.2.1
22# - http://www.ibiblio.org/pub/Linux/system/serial/ sredird-2.2.2.tar.gz
23# - does not acknowledge SET_CONTROL (RTS/DTR) correctly, always responding
24# [105 1] instead of the actual value.
25# - SET_BAUDRATE answer contains 4 extra null bytes -> probably for larger
26# numbers than 2**32?
27# - To get the signature [COM_PORT_OPTION 0] has to be sent.
28# - run a server: while true; do nc -l -p 7000 -c "sredird debug /dev/ttyUSB0 /var/lock/sredir"; done
Chris Liechti033f17c2015-08-30 21:28:04 +020029# ===========================================================================
cliechti81c54762009-08-03 23:53:27 +000030# telnetcpcd (untested)
31# - http://ftp.wayne.edu/kermit/sredird/telnetcpcd-1.09.tar.gz
32# - To get the signature [COM_PORT_OPTION] w/o data has to be sent.
Chris Liechti033f17c2015-08-30 21:28:04 +020033# ===========================================================================
cliechti81c54762009-08-03 23:53:27 +000034# ser2net
35# - does not negotiate BINARY or COM_PORT_OPTION for his side but at least
36# acknowledges that the client activates these options
37# - The configuration may be that the server prints a banner. As this client
38# implementation does a flushInput on connect, this banner is hidden from
39# the user application.
40# - NOTIFY_MODEMSTATE: the poll interval of the server seems to be one
41# second.
42# - To get the signature [COM_PORT_OPTION 0] has to be sent.
43# - run a server: run ser2net daemon, in /etc/ser2net.conf:
44# 2000:telnet:0:/dev/ttyS0:9600 remctl banner
Chris Liechti033f17c2015-08-30 21:28:04 +020045# ###########################################################################
cliechti81c54762009-08-03 23:53:27 +000046
47# How to identify ports? pySerial might want to support other protocols in the
48# future, so lets use an URL scheme.
49# for RFC2217 compliant servers we will use this:
Chris Liechti142ae562015-08-23 01:11:06 +020050# rfc2217://<host>:<port>[?option[&option...]]
cliechti81c54762009-08-03 23:53:27 +000051#
52# options:
Chris Liechti01587b12015-08-05 02:39:32 +020053# - "logging" set log level print diagnostic messages (e.g. "logging=debug")
cliechti81c54762009-08-03 23:53:27 +000054# - "ign_set_control": do not look at the answers to SET_CONTROL
cliechti7cb78e82009-08-05 15:47:57 +000055# - "poll_modem": issue NOTIFY_MODEMSTATE requests when CTS/DTR/RI/CD is read.
56# Without this option it expects that the server sends notifications
57# automatically on change (which most servers do and is according to the
58# RFC).
cliechti81c54762009-08-03 23:53:27 +000059# the order of the options is not relevant
60
cliechti5cc3eb12009-08-11 23:04:30 +000061import logging
Chris Liechtic4bca9e2015-08-07 14:40:41 +020062import socket
63import struct
64import threading
65import time
66try:
67 import urlparse
68except ImportError:
69 import urllib.parse as urlparse
Chris Liechtid2146002015-08-04 16:57:16 +020070try:
71 import Queue
72except ImportError:
73 import queue as Queue
74
Chris Liechti033f17c2015-08-30 21:28:04 +020075import serial
76from serial.serialutil import SerialBase, SerialException, to_bytes, iterbytes, portNotOpenError
Chris Liechtib4cda3a2015-08-08 17:12:08 +020077
cliechti8099bed2009-08-01 23:59:18 +000078# port string is expected to be something like this:
79# rfc2217://host:port
80# host may be an IP or including domain, whatever.
81# port is 0...65535
82
Chris Liechti3ad62fb2015-08-29 21:53:32 +020083# map log level names to constants. used in from_url()
cliechti5cc3eb12009-08-11 23:04:30 +000084LOGGER_LEVELS = {
Chris Liechticb6ce1b2016-02-02 01:53:56 +010085 'debug': logging.DEBUG,
86 'info': logging.INFO,
87 'warning': logging.WARNING,
88 'error': logging.ERROR,
89}
cliechti5cc3eb12009-08-11 23:04:30 +000090
91
cliechti8099bed2009-08-01 23:59:18 +000092# telnet protocol characters
Chris Liechti033f17c2015-08-30 21:28:04 +020093SE = b'\xf0' # Subnegotiation End
Chris Liechtib4cda3a2015-08-08 17:12:08 +020094NOP = b'\xf1' # No Operation
Chris Liechti033f17c2015-08-30 21:28:04 +020095DM = b'\xf2' # Data Mark
Chris Liechtib4cda3a2015-08-08 17:12:08 +020096BRK = b'\xf3' # Break
Chris Liechti033f17c2015-08-30 21:28:04 +020097IP = b'\xf4' # Interrupt process
98AO = b'\xf5' # Abort output
Chris Liechtib4cda3a2015-08-08 17:12:08 +020099AYT = b'\xf6' # Are You There
Chris Liechti033f17c2015-08-30 21:28:04 +0200100EC = b'\xf7' # Erase Character
101EL = b'\xf8' # Erase Line
102GA = b'\xf9' # Go Ahead
103SB = b'\xfa' # Subnegotiation Begin
Chris Liechtib4cda3a2015-08-08 17:12:08 +0200104WILL = b'\xfb'
105WONT = b'\xfc'
Chris Liechti033f17c2015-08-30 21:28:04 +0200106DO = b'\xfd'
Chris Liechtib4cda3a2015-08-08 17:12:08 +0200107DONT = b'\xfe'
Chris Liechti033f17c2015-08-30 21:28:04 +0200108IAC = b'\xff' # Interpret As Command
Chris Liechtib4cda3a2015-08-08 17:12:08 +0200109IAC_DOUBLED = b'\xff\xff'
cliechti8099bed2009-08-01 23:59:18 +0000110
111# selected telnet options
Chris Liechtib4cda3a2015-08-08 17:12:08 +0200112BINARY = b'\x00' # 8-bit data path
113ECHO = b'\x01' # echo
114SGA = b'\x03' # suppress go ahead
cliechti8099bed2009-08-01 23:59:18 +0000115
116# RFC2217
Chris Liechtib4cda3a2015-08-08 17:12:08 +0200117COM_PORT_OPTION = b'\x2c'
cliechti8099bed2009-08-01 23:59:18 +0000118
119# Client to Access Server
Chris Liechtib4cda3a2015-08-08 17:12:08 +0200120SET_BAUDRATE = b'\x01'
121SET_DATASIZE = b'\x02'
122SET_PARITY = b'\x03'
123SET_STOPSIZE = b'\x04'
124SET_CONTROL = b'\x05'
125NOTIFY_LINESTATE = b'\x06'
126NOTIFY_MODEMSTATE = b'\x07'
127FLOWCONTROL_SUSPEND = b'\x08'
128FLOWCONTROL_RESUME = b'\x09'
129SET_LINESTATE_MASK = b'\x0a'
130SET_MODEMSTATE_MASK = b'\x0b'
131PURGE_DATA = b'\x0c'
cliechti8099bed2009-08-01 23:59:18 +0000132
Chris Liechtib4cda3a2015-08-08 17:12:08 +0200133SERVER_SET_BAUDRATE = b'\x65'
134SERVER_SET_DATASIZE = b'\x66'
135SERVER_SET_PARITY = b'\x67'
136SERVER_SET_STOPSIZE = b'\x68'
137SERVER_SET_CONTROL = b'\x69'
138SERVER_NOTIFY_LINESTATE = b'\x6a'
139SERVER_NOTIFY_MODEMSTATE = b'\x6b'
140SERVER_FLOWCONTROL_SUSPEND = b'\x6c'
141SERVER_FLOWCONTROL_RESUME = b'\x6d'
142SERVER_SET_LINESTATE_MASK = b'\x6e'
143SERVER_SET_MODEMSTATE_MASK = b'\x6f'
144SERVER_PURGE_DATA = b'\x70'
cliechti8099bed2009-08-01 23:59:18 +0000145
146RFC2217_ANSWER_MAP = {
147 SET_BAUDRATE: SERVER_SET_BAUDRATE,
148 SET_DATASIZE: SERVER_SET_DATASIZE,
149 SET_PARITY: SERVER_SET_PARITY,
150 SET_STOPSIZE: SERVER_SET_STOPSIZE,
151 SET_CONTROL: SERVER_SET_CONTROL,
152 NOTIFY_LINESTATE: SERVER_NOTIFY_LINESTATE,
153 NOTIFY_MODEMSTATE: SERVER_NOTIFY_MODEMSTATE,
154 FLOWCONTROL_SUSPEND: SERVER_FLOWCONTROL_SUSPEND,
155 FLOWCONTROL_RESUME: SERVER_FLOWCONTROL_RESUME,
156 SET_LINESTATE_MASK: SERVER_SET_LINESTATE_MASK,
157 SET_MODEMSTATE_MASK: SERVER_SET_MODEMSTATE_MASK,
158 PURGE_DATA: SERVER_PURGE_DATA,
159}
160
Chris Liechtib4cda3a2015-08-08 17:12:08 +0200161SET_CONTROL_REQ_FLOW_SETTING = b'\x00' # Request Com Port Flow Control Setting (outbound/both)
162SET_CONTROL_USE_NO_FLOW_CONTROL = b'\x01' # Use No Flow Control (outbound/both)
163SET_CONTROL_USE_SW_FLOW_CONTROL = b'\x02' # Use XON/XOFF Flow Control (outbound/both)
164SET_CONTROL_USE_HW_FLOW_CONTROL = b'\x03' # Use HARDWARE Flow Control (outbound/both)
165SET_CONTROL_REQ_BREAK_STATE = b'\x04' # Request BREAK State
166SET_CONTROL_BREAK_ON = b'\x05' # Set BREAK State ON
167SET_CONTROL_BREAK_OFF = b'\x06' # Set BREAK State OFF
168SET_CONTROL_REQ_DTR = b'\x07' # Request DTR Signal State
169SET_CONTROL_DTR_ON = b'\x08' # Set DTR Signal State ON
170SET_CONTROL_DTR_OFF = b'\x09' # Set DTR Signal State OFF
171SET_CONTROL_REQ_RTS = b'\x0a' # Request RTS Signal State
172SET_CONTROL_RTS_ON = b'\x0b' # Set RTS Signal State ON
173SET_CONTROL_RTS_OFF = b'\x0c' # Set RTS Signal State OFF
174SET_CONTROL_REQ_FLOW_SETTING_IN = b'\x0d' # Request Com Port Flow Control Setting (inbound)
175SET_CONTROL_USE_NO_FLOW_CONTROL_IN = b'\x0e' # Use No Flow Control (inbound)
176SET_CONTROL_USE_SW_FLOW_CONTOL_IN = b'\x0f' # Use XON/XOFF Flow Control (inbound)
177SET_CONTROL_USE_HW_FLOW_CONTOL_IN = b'\x10' # Use HARDWARE Flow Control (inbound)
178SET_CONTROL_USE_DCD_FLOW_CONTROL = b'\x11' # Use DCD Flow Control (outbound/both)
179SET_CONTROL_USE_DTR_FLOW_CONTROL = b'\x12' # Use DTR Flow Control (inbound)
180SET_CONTROL_USE_DSR_FLOW_CONTROL = b'\x13' # Use DSR Flow Control (outbound/both)
cliechti8099bed2009-08-01 23:59:18 +0000181
Chris Liechtib4cda3a2015-08-08 17:12:08 +0200182LINESTATE_MASK_TIMEOUT = 128 # Time-out Error
183LINESTATE_MASK_SHIFTREG_EMPTY = 64 # Transfer Shift Register Empty
184LINESTATE_MASK_TRANSREG_EMPTY = 32 # Transfer Holding Register Empty
185LINESTATE_MASK_BREAK_DETECT = 16 # Break-detect Error
186LINESTATE_MASK_FRAMING_ERROR = 8 # Framing Error
187LINESTATE_MASK_PARTIY_ERROR = 4 # Parity Error
188LINESTATE_MASK_OVERRUN_ERROR = 2 # Overrun Error
189LINESTATE_MASK_DATA_READY = 1 # Data Ready
cliechti8099bed2009-08-01 23:59:18 +0000190
Chris Liechtib4cda3a2015-08-08 17:12:08 +0200191MODEMSTATE_MASK_CD = 128 # Receive Line Signal Detect (also known as Carrier Detect)
192MODEMSTATE_MASK_RI = 64 # Ring Indicator
193MODEMSTATE_MASK_DSR = 32 # Data-Set-Ready Signal State
194MODEMSTATE_MASK_CTS = 16 # Clear-To-Send Signal State
195MODEMSTATE_MASK_CD_CHANGE = 8 # Delta Receive Line Signal Detect
196MODEMSTATE_MASK_RI_CHANGE = 4 # Trailing-edge Ring Detector
197MODEMSTATE_MASK_DSR_CHANGE = 2 # Delta Data-Set-Ready
198MODEMSTATE_MASK_CTS_CHANGE = 1 # Delta Clear-To-Send
cliechti8099bed2009-08-01 23:59:18 +0000199
Chris Liechtib4cda3a2015-08-08 17:12:08 +0200200PURGE_RECEIVE_BUFFER = b'\x01' # Purge access server receive data buffer
201PURGE_TRANSMIT_BUFFER = b'\x02' # Purge access server transmit data buffer
Chris Liechti70ca49c2016-02-07 23:54:03 +0100202PURGE_BOTH_BUFFERS = b'\x03' # Purge both the access server receive data
203 # buffer and the access server transmit data buffer
cliechti8099bed2009-08-01 23:59:18 +0000204
205
206RFC2217_PARITY_MAP = {
Chris Liechti033f17c2015-08-30 21:28:04 +0200207 serial.PARITY_NONE: 1,
208 serial.PARITY_ODD: 2,
209 serial.PARITY_EVEN: 3,
210 serial.PARITY_MARK: 4,
211 serial.PARITY_SPACE: 5,
cliechti8099bed2009-08-01 23:59:18 +0000212}
Chris Liechti033f17c2015-08-30 21:28:04 +0200213RFC2217_REVERSE_PARITY_MAP = dict((v, k) for k, v in RFC2217_PARITY_MAP.items())
cliechti8099bed2009-08-01 23:59:18 +0000214
215RFC2217_STOPBIT_MAP = {
Chris Liechti033f17c2015-08-30 21:28:04 +0200216 serial.STOPBITS_ONE: 1,
217 serial.STOPBITS_ONE_POINT_FIVE: 3,
218 serial.STOPBITS_TWO: 2,
cliechti8099bed2009-08-01 23:59:18 +0000219}
Chris Liechti033f17c2015-08-30 21:28:04 +0200220RFC2217_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
Chris Liechti033f17c2015-08-30 21:28:04 +0200233
cliechtiac205322009-08-02 20:40:21 +0000234class TelnetOption(object):
cliechti1ef7e3e2009-08-03 02:38:43 +0000235 """Manage a single telnet option, keeps track of DO/DONT WILL/WONT."""
236
Chris Liechti70ca49c2016-02-07 23:54:03 +0100237 def __init__(self, connection, name, option, send_yes, send_no, ack_yes,
238 ack_no, initial_state, activation_callback=None):
cliechtieada4fd2013-07-31 16:26:07 +0000239 """\
240 Initialize option.
cliechti1ef7e3e2009-08-03 02:38:43 +0000241 :param connection: connection used to transmit answers
242 :param name: a readable name for debug outputs
243 :param send_yes: what to send when option is to be enabled.
244 :param send_no: what to send when option is to be disabled.
245 :param ack_yes: what to expect when remote agrees on option.
246 :param ack_no: what to expect when remote disagrees on option.
247 :param initial_state: options initialized with REQUESTED are tried to
248 be enabled on startup. use INACTIVE for all others.
249 """
cliechti2b929b72009-08-02 23:49:02 +0000250 self.connection = connection
cliechtiac205322009-08-02 20:40:21 +0000251 self.name = name
252 self.option = option
253 self.send_yes = send_yes
254 self.send_no = send_no
255 self.ack_yes = ack_yes
256 self.ack_no = ack_no
257 self.state = initial_state
258 self.active = False
cliechti86b593e2009-08-05 16:28:12 +0000259 self.activation_callback = activation_callback
cliechtiac205322009-08-02 20:40:21 +0000260
261 def __repr__(self):
cliechti1ef7e3e2009-08-03 02:38:43 +0000262 """String for debug outputs"""
cliechtiac205322009-08-02 20:40:21 +0000263 return "%s:%s(%s)" % (self.name, self.active, self.state)
264
cliechti2b929b72009-08-02 23:49:02 +0000265 def process_incoming(self, command):
cliechti7d448562014-08-03 21:57:45 +0000266 """\
267 A DO/DONT/WILL/WONT was received for this option, update state and
268 answer when needed.
269 """
cliechtiac205322009-08-02 20:40:21 +0000270 if command == self.ack_yes:
271 if self.state is REQUESTED:
272 self.state = ACTIVE
273 self.active = True
cliechti86b593e2009-08-05 16:28:12 +0000274 if self.activation_callback is not None:
275 self.activation_callback()
cliechtiac205322009-08-02 20:40:21 +0000276 elif self.state is ACTIVE:
277 pass
278 elif self.state is INACTIVE:
279 self.state = ACTIVE
cliechti1ef7e3e2009-08-03 02:38:43 +0000280 self.connection.telnetSendOption(self.send_yes, self.option)
cliechtiac205322009-08-02 20:40:21 +0000281 self.active = True
cliechti86b593e2009-08-05 16:28:12 +0000282 if self.activation_callback is not None:
283 self.activation_callback()
cliechtiac205322009-08-02 20:40:21 +0000284 elif self.state is REALLY_INACTIVE:
cliechti1ef7e3e2009-08-03 02:38:43 +0000285 self.connection.telnetSendOption(self.send_no, self.option)
cliechtiac205322009-08-02 20:40:21 +0000286 else:
287 raise ValueError('option in illegal state %r' % self)
288 elif command == self.ack_no:
289 if self.state is REQUESTED:
290 self.state = INACTIVE
291 self.active = False
292 elif self.state is ACTIVE:
293 self.state = INACTIVE
cliechti1ef7e3e2009-08-03 02:38:43 +0000294 self.connection.telnetSendOption(self.send_no, self.option)
cliechtiac205322009-08-02 20:40:21 +0000295 self.active = False
296 elif self.state is INACTIVE:
297 pass
298 elif self.state is REALLY_INACTIVE:
299 pass
300 else:
301 raise ValueError('option in illegal state %r' % self)
302
303
cliechti2b929b72009-08-02 23:49:02 +0000304class TelnetSubnegotiation(object):
cliechtieada4fd2013-07-31 16:26:07 +0000305 """\
306 A object to handle subnegotiation of options. In this case actually
307 sub-sub options for RFC 2217. It is used to track com port options.
308 """
cliechti2b929b72009-08-02 23:49:02 +0000309
310 def __init__(self, connection, name, option, ack_option=None):
Chris Liechti033f17c2015-08-30 21:28:04 +0200311 if ack_option is None:
312 ack_option = option
cliechti2b929b72009-08-02 23:49:02 +0000313 self.connection = connection
314 self.name = name
315 self.option = option
316 self.value = None
317 self.ack_option = ack_option
318 self.state = INACTIVE
319
320 def __repr__(self):
cliechti044d8662009-08-11 21:40:31 +0000321 """String for debug outputs."""
cliechti2b929b72009-08-02 23:49:02 +0000322 return "%s:%s" % (self.name, self.state)
323
324 def set(self, value):
cliechtieada4fd2013-07-31 16:26:07 +0000325 """\
cliechti7d448562014-08-03 21:57:45 +0000326 Request a change of the value. a request is sent to the server. if
cliechti2b929b72009-08-02 23:49:02 +0000327 the client needs to know if the change is performed he has to check the
cliechtieada4fd2013-07-31 16:26:07 +0000328 state of this object.
329 """
cliechti2b929b72009-08-02 23:49:02 +0000330 self.value = value
331 self.state = REQUESTED
cliechti1ef7e3e2009-08-03 02:38:43 +0000332 self.connection.rfc2217SendSubnegotiation(self.option, self.value)
cliechti6a300772009-08-12 02:28:56 +0000333 if self.connection.logger:
334 self.connection.logger.debug("SB Requesting %s -> %r" % (self.name, self.value))
cliechti2b929b72009-08-02 23:49:02 +0000335
336 def isReady(self):
cliechtieada4fd2013-07-31 16:26:07 +0000337 """\
cliechti7d448562014-08-03 21:57:45 +0000338 Check if answer from server has been received. when server rejects
cliechtieada4fd2013-07-31 16:26:07 +0000339 the change, raise a ValueError.
340 """
cliechti2b929b72009-08-02 23:49:02 +0000341 if self.state == REALLY_INACTIVE:
342 raise ValueError("remote rejected value for option %r" % (self.name))
343 return self.state == ACTIVE
cliechti1ef7e3e2009-08-03 02:38:43 +0000344 # add property to have a similar interface as TelnetOption
cliechti2b929b72009-08-02 23:49:02 +0000345 active = property(isReady)
346
cliechti044d8662009-08-11 21:40:31 +0000347 def wait(self, timeout=3):
cliechtieada4fd2013-07-31 16:26:07 +0000348 """\
cliechti7d448562014-08-03 21:57:45 +0000349 Wait until the subnegotiation has been acknowledged or timeout. It
cliechti1ef7e3e2009-08-03 02:38:43 +0000350 can also throw a value error when the answer from the server does not
cliechtieada4fd2013-07-31 16:26:07 +0000351 match the value sent.
352 """
cliechti044d8662009-08-11 21:40:31 +0000353 timeout_time = time.time() + timeout
cliechti2b929b72009-08-02 23:49:02 +0000354 while time.time() < timeout_time:
355 time.sleep(0.05) # prevent 100% CPU load
356 if self.isReady():
357 break
358 else:
359 raise SerialException("timeout while waiting for option %r" % (self.name))
360
361 def checkAnswer(self, suboption):
cliechtieada4fd2013-07-31 16:26:07 +0000362 """\
cliechti7d448562014-08-03 21:57:45 +0000363 Check an incoming subnegotiation block. The parameter already has
cliechtieada4fd2013-07-31 16:26:07 +0000364 cut off the header like sub option number and com port option value.
365 """
cliechti2b929b72009-08-02 23:49:02 +0000366 if self.value == suboption[:len(self.value)]:
367 self.state = ACTIVE
368 else:
369 # error propagation done in isReady
370 self.state = REALLY_INACTIVE
cliechti6a300772009-08-12 02:28:56 +0000371 if self.connection.logger:
372 self.connection.logger.debug("SB Answer %s -> %r -> %s" % (self.name, suboption, self.state))
cliechti2b929b72009-08-02 23:49:02 +0000373
374
Chris Liechtief6b7b42015-08-06 22:19:26 +0200375class Serial(SerialBase):
cliechti044d8662009-08-11 21:40:31 +0000376 """Serial port implementation for RFC 2217 remote serial ports."""
cliechti8099bed2009-08-01 23:59:18 +0000377
378 BAUDRATES = (50, 75, 110, 134, 150, 200, 300, 600, 1200, 1800, 2400, 4800,
379 9600, 19200, 38400, 57600, 115200)
380
Chris Liechtibb5341b2015-10-31 23:31:26 +0100381 def __init__(self, *args, **kwargs):
382 super(Serial, self).__init__(*args, **kwargs)
383 self._thread = None
384 self._socket = None
385
cliechti8099bed2009-08-01 23:59:18 +0000386 def open(self):
cliechtieada4fd2013-07-31 16:26:07 +0000387 """\
388 Open port with current settings. This may throw a SerialException
389 if the port cannot be opened.
390 """
cliechti6a300772009-08-12 02:28:56 +0000391 self.logger = None
cliechti81c54762009-08-03 23:53:27 +0000392 self._ignore_set_control_answer = False
cliechti7cb78e82009-08-05 15:47:57 +0000393 self._poll_modem_state = False
cliechtidfe2d272009-08-10 22:19:41 +0000394 self._network_timeout = 3
cliechti8099bed2009-08-01 23:59:18 +0000395 if self._port is None:
396 raise SerialException("Port must be configured before it can be used.")
Chris Liechti3ad62fb2015-08-29 21:53:32 +0200397 if self.is_open:
cliechti8f69e702011-03-19 00:22:32 +0000398 raise SerialException("Port is already open.")
cliechti8099bed2009-08-01 23:59:18 +0000399 try:
Chris Liechti3ad62fb2015-08-29 21:53:32 +0200400 self._socket = socket.create_connection(self.from_url(self.portstr))
cliechti6a300772009-08-12 02:28:56 +0000401 self._socket.setsockopt(socket.IPPROTO_TCP, socket.TCP_NODELAY, 1)
Chris Liechti68340d72015-08-03 14:15:48 +0200402 except Exception as msg:
cliechti8099bed2009-08-01 23:59:18 +0000403 self._socket = None
404 raise SerialException("Could not open port %s: %s" % (self.portstr, msg))
405
Chris Liechti033f17c2015-08-30 21:28:04 +0200406 self._socket.settimeout(5) # XXX good value?
cliechti8099bed2009-08-01 23:59:18 +0000407
cliechti1ef7e3e2009-08-03 02:38:43 +0000408 # use a thread save queue as buffer. it also simplifies implementing
409 # the read timeout
cliechti8099bed2009-08-01 23:59:18 +0000410 self._read_buffer = Queue.Queue()
cliechti81c54762009-08-03 23:53:27 +0000411 # to ensure that user writes does not interfere with internal
412 # telnet/rfc2217 options establish a lock
413 self._write_lock = threading.Lock()
cliechtiac205322009-08-02 20:40:21 +0000414 # name the following separately so that, below, a check can be easily done
415 mandadory_options = [
cliechti2b929b72009-08-02 23:49:02 +0000416 TelnetOption(self, 'we-BINARY', BINARY, WILL, WONT, DO, DONT, INACTIVE),
cliechti2b929b72009-08-02 23:49:02 +0000417 TelnetOption(self, 'we-RFC2217', COM_PORT_OPTION, WILL, WONT, DO, DONT, REQUESTED),
cliechtiac205322009-08-02 20:40:21 +0000418 ]
419 # all supported telnet options
420 self._telnet_options = [
cliechtia29275e2009-08-03 00:08:04 +0000421 TelnetOption(self, 'ECHO', ECHO, DO, DONT, WILL, WONT, REQUESTED),
cliechti2b929b72009-08-02 23:49:02 +0000422 TelnetOption(self, 'we-SGA', SGA, WILL, WONT, DO, DONT, REQUESTED),
423 TelnetOption(self, 'they-SGA', SGA, DO, DONT, WILL, WONT, REQUESTED),
cliechti81c54762009-08-03 23:53:27 +0000424 TelnetOption(self, 'they-BINARY', BINARY, DO, DONT, WILL, WONT, INACTIVE),
425 TelnetOption(self, 'they-RFC2217', COM_PORT_OPTION, DO, DONT, WILL, WONT, REQUESTED),
cliechtiac205322009-08-02 20:40:21 +0000426 ] + mandadory_options
cliechti044d8662009-08-11 21:40:31 +0000427 # RFC 2217 specific states
cliechti2b929b72009-08-02 23:49:02 +0000428 # COM port settings
429 self._rfc2217_port_settings = {
430 'baudrate': TelnetSubnegotiation(self, 'baudrate', SET_BAUDRATE, SERVER_SET_BAUDRATE),
431 'datasize': TelnetSubnegotiation(self, 'datasize', SET_DATASIZE, SERVER_SET_DATASIZE),
432 'parity': TelnetSubnegotiation(self, 'parity', SET_PARITY, SERVER_SET_PARITY),
433 'stopsize': TelnetSubnegotiation(self, 'stopsize', SET_STOPSIZE, SERVER_SET_STOPSIZE),
Chris Liechticb6ce1b2016-02-02 01:53:56 +0100434 }
cliechticb20a4f2011-04-25 02:25:54 +0000435 # There are more subnegotiation objects, combine all in one dictionary
cliechti2b929b72009-08-02 23:49:02 +0000436 # for easy access
437 self._rfc2217_options = {
438 'purge': TelnetSubnegotiation(self, 'purge', PURGE_DATA, SERVER_PURGE_DATA),
cliechti81c54762009-08-03 23:53:27 +0000439 'control': TelnetSubnegotiation(self, 'control', SET_CONTROL, SERVER_SET_CONTROL),
Chris Liechticb6ce1b2016-02-02 01:53:56 +0100440 }
cliechti2b929b72009-08-02 23:49:02 +0000441 self._rfc2217_options.update(self._rfc2217_port_settings)
442 # cache for line and modem states that the server sends to us
cliechti8099bed2009-08-01 23:59:18 +0000443 self._linestate = 0
cliechti7cb78e82009-08-05 15:47:57 +0000444 self._modemstate = None
445 self._modemstate_expires = 0
cliechti044d8662009-08-11 21:40:31 +0000446 # RFC 2217 flow control between server and client
cliechti672d0292009-08-03 02:01:57 +0000447 self._remote_suspend_flow = False
cliechti8099bed2009-08-01 23:59:18 +0000448
Chris Liechti39d52172015-10-25 22:53:51 +0100449 self.is_open = True
cliechti1ef7e3e2009-08-03 02:38:43 +0000450 self._thread = threading.Thread(target=self._telnetReadLoop)
cliechti8099bed2009-08-01 23:59:18 +0000451 self._thread.setDaemon(True)
cliechti5cc3eb12009-08-11 23:04:30 +0000452 self._thread.setName('pySerial RFC 2217 reader thread for %s' % (self._port,))
cliechti8099bed2009-08-01 23:59:18 +0000453 self._thread.start()
454
Chris Liechti39d52172015-10-25 22:53:51 +0100455 try: # must clean-up if open fails
456 # negotiate Telnet/RFC 2217 -> send initial requests
457 for option in self._telnet_options:
458 if option.state is REQUESTED:
459 self.telnetSendOption(option.send_yes, option.option)
460 # now wait until important options are negotiated
461 timeout_time = time.time() + self._network_timeout
462 while time.time() < timeout_time:
463 time.sleep(0.05) # prevent 100% CPU load
464 if sum(o.active for o in mandadory_options) == sum(o.state != INACTIVE for o in mandadory_options):
465 break
466 else:
467 raise SerialException("Remote does not seem to support RFC2217 or BINARY mode %r" % mandadory_options)
468 if self.logger:
469 self.logger.info("Negotiated options: %s" % self._telnet_options)
cliechti8099bed2009-08-01 23:59:18 +0000470
Chris Liechti39d52172015-10-25 22:53:51 +0100471 # fine, go on, set RFC 2271 specific things
472 self._reconfigure_port()
473 # all things set up get, now a clean start
474 if not self._dsrdtr:
475 self._update_dtr_state()
476 if not self._rtscts:
477 self._update_rts_state()
478 self.reset_input_buffer()
479 self.reset_output_buffer()
480 except:
481 self.close()
482 raise
cliechti8099bed2009-08-01 23:59:18 +0000483
Chris Liechti3ad62fb2015-08-29 21:53:32 +0200484 def _reconfigure_port(self):
cliechti8099bed2009-08-01 23:59:18 +0000485 """Set communication parameters on opened port."""
486 if self._socket is None:
487 raise SerialException("Can only operate on open ports")
488
cliechti8099bed2009-08-01 23:59:18 +0000489 # if self._timeout != 0 and self._interCharTimeout is not None:
cliechti8099bed2009-08-01 23:59:18 +0000490 # XXX
491
Chris Liechti3ad62fb2015-08-29 21:53:32 +0200492 if self._write_timeout is not None:
493 raise NotImplementedError('write_timeout is currently not supported')
cliechti2b929b72009-08-02 23:49:02 +0000494 # XXX
cliechti8099bed2009-08-01 23:59:18 +0000495
cliechti2b929b72009-08-02 23:49:02 +0000496 # Setup the connection
cliechti1ef7e3e2009-08-03 02:38:43 +0000497 # to get good performance, all parameter changes are sent first...
Chris Liechtiba45c522016-02-06 23:53:23 +0100498 if not 0 < self._baudrate < 2 ** 32:
cliechti81c54762009-08-03 23:53:27 +0000499 raise ValueError("invalid baudrate: %r" % (self._baudrate))
Chris Liechti01587b12015-08-05 02:39:32 +0200500 self._rfc2217_port_settings['baudrate'].set(struct.pack(b'!I', self._baudrate))
501 self._rfc2217_port_settings['datasize'].set(struct.pack(b'!B', self._bytesize))
502 self._rfc2217_port_settings['parity'].set(struct.pack(b'!B', RFC2217_PARITY_MAP[self._parity]))
503 self._rfc2217_port_settings['stopsize'].set(struct.pack(b'!B', RFC2217_STOPBIT_MAP[self._stopbits]))
cliechti8099bed2009-08-01 23:59:18 +0000504
cliechti2b929b72009-08-02 23:49:02 +0000505 # and now wait until parameters are active
506 items = self._rfc2217_port_settings.values()
cliechti6a300772009-08-12 02:28:56 +0000507 if self.logger:
508 self.logger.debug("Negotiating settings: %s" % (items,))
cliechtidfe2d272009-08-10 22:19:41 +0000509 timeout_time = time.time() + self._network_timeout
cliechti2b929b72009-08-02 23:49:02 +0000510 while time.time() < timeout_time:
511 time.sleep(0.05) # prevent 100% CPU load
512 if sum(o.active for o in items) == len(items):
513 break
514 else:
515 raise SerialException("Remote does not accept parameter change (RFC2217): %r" % items)
cliechti6a300772009-08-12 02:28:56 +0000516 if self.logger:
517 self.logger.info("Negotiated settings: %s" % (items,))
cliechti8099bed2009-08-01 23:59:18 +0000518
519 if self._rtscts and self._xonxoff:
cliechti1ef7e3e2009-08-03 02:38:43 +0000520 raise ValueError('xonxoff and rtscts together are not supported')
cliechti8099bed2009-08-01 23:59:18 +0000521 elif self._rtscts:
cliechti1ef7e3e2009-08-03 02:38:43 +0000522 self.rfc2217SetControl(SET_CONTROL_USE_HW_FLOW_CONTROL)
cliechti8099bed2009-08-01 23:59:18 +0000523 elif self._xonxoff:
cliechti1ef7e3e2009-08-03 02:38:43 +0000524 self.rfc2217SetControl(SET_CONTROL_USE_SW_FLOW_CONTROL)
cliechti8099bed2009-08-01 23:59:18 +0000525 else:
cliechti1ef7e3e2009-08-03 02:38:43 +0000526 self.rfc2217SetControl(SET_CONTROL_USE_NO_FLOW_CONTROL)
cliechti8099bed2009-08-01 23:59:18 +0000527
528 def close(self):
529 """Close port"""
Chris Liechti39d52172015-10-25 22:53:51 +0100530 self.is_open = False
531 if self._socket:
532 try:
533 self._socket.shutdown(socket.SHUT_RDWR)
534 self._socket.close()
535 except:
536 # ignore errors.
537 pass
538 if self._thread:
539 self._thread.join(7) # XXX more than socket timeout
540 self._thread = None
cliechti8099bed2009-08-01 23:59:18 +0000541 # in case of quick reconnects, give the server some time
542 time.sleep(0.3)
Chris Liechti39d52172015-10-25 22:53:51 +0100543 self._socket = None
cliechti8099bed2009-08-01 23:59:18 +0000544
Chris Liechti3ad62fb2015-08-29 21:53:32 +0200545 def from_url(self, url):
cliechti1ef7e3e2009-08-03 02:38:43 +0000546 """extract host and port from an URL string"""
Chris Liechtia4222112015-08-07 01:03:12 +0200547 parts = urlparse.urlsplit(url)
Chris Liechtid14b1ab2015-08-21 00:28:53 +0200548 if parts.scheme != "rfc2217":
549 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 +0000550 try:
Chris Liechtia4222112015-08-07 01:03:12 +0200551 # process options now, directly altering self
Chris Liechtid14b1ab2015-08-21 00:28:53 +0200552 for option, values in urlparse.parse_qs(parts.query, True).items():
553 if option == 'logging':
Chris Liechtia4222112015-08-07 01:03:12 +0200554 logging.basicConfig() # XXX is that good to call it here?
555 self.logger = logging.getLogger('pySerial.rfc2217')
Chris Liechtid14b1ab2015-08-21 00:28:53 +0200556 self.logger.setLevel(LOGGER_LEVELS[values[0]])
Chris Liechtia4222112015-08-07 01:03:12 +0200557 self.logger.debug('enabled logging')
558 elif option == 'ign_set_control':
559 self._ignore_set_control_answer = True
560 elif option == 'poll_modem':
561 self._poll_modem_state = True
562 elif option == 'timeout':
Chris Liechtid14b1ab2015-08-21 00:28:53 +0200563 self._network_timeout = float(values[0])
Chris Liechtia4222112015-08-07 01:03:12 +0200564 else:
565 raise ValueError('unknown option: %r' % (option,))
cliechti81c54762009-08-03 23:53:27 +0000566 # get host and port
Chris Liechtia4222112015-08-07 01:03:12 +0200567 host, port = parts.hostname, parts.port
Chris Liechti033f17c2015-08-30 21:28:04 +0200568 if not 0 <= port < 65536:
569 raise ValueError("port not in range 0...65535")
Chris Liechti68340d72015-08-03 14:15:48 +0200570 except ValueError as e:
Chris Liechtid14b1ab2015-08-21 00:28:53 +0200571 raise SerialException('expected a string in the form "rfc2217://<host>:<port>[?option[&option...]]": %s' % e)
cliechti8099bed2009-08-01 23:59:18 +0000572 return (host, port)
573
574 # - - - - - - - - - - - - - - - - - - - - - - - -
575
Chris Liechtief1fe252015-08-27 23:25:21 +0200576 @property
577 def in_waiting(self):
Chris Liechti3ad62fb2015-08-29 21:53:32 +0200578 """Return the number of bytes currently in the input buffer."""
Chris Liechti033f17c2015-08-30 21:28:04 +0200579 if not self.is_open:
580 raise portNotOpenError
cliechti8099bed2009-08-01 23:59:18 +0000581 return self._read_buffer.qsize()
582
583 def read(self, size=1):
cliechtieada4fd2013-07-31 16:26:07 +0000584 """\
585 Read size bytes from the serial port. If a timeout is set it may
cliechti8099bed2009-08-01 23:59:18 +0000586 return less characters as requested. With no timeout it will block
cliechtieada4fd2013-07-31 16:26:07 +0000587 until the requested number of bytes is read.
588 """
Chris Liechti033f17c2015-08-30 21:28:04 +0200589 if not self.is_open:
590 raise portNotOpenError
cliechti8099bed2009-08-01 23:59:18 +0000591 data = bytearray()
592 try:
593 while len(data) < size:
cliechti81c54762009-08-03 23:53:27 +0000594 if self._thread is None:
595 raise SerialException('connection failed (reader thread died)')
Chris Liechti01587b12015-08-05 02:39:32 +0200596 data += self._read_buffer.get(True, self._timeout)
Chris Liechti033f17c2015-08-30 21:28:04 +0200597 except Queue.Empty: # -> timeout
cliechti8099bed2009-08-01 23:59:18 +0000598 pass
599 return bytes(data)
600
601 def write(self, data):
cliechtieada4fd2013-07-31 16:26:07 +0000602 """\
Chris Liechti3ad62fb2015-08-29 21:53:32 +0200603 Output the given byte string over the serial port. Can block if the
cliechti8099bed2009-08-01 23:59:18 +0000604 connection is blocked. May raise SerialException if the connection is
cliechtieada4fd2013-07-31 16:26:07 +0000605 closed.
606 """
Chris Liechti033f17c2015-08-30 21:28:04 +0200607 if not self.is_open:
608 raise portNotOpenError
Chris Liechti01587b12015-08-05 02:39:32 +0200609 with self._write_lock:
cliechti81c54762009-08-03 23:53:27 +0000610 try:
cliechti38077122013-10-16 02:57:27 +0000611 self._socket.sendall(to_bytes(data).replace(IAC, IAC_DOUBLED))
Chris Liechti68340d72015-08-03 14:15:48 +0200612 except socket.error as e:
Chris Liechti142ae562015-08-23 01:11:06 +0200613 raise SerialException("connection failed (socket error): %s" % (e,))
cliechti8099bed2009-08-01 23:59:18 +0000614 return len(data)
615
Chris Liechtief1fe252015-08-27 23:25:21 +0200616 def reset_input_buffer(self):
cliechti8099bed2009-08-01 23:59:18 +0000617 """Clear input buffer, discarding all that is in the buffer."""
Chris Liechti033f17c2015-08-30 21:28:04 +0200618 if not self.is_open:
619 raise portNotOpenError
cliechti1ef7e3e2009-08-03 02:38:43 +0000620 self.rfc2217SendPurge(PURGE_RECEIVE_BUFFER)
cliechti8099bed2009-08-01 23:59:18 +0000621 # empty read buffer
622 while self._read_buffer.qsize():
623 self._read_buffer.get(False)
624
Chris Liechtief1fe252015-08-27 23:25:21 +0200625 def reset_output_buffer(self):
cliechtieada4fd2013-07-31 16:26:07 +0000626 """\
627 Clear output buffer, aborting the current output and
628 discarding all that is in the buffer.
629 """
Chris Liechti033f17c2015-08-30 21:28:04 +0200630 if not self.is_open:
631 raise portNotOpenError
cliechti1ef7e3e2009-08-03 02:38:43 +0000632 self.rfc2217SendPurge(PURGE_TRANSMIT_BUFFER)
cliechti8099bed2009-08-01 23:59:18 +0000633
Chris Liechtief1fe252015-08-27 23:25:21 +0200634 def _update_break_state(self):
cliechtieada4fd2013-07-31 16:26:07 +0000635 """\
636 Set break: Controls TXD. When active, to transmitting is
637 possible.
638 """
Chris Liechti033f17c2015-08-30 21:28:04 +0200639 if not self.is_open:
640 raise portNotOpenError
cliechti6a300772009-08-12 02:28:56 +0000641 if self.logger:
Chris Liechtief1fe252015-08-27 23:25:21 +0200642 self.logger.info('set BREAK to %s' % ('active' if self._break_state else 'inactive'))
643 if self._break_state:
cliechti1ef7e3e2009-08-03 02:38:43 +0000644 self.rfc2217SetControl(SET_CONTROL_BREAK_ON)
cliechti8099bed2009-08-01 23:59:18 +0000645 else:
cliechti1ef7e3e2009-08-03 02:38:43 +0000646 self.rfc2217SetControl(SET_CONTROL_BREAK_OFF)
cliechti8099bed2009-08-01 23:59:18 +0000647
Chris Liechtief1fe252015-08-27 23:25:21 +0200648 def _update_rts_state(self):
cliechti044d8662009-08-11 21:40:31 +0000649 """Set terminal status line: Request To Send."""
Chris Liechti033f17c2015-08-30 21:28:04 +0200650 if not self.is_open:
651 raise portNotOpenError
cliechti6a300772009-08-12 02:28:56 +0000652 if self.logger:
Chris Liechtief1fe252015-08-27 23:25:21 +0200653 self.logger.info('set RTS to %s' % ('active' if self._rts_state else 'inactive'))
654 if self._rts_state:
cliechti1ef7e3e2009-08-03 02:38:43 +0000655 self.rfc2217SetControl(SET_CONTROL_RTS_ON)
cliechti8099bed2009-08-01 23:59:18 +0000656 else:
cliechti1ef7e3e2009-08-03 02:38:43 +0000657 self.rfc2217SetControl(SET_CONTROL_RTS_OFF)
cliechti8099bed2009-08-01 23:59:18 +0000658
Chris Liechtief1fe252015-08-27 23:25:21 +0200659 def _update_dtr_state(self, level=True):
cliechti044d8662009-08-11 21:40:31 +0000660 """Set terminal status line: Data Terminal Ready."""
Chris Liechti033f17c2015-08-30 21:28:04 +0200661 if not self.is_open:
662 raise portNotOpenError
cliechti6a300772009-08-12 02:28:56 +0000663 if self.logger:
Chris Liechtief1fe252015-08-27 23:25:21 +0200664 self.logger.info('set DTR to %s' % ('active' if self._dtr_state else 'inactive'))
665 if self._dtr_state:
cliechti1ef7e3e2009-08-03 02:38:43 +0000666 self.rfc2217SetControl(SET_CONTROL_DTR_ON)
cliechti8099bed2009-08-01 23:59:18 +0000667 else:
cliechti1ef7e3e2009-08-03 02:38:43 +0000668 self.rfc2217SetControl(SET_CONTROL_DTR_OFF)
cliechti8099bed2009-08-01 23:59:18 +0000669
Chris Liechtief1fe252015-08-27 23:25:21 +0200670 @property
671 def cts(self):
cliechti044d8662009-08-11 21:40:31 +0000672 """Read terminal status line: Clear To Send."""
Chris Liechti033f17c2015-08-30 21:28:04 +0200673 if not self.is_open:
674 raise portNotOpenError
cliechti7cb78e82009-08-05 15:47:57 +0000675 return bool(self.getModemState() & MODEMSTATE_MASK_CTS)
cliechti8099bed2009-08-01 23:59:18 +0000676
Chris Liechtief1fe252015-08-27 23:25:21 +0200677 @property
678 def dsr(self):
cliechti044d8662009-08-11 21:40:31 +0000679 """Read terminal status line: Data Set Ready."""
Chris Liechti033f17c2015-08-30 21:28:04 +0200680 if not self.is_open:
681 raise portNotOpenError
cliechti7cb78e82009-08-05 15:47:57 +0000682 return bool(self.getModemState() & MODEMSTATE_MASK_DSR)
cliechti8099bed2009-08-01 23:59:18 +0000683
Chris Liechtief1fe252015-08-27 23:25:21 +0200684 @property
685 def ri(self):
cliechti044d8662009-08-11 21:40:31 +0000686 """Read terminal status line: Ring Indicator."""
Chris Liechti033f17c2015-08-30 21:28:04 +0200687 if not self.is_open:
688 raise portNotOpenError
cliechti7cb78e82009-08-05 15:47:57 +0000689 return bool(self.getModemState() & MODEMSTATE_MASK_RI)
cliechti8099bed2009-08-01 23:59:18 +0000690
Chris Liechtief1fe252015-08-27 23:25:21 +0200691 @property
692 def cd(self):
cliechti044d8662009-08-11 21:40:31 +0000693 """Read terminal status line: Carrier Detect."""
Chris Liechti033f17c2015-08-30 21:28:04 +0200694 if not self.is_open:
695 raise portNotOpenError
cliechti7cb78e82009-08-05 15:47:57 +0000696 return bool(self.getModemState() & MODEMSTATE_MASK_CD)
cliechti8099bed2009-08-01 23:59:18 +0000697
698 # - - - platform specific - - -
699 # None so far
700
701 # - - - RFC2217 specific - - -
702
cliechti1ef7e3e2009-08-03 02:38:43 +0000703 def _telnetReadLoop(self):
cliechti7d448562014-08-03 21:57:45 +0000704 """Read loop for the socket."""
cliechti8099bed2009-08-01 23:59:18 +0000705 mode = M_NORMAL
706 suboption = None
cliechti81c54762009-08-03 23:53:27 +0000707 try:
Chris Liechti39d52172015-10-25 22:53:51 +0100708 while self.is_open:
cliechti81c54762009-08-03 23:53:27 +0000709 try:
710 data = self._socket.recv(1024)
711 except socket.timeout:
712 # just need to get out of recv form time to time to check if
713 # still alive
714 continue
Chris Liechti68340d72015-08-03 14:15:48 +0200715 except socket.error as e:
cliechti81c54762009-08-03 23:53:27 +0000716 # connection fails -> terminate loop
cliechticb20a4f2011-04-25 02:25:54 +0000717 if self.logger:
718 self.logger.debug("socket error in reader thread: %s" % (e,))
cliechti81c54762009-08-03 23:53:27 +0000719 break
Chris Liechti033f17c2015-08-30 21:28:04 +0200720 if not data:
721 break # lost connection
Chris Liechtif99cd5c2015-08-13 22:54:16 +0200722 for byte in iterbytes(data):
cliechti81c54762009-08-03 23:53:27 +0000723 if mode == M_NORMAL:
724 # interpret as command or as data
725 if byte == IAC:
726 mode = M_IAC_SEEN
cliechti8099bed2009-08-01 23:59:18 +0000727 else:
cliechti81c54762009-08-03 23:53:27 +0000728 # store data in read buffer or sub option buffer
729 # depending on state
730 if suboption is not None:
Chris Liechti01587b12015-08-05 02:39:32 +0200731 suboption += byte
cliechti81c54762009-08-03 23:53:27 +0000732 else:
733 self._read_buffer.put(byte)
734 elif mode == M_IAC_SEEN:
735 if byte == IAC:
736 # interpret as command doubled -> insert character
737 # itself
cliechtif325c032009-12-25 16:09:49 +0000738 if suboption is not None:
Chris Liechti01587b12015-08-05 02:39:32 +0200739 suboption += IAC
cliechtif325c032009-12-25 16:09:49 +0000740 else:
741 self._read_buffer.put(IAC)
cliechti81c54762009-08-03 23:53:27 +0000742 mode = M_NORMAL
743 elif byte == SB:
744 # sub option start
745 suboption = bytearray()
746 mode = M_NORMAL
747 elif byte == SE:
748 # sub option end -> process it now
749 self._telnetProcessSubnegotiation(bytes(suboption))
750 suboption = None
751 mode = M_NORMAL
752 elif byte in (DO, DONT, WILL, WONT):
753 # negotiation
754 telnet_command = byte
755 mode = M_NEGOTIATE
756 else:
757 # other telnet commands
758 self._telnetProcessCommand(byte)
759 mode = M_NORMAL
Chris Liechti033f17c2015-08-30 21:28:04 +0200760 elif mode == M_NEGOTIATE: # DO, DONT, WILL, WONT was received, option now following
cliechti81c54762009-08-03 23:53:27 +0000761 self._telnetNegotiateOption(telnet_command, byte)
cliechti8099bed2009-08-01 23:59:18 +0000762 mode = M_NORMAL
cliechti81c54762009-08-03 23:53:27 +0000763 finally:
764 self._thread = None
cliechti6a300772009-08-12 02:28:56 +0000765 if self.logger:
766 self.logger.debug("read thread terminated")
cliechti8099bed2009-08-01 23:59:18 +0000767
768 # - incoming telnet commands and options
769
cliechti1ef7e3e2009-08-03 02:38:43 +0000770 def _telnetProcessCommand(self, command):
cliechti044d8662009-08-11 21:40:31 +0000771 """Process commands other than DO, DONT, WILL, WONT."""
cliechti1ef7e3e2009-08-03 02:38:43 +0000772 # Currently none. RFC2217 only uses negotiation and subnegotiation.
cliechti6a300772009-08-12 02:28:56 +0000773 if self.logger:
774 self.logger.warning("ignoring Telnet command: %r" % (command,))
cliechti8099bed2009-08-01 23:59:18 +0000775
cliechti1ef7e3e2009-08-03 02:38:43 +0000776 def _telnetNegotiateOption(self, command, option):
cliechti044d8662009-08-11 21:40:31 +0000777 """Process incoming DO, DONT, WILL, WONT."""
cliechti2b929b72009-08-02 23:49:02 +0000778 # check our registered telnet options and forward command to them
779 # they know themselves if they have to answer or not
cliechtiac205322009-08-02 20:40:21 +0000780 known = False
781 for item in self._telnet_options:
cliechti2b929b72009-08-02 23:49:02 +0000782 # can have more than one match! as some options are duplicated for
783 # 'us' and 'them'
cliechtiac205322009-08-02 20:40:21 +0000784 if item.option == option:
cliechti2b929b72009-08-02 23:49:02 +0000785 item.process_incoming(command)
cliechtiac205322009-08-02 20:40:21 +0000786 known = True
787 if not known:
788 # handle unknown options
789 # only answer to positive requests and deny them
790 if command == WILL or command == DO:
Chris Liechti142ae562015-08-23 01:11:06 +0200791 self.telnetSendOption((DONT if command == WILL else WONT), option)
cliechti6a300772009-08-12 02:28:56 +0000792 if self.logger:
793 self.logger.warning("rejected Telnet option: %r" % (option,))
cliechtiac205322009-08-02 20:40:21 +0000794
cliechti1ef7e3e2009-08-03 02:38:43 +0000795 def _telnetProcessSubnegotiation(self, suboption):
cliechti044d8662009-08-11 21:40:31 +0000796 """Process subnegotiation, the data between IAC SB and IAC SE."""
cliechti8099bed2009-08-01 23:59:18 +0000797 if suboption[0:1] == COM_PORT_OPTION:
798 if suboption[1:2] == SERVER_NOTIFY_LINESTATE and len(suboption) >= 3:
Chris Liechti033f17c2015-08-30 21:28:04 +0200799 self._linestate = ord(suboption[2:3]) # ensure it is a number
cliechti6a300772009-08-12 02:28:56 +0000800 if self.logger:
801 self.logger.info("NOTIFY_LINESTATE: %s" % self._linestate)
cliechti8099bed2009-08-01 23:59:18 +0000802 elif suboption[1:2] == SERVER_NOTIFY_MODEMSTATE and len(suboption) >= 3:
Chris Liechti033f17c2015-08-30 21:28:04 +0200803 self._modemstate = ord(suboption[2:3]) # ensure it is a number
cliechti6a300772009-08-12 02:28:56 +0000804 if self.logger:
805 self.logger.info("NOTIFY_MODEMSTATE: %s" % self._modemstate)
cliechti7cb78e82009-08-05 15:47:57 +0000806 # update time when we think that a poll would make sense
807 self._modemstate_expires = time.time() + 0.3
cliechti672d0292009-08-03 02:01:57 +0000808 elif suboption[1:2] == FLOWCONTROL_SUSPEND:
809 self._remote_suspend_flow = True
810 elif suboption[1:2] == FLOWCONTROL_RESUME:
811 self._remote_suspend_flow = False
cliechti8099bed2009-08-01 23:59:18 +0000812 else:
cliechti2b929b72009-08-02 23:49:02 +0000813 for item in self._rfc2217_options.values():
814 if item.ack_option == suboption[1:2]:
cliechti81c54762009-08-03 23:53:27 +0000815 #~ print "processing COM_PORT_OPTION: %r" % list(suboption[1:])
cliechti2b929b72009-08-02 23:49:02 +0000816 item.checkAnswer(bytes(suboption[2:]))
817 break
818 else:
cliechti6a300772009-08-12 02:28:56 +0000819 if self.logger:
820 self.logger.warning("ignoring COM_PORT_OPTION: %r" % (suboption,))
cliechti8099bed2009-08-01 23:59:18 +0000821 else:
cliechti6a300772009-08-12 02:28:56 +0000822 if self.logger:
823 self.logger.warning("ignoring subnegotiation: %r" % (suboption,))
cliechti8099bed2009-08-01 23:59:18 +0000824
825 # - outgoing telnet commands and options
826
cliechti81c54762009-08-03 23:53:27 +0000827 def _internal_raw_write(self, data):
cliechti044d8662009-08-11 21:40:31 +0000828 """internal socket write with no data escaping. used to send telnet stuff."""
Chris Liechti01587b12015-08-05 02:39:32 +0200829 with self._write_lock:
cliechti81c54762009-08-03 23:53:27 +0000830 self._socket.sendall(data)
cliechti81c54762009-08-03 23:53:27 +0000831
cliechti1ef7e3e2009-08-03 02:38:43 +0000832 def telnetSendOption(self, action, option):
cliechti044d8662009-08-11 21:40:31 +0000833 """Send DO, DONT, WILL, WONT."""
cliechti81c54762009-08-03 23:53:27 +0000834 self._internal_raw_write(to_bytes([IAC, action, option]))
cliechti8099bed2009-08-01 23:59:18 +0000835
Chris Liechtib4cda3a2015-08-08 17:12:08 +0200836 def rfc2217SendSubnegotiation(self, option, value=b''):
cliechti044d8662009-08-11 21:40:31 +0000837 """Subnegotiation of RFC2217 parameters."""
cliechtif325c032009-12-25 16:09:49 +0000838 value = value.replace(IAC, IAC_DOUBLED)
cliechti81c54762009-08-03 23:53:27 +0000839 self._internal_raw_write(to_bytes([IAC, SB, COM_PORT_OPTION, option] + list(value) + [IAC, SE]))
cliechti2b929b72009-08-02 23:49:02 +0000840
cliechti1ef7e3e2009-08-03 02:38:43 +0000841 def rfc2217SendPurge(self, value):
cliechti2b929b72009-08-02 23:49:02 +0000842 item = self._rfc2217_options['purge']
Chris Liechti033f17c2015-08-30 21:28:04 +0200843 item.set(value) # transmit desired purge type
844 item.wait(self._network_timeout) # wait for acknowledge from the server
cliechti2b929b72009-08-02 23:49:02 +0000845
cliechti1ef7e3e2009-08-03 02:38:43 +0000846 def rfc2217SetControl(self, value):
cliechti81c54762009-08-03 23:53:27 +0000847 item = self._rfc2217_options['control']
Chris Liechti033f17c2015-08-30 21:28:04 +0200848 item.set(value) # transmit desired control type
cliechti81c54762009-08-03 23:53:27 +0000849 if self._ignore_set_control_answer:
850 # answers are ignored when option is set. compatibility mode for
cliechticb20a4f2011-04-25 02:25:54 +0000851 # servers that answer, but not the expected one... (or no answer
cliechti81c54762009-08-03 23:53:27 +0000852 # at all) i.e. sredird
853 time.sleep(0.1) # this helps getting the unit tests passed
854 else:
cliechtidfe2d272009-08-10 22:19:41 +0000855 item.wait(self._network_timeout) # wait for acknowledge from the server
cliechti8099bed2009-08-01 23:59:18 +0000856
cliechti1ef7e3e2009-08-03 02:38:43 +0000857 def rfc2217FlowServerReady(self):
cliechtieada4fd2013-07-31 16:26:07 +0000858 """\
859 check if server is ready to receive data. block for some time when
860 not.
861 """
cliechti672d0292009-08-03 02:01:57 +0000862 #~ if self._remote_suspend_flow:
Chris Liechtiba45c522016-02-06 23:53:23 +0100863 #~ wait---
cliechti672d0292009-08-03 02:01:57 +0000864
cliechti7cb78e82009-08-05 15:47:57 +0000865 def getModemState(self):
cliechtieada4fd2013-07-31 16:26:07 +0000866 """\
cliechti7d448562014-08-03 21:57:45 +0000867 get last modem state (cached value. If value is "old", request a new
868 one. This cache helps that we don't issue to many requests when e.g. all
869 status lines, one after the other is queried by the user (getCTS, getDSR
cliechtieada4fd2013-07-31 16:26:07 +0000870 etc.)
871 """
cliechti7cb78e82009-08-05 15:47:57 +0000872 # active modem state polling enabled? is the value fresh enough?
873 if self._poll_modem_state and self._modemstate_expires < time.time():
cliechti6a300772009-08-12 02:28:56 +0000874 if self.logger:
875 self.logger.debug('polling modem state')
cliechti7cb78e82009-08-05 15:47:57 +0000876 # when it is older, request an update
877 self.rfc2217SendSubnegotiation(NOTIFY_MODEMSTATE)
cliechtidfe2d272009-08-10 22:19:41 +0000878 timeout_time = time.time() + self._network_timeout
cliechti7cb78e82009-08-05 15:47:57 +0000879 while time.time() < timeout_time:
880 time.sleep(0.05) # prevent 100% CPU load
881 # when expiration time is updated, it means that there is a new
882 # value
883 if self._modemstate_expires > time.time():
884 break
Chris Liechti01587b12015-08-05 02:39:32 +0200885 else:
886 if self.logger:
887 self.logger.warning('poll for modem state failed')
cliechti7cb78e82009-08-05 15:47:57 +0000888 # even when there is a timeout, do not generate an error just
889 # return the last known value. this way we can support buggy
890 # servers that do not respond to polls, but send automatic
891 # updates.
892 if self._modemstate is not None:
cliechti6a300772009-08-12 02:28:56 +0000893 if self.logger:
894 self.logger.debug('using cached modem state')
cliechti7cb78e82009-08-05 15:47:57 +0000895 return self._modemstate
896 else:
897 # never received a notification from the server
cliechti8fb119c2009-08-05 23:39:45 +0000898 raise SerialException("remote sends no NOTIFY_MODEMSTATE")
cliechti8099bed2009-08-01 23:59:18 +0000899
cliechti5cc3eb12009-08-11 23:04:30 +0000900
cliechti595ed5b2009-08-10 01:43:32 +0000901#############################################################################
cliechti5cc3eb12009-08-11 23:04:30 +0000902# The following is code that helps implementing an RFC 2217 server.
cliechti8099bed2009-08-01 23:59:18 +0000903
cliechti8ccc2ff2009-08-05 12:44:46 +0000904class PortManager(object):
cliechtieada4fd2013-07-31 16:26:07 +0000905 """\
906 This class manages the state of Telnet and RFC 2217. It needs a serial
cliechticb20a4f2011-04-25 02:25:54 +0000907 instance and a connection to work with. Connection is expected to implement
cliechtieada4fd2013-07-31 16:26:07 +0000908 a (thread safe) write function, that writes the string to the network.
909 """
cliechti130d1f02009-08-04 02:10:58 +0000910
cliechti6a300772009-08-12 02:28:56 +0000911 def __init__(self, serial_port, connection, logger=None):
cliechti130d1f02009-08-04 02:10:58 +0000912 self.serial = serial_port
913 self.connection = connection
cliechti6a300772009-08-12 02:28:56 +0000914 self.logger = logger
cliechti86b593e2009-08-05 16:28:12 +0000915 self._client_is_rfc2217 = False
cliechti130d1f02009-08-04 02:10:58 +0000916
917 # filter state machine
918 self.mode = M_NORMAL
919 self.suboption = None
920 self.telnet_command = None
921
922 # states for modem/line control events
923 self.modemstate_mask = 255
924 self.last_modemstate = None
925 self.linstate_mask = 0
926
927 # all supported telnet options
928 self._telnet_options = [
929 TelnetOption(self, 'ECHO', ECHO, WILL, WONT, DO, DONT, REQUESTED),
930 TelnetOption(self, 'we-SGA', SGA, WILL, WONT, DO, DONT, REQUESTED),
931 TelnetOption(self, 'they-SGA', SGA, DO, DONT, WILL, WONT, INACTIVE),
932 TelnetOption(self, 'we-BINARY', BINARY, WILL, WONT, DO, DONT, INACTIVE),
933 TelnetOption(self, 'they-BINARY', BINARY, DO, DONT, WILL, WONT, REQUESTED),
cliechti86b593e2009-08-05 16:28:12 +0000934 TelnetOption(self, 'we-RFC2217', COM_PORT_OPTION, WILL, WONT, DO, DONT, REQUESTED, self._client_ok),
935 TelnetOption(self, 'they-RFC2217', COM_PORT_OPTION, DO, DONT, WILL, WONT, INACTIVE, self._client_ok),
Chris Liechticb6ce1b2016-02-02 01:53:56 +0100936 ]
cliechti130d1f02009-08-04 02:10:58 +0000937
938 # negotiate Telnet/RFC2217 -> send initial requests
cliechti6a300772009-08-12 02:28:56 +0000939 if self.logger:
940 self.logger.debug("requesting initial Telnet/RFC 2217 options")
cliechti130d1f02009-08-04 02:10:58 +0000941 for option in self._telnet_options:
942 if option.state is REQUESTED:
943 self.telnetSendOption(option.send_yes, option.option)
944 # issue 1st modem state notification
cliechti86b593e2009-08-05 16:28:12 +0000945
946 def _client_ok(self):
cliechtieada4fd2013-07-31 16:26:07 +0000947 """\
cliechti7d448562014-08-03 21:57:45 +0000948 callback of telnet option. It gets called when option is activated.
949 This one here is used to detect when the client agrees on RFC 2217. A
cliechti86b593e2009-08-05 16:28:12 +0000950 flag is set so that other functions like check_modem_lines know if the
cliechti7d448562014-08-03 21:57:45 +0000951 client is OK.
cliechtieada4fd2013-07-31 16:26:07 +0000952 """
cliechti86b593e2009-08-05 16:28:12 +0000953 # The callback is used for we and they so if one party agrees, we're
954 # already happy. it seems not all servers do the negotiation correctly
955 # and i guess there are incorrect clients too.. so be happy if client
956 # answers one or the other positively.
957 self._client_is_rfc2217 = True
cliechti6a300772009-08-12 02:28:56 +0000958 if self.logger:
959 self.logger.info("client accepts RFC 2217")
cliechti8fb119c2009-08-05 23:39:45 +0000960 # this is to ensure that the client gets a notification, even if there
961 # was no change
962 self.check_modem_lines(force_notification=True)
cliechti130d1f02009-08-04 02:10:58 +0000963
964 # - outgoing telnet commands and options
965
966 def telnetSendOption(self, action, option):
cliechti044d8662009-08-11 21:40:31 +0000967 """Send DO, DONT, WILL, WONT."""
cliechti130d1f02009-08-04 02:10:58 +0000968 self.connection.write(to_bytes([IAC, action, option]))
969
Chris Liechtib4cda3a2015-08-08 17:12:08 +0200970 def rfc2217SendSubnegotiation(self, option, value=b''):
cliechti044d8662009-08-11 21:40:31 +0000971 """Subnegotiation of RFC 2217 parameters."""
cliechtif325c032009-12-25 16:09:49 +0000972 value = value.replace(IAC, IAC_DOUBLED)
cliechti130d1f02009-08-04 02:10:58 +0000973 self.connection.write(to_bytes([IAC, SB, COM_PORT_OPTION, option] + list(value) + [IAC, SE]))
974
975 # - check modem lines, needs to be called periodically from user to
976 # establish polling
977
cliechti7cb78e82009-08-05 15:47:57 +0000978 def check_modem_lines(self, force_notification=False):
cliechti130d1f02009-08-04 02:10:58 +0000979 modemstate = (
Chris Liechtiba45c522016-02-06 23:53:23 +0100980 (self.serial.getCTS() and MODEMSTATE_MASK_CTS) |
981 (self.serial.getDSR() and MODEMSTATE_MASK_DSR) |
982 (self.serial.getRI() and MODEMSTATE_MASK_RI) |
983 (self.serial.getCD() and MODEMSTATE_MASK_CD))
cliechti7cb78e82009-08-05 15:47:57 +0000984 # check what has changed
Chris Liechti033f17c2015-08-30 21:28:04 +0200985 deltas = modemstate ^ (self.last_modemstate or 0) # when last is None -> 0
cliechti7cb78e82009-08-05 15:47:57 +0000986 if deltas & MODEMSTATE_MASK_CTS:
987 modemstate |= MODEMSTATE_MASK_CTS_CHANGE
988 if deltas & MODEMSTATE_MASK_DSR:
989 modemstate |= MODEMSTATE_MASK_DSR_CHANGE
990 if deltas & MODEMSTATE_MASK_RI:
991 modemstate |= MODEMSTATE_MASK_RI_CHANGE
992 if deltas & MODEMSTATE_MASK_CD:
993 modemstate |= MODEMSTATE_MASK_CD_CHANGE
994 # if new state is different and the mask allows this change, send
cliechti86b593e2009-08-05 16:28:12 +0000995 # notification. suppress notifications when client is not rfc2217
cliechti7cb78e82009-08-05 15:47:57 +0000996 if modemstate != self.last_modemstate or force_notification:
cliechti8fb119c2009-08-05 23:39:45 +0000997 if (self._client_is_rfc2217 and (modemstate & self.modemstate_mask)) or force_notification:
cliechti7cb78e82009-08-05 15:47:57 +0000998 self.rfc2217SendSubnegotiation(
Chris Liechticb6ce1b2016-02-02 01:53:56 +0100999 SERVER_NOTIFY_MODEMSTATE,
1000 to_bytes([modemstate & self.modemstate_mask]))
cliechti6a300772009-08-12 02:28:56 +00001001 if self.logger:
1002 self.logger.info("NOTIFY_MODEMSTATE: %s" % (modemstate,))
cliechti7cb78e82009-08-05 15:47:57 +00001003 # save last state, but forget about deltas.
1004 # otherwise it would also notify about changing deltas which is
1005 # probably not very useful
1006 self.last_modemstate = modemstate & 0xf0
cliechti130d1f02009-08-04 02:10:58 +00001007
cliechti32c10332009-08-05 13:23:43 +00001008 # - outgoing data escaping
1009
1010 def escape(self, data):
cliechtieada4fd2013-07-31 16:26:07 +00001011 """\
cliechti7d448562014-08-03 21:57:45 +00001012 This generator function is for the user. All outgoing data has to be
cliechticb20a4f2011-04-25 02:25:54 +00001013 properly escaped, so that no IAC character in the data stream messes up
1014 the Telnet state machine in the server.
cliechti32c10332009-08-05 13:23:43 +00001015
1016 socket.sendall(escape(data))
1017 """
Chris Liechtib15dc052015-10-19 23:17:16 +02001018 for byte in iterbytes(data):
cliechti32c10332009-08-05 13:23:43 +00001019 if byte == IAC:
1020 yield IAC
1021 yield IAC
1022 else:
1023 yield byte
1024
cliechti130d1f02009-08-04 02:10:58 +00001025 # - incoming data filter
1026
1027 def filter(self, data):
cliechtieada4fd2013-07-31 16:26:07 +00001028 """\
cliechti7d448562014-08-03 21:57:45 +00001029 Handle a bunch of incoming bytes. This is a generator. It will yield
cliechti044d8662009-08-11 21:40:31 +00001030 all characters not of interest for Telnet/RFC 2217.
cliechti130d1f02009-08-04 02:10:58 +00001031
1032 The idea is that the reader thread pushes data from the socket through
1033 this filter:
1034
1035 for byte in filter(socket.recv(1024)):
1036 # do things like CR/LF conversion/whatever
1037 # and write data to the serial port
1038 serial.write(byte)
1039
1040 (socket error handling code left as exercise for the reader)
1041 """
Chris Liechtif99cd5c2015-08-13 22:54:16 +02001042 for byte in iterbytes(data):
cliechti130d1f02009-08-04 02:10:58 +00001043 if self.mode == M_NORMAL:
1044 # interpret as command or as data
1045 if byte == IAC:
1046 self.mode = M_IAC_SEEN
1047 else:
1048 # store data in sub option buffer or pass it to our
1049 # consumer depending on state
1050 if self.suboption is not None:
Chris Liechti01587b12015-08-05 02:39:32 +02001051 self.suboption += byte
cliechti130d1f02009-08-04 02:10:58 +00001052 else:
1053 yield byte
1054 elif self.mode == M_IAC_SEEN:
1055 if byte == IAC:
1056 # interpret as command doubled -> insert character
1057 # itself
cliechtif325c032009-12-25 16:09:49 +00001058 if self.suboption is not None:
Chris Liechti01587b12015-08-05 02:39:32 +02001059 self.suboption += byte
cliechtif325c032009-12-25 16:09:49 +00001060 else:
1061 yield byte
cliechti130d1f02009-08-04 02:10:58 +00001062 self.mode = M_NORMAL
1063 elif byte == SB:
1064 # sub option start
1065 self.suboption = bytearray()
1066 self.mode = M_NORMAL
1067 elif byte == SE:
1068 # sub option end -> process it now
1069 self._telnetProcessSubnegotiation(bytes(self.suboption))
1070 self.suboption = None
1071 self.mode = M_NORMAL
1072 elif byte in (DO, DONT, WILL, WONT):
1073 # negotiation
1074 self.telnet_command = byte
1075 self.mode = M_NEGOTIATE
1076 else:
1077 # other telnet commands
1078 self._telnetProcessCommand(byte)
1079 self.mode = M_NORMAL
Chris Liechti033f17c2015-08-30 21:28:04 +02001080 elif self.mode == M_NEGOTIATE: # DO, DONT, WILL, WONT was received, option now following
cliechti130d1f02009-08-04 02:10:58 +00001081 self._telnetNegotiateOption(self.telnet_command, byte)
1082 self.mode = M_NORMAL
1083
1084 # - incoming telnet commands and options
1085
1086 def _telnetProcessCommand(self, command):
cliechti044d8662009-08-11 21:40:31 +00001087 """Process commands other than DO, DONT, WILL, WONT."""
cliechti130d1f02009-08-04 02:10:58 +00001088 # Currently none. RFC2217 only uses negotiation and subnegotiation.
cliechti6a300772009-08-12 02:28:56 +00001089 if self.logger:
1090 self.logger.warning("ignoring Telnet command: %r" % (command,))
cliechti130d1f02009-08-04 02:10:58 +00001091
1092 def _telnetNegotiateOption(self, command, option):
cliechti044d8662009-08-11 21:40:31 +00001093 """Process incoming DO, DONT, WILL, WONT."""
cliechti130d1f02009-08-04 02:10:58 +00001094 # check our registered telnet options and forward command to them
1095 # they know themselves if they have to answer or not
1096 known = False
1097 for item in self._telnet_options:
1098 # can have more than one match! as some options are duplicated for
1099 # 'us' and 'them'
1100 if item.option == option:
1101 item.process_incoming(command)
1102 known = True
1103 if not known:
1104 # handle unknown options
1105 # only answer to positive requests and deny them
1106 if command == WILL or command == DO:
Chris Liechti142ae562015-08-23 01:11:06 +02001107 self.telnetSendOption((DONT if command == WILL else WONT), option)
cliechti6a300772009-08-12 02:28:56 +00001108 if self.logger:
1109 self.logger.warning("rejected Telnet option: %r" % (option,))
cliechti130d1f02009-08-04 02:10:58 +00001110
cliechti130d1f02009-08-04 02:10:58 +00001111 def _telnetProcessSubnegotiation(self, suboption):
cliechti044d8662009-08-11 21:40:31 +00001112 """Process subnegotiation, the data between IAC SB and IAC SE."""
cliechti130d1f02009-08-04 02:10:58 +00001113 if suboption[0:1] == COM_PORT_OPTION:
cliechti6a300772009-08-12 02:28:56 +00001114 if self.logger:
1115 self.logger.debug('received COM_PORT_OPTION: %r' % (suboption,))
cliechti130d1f02009-08-04 02:10:58 +00001116 if suboption[1:2] == SET_BAUDRATE:
1117 backup = self.serial.baudrate
1118 try:
Chris Liechti01587b12015-08-05 02:39:32 +02001119 (baudrate,) = struct.unpack(b"!I", suboption[2:6])
cliechtieada4fd2013-07-31 16:26:07 +00001120 if baudrate != 0:
1121 self.serial.baudrate = baudrate
Chris Liechtid2146002015-08-04 16:57:16 +02001122 except ValueError as e:
cliechti6a300772009-08-12 02:28:56 +00001123 if self.logger:
1124 self.logger.error("failed to set baud rate: %s" % (e,))
cliechti130d1f02009-08-04 02:10:58 +00001125 self.serial.baudrate = backup
cliechti5cc3eb12009-08-11 23:04:30 +00001126 else:
cliechti6a300772009-08-12 02:28:56 +00001127 if self.logger:
Chris Liechti142ae562015-08-23 01:11:06 +02001128 self.logger.info("%s baud rate: %s" % ('set' if baudrate else 'get', self.serial.baudrate))
Chris Liechti01587b12015-08-05 02:39:32 +02001129 self.rfc2217SendSubnegotiation(SERVER_SET_BAUDRATE, struct.pack(b"!I", self.serial.baudrate))
cliechti130d1f02009-08-04 02:10:58 +00001130 elif suboption[1:2] == SET_DATASIZE:
1131 backup = self.serial.bytesize
1132 try:
Chris Liechti142ae562015-08-23 01:11:06 +02001133 (datasize,) = struct.unpack(b"!B", suboption[2:3])
cliechtieada4fd2013-07-31 16:26:07 +00001134 if datasize != 0:
1135 self.serial.bytesize = datasize
Chris Liechtid2146002015-08-04 16:57:16 +02001136 except ValueError as e:
cliechti6a300772009-08-12 02:28:56 +00001137 if self.logger:
1138 self.logger.error("failed to set data size: %s" % (e,))
cliechti130d1f02009-08-04 02:10:58 +00001139 self.serial.bytesize = backup
cliechti5cc3eb12009-08-11 23:04:30 +00001140 else:
cliechti6a300772009-08-12 02:28:56 +00001141 if self.logger:
Chris Liechti142ae562015-08-23 01:11:06 +02001142 self.logger.info("%s data size: %s" % ('set' if datasize else 'get', self.serial.bytesize))
Chris Liechti01587b12015-08-05 02:39:32 +02001143 self.rfc2217SendSubnegotiation(SERVER_SET_DATASIZE, struct.pack(b"!B", self.serial.bytesize))
cliechti130d1f02009-08-04 02:10:58 +00001144 elif suboption[1:2] == SET_PARITY:
1145 backup = self.serial.parity
1146 try:
Chris Liechti01587b12015-08-05 02:39:32 +02001147 parity = struct.unpack(b"!B", suboption[2:3])[0]
cliechtieada4fd2013-07-31 16:26:07 +00001148 if parity != 0:
1149 self.serial.parity = RFC2217_REVERSE_PARITY_MAP[parity]
Chris Liechtid2146002015-08-04 16:57:16 +02001150 except ValueError as e:
cliechti6a300772009-08-12 02:28:56 +00001151 if self.logger:
1152 self.logger.error("failed to set parity: %s" % (e,))
cliechti130d1f02009-08-04 02:10:58 +00001153 self.serial.parity = backup
cliechti5cc3eb12009-08-11 23:04:30 +00001154 else:
cliechti6a300772009-08-12 02:28:56 +00001155 if self.logger:
Chris Liechti142ae562015-08-23 01:11:06 +02001156 self.logger.info("%s parity: %s" % ('set' if parity else 'get', self.serial.parity))
cliechti130d1f02009-08-04 02:10:58 +00001157 self.rfc2217SendSubnegotiation(
Chris Liechticb6ce1b2016-02-02 01:53:56 +01001158 SERVER_SET_PARITY,
1159 struct.pack(b"!B", RFC2217_PARITY_MAP[self.serial.parity]))
cliechti130d1f02009-08-04 02:10:58 +00001160 elif suboption[1:2] == SET_STOPSIZE:
1161 backup = self.serial.stopbits
1162 try:
Chris Liechti01587b12015-08-05 02:39:32 +02001163 stopbits = struct.unpack(b"!B", suboption[2:3])[0]
cliechtieada4fd2013-07-31 16:26:07 +00001164 if stopbits != 0:
1165 self.serial.stopbits = RFC2217_REVERSE_STOPBIT_MAP[stopbits]
Chris Liechtid2146002015-08-04 16:57:16 +02001166 except ValueError as e:
cliechti6a300772009-08-12 02:28:56 +00001167 if self.logger:
1168 self.logger.error("failed to set stop bits: %s" % (e,))
cliechti130d1f02009-08-04 02:10:58 +00001169 self.serial.stopbits = backup
cliechti5cc3eb12009-08-11 23:04:30 +00001170 else:
cliechti6a300772009-08-12 02:28:56 +00001171 if self.logger:
Chris Liechti142ae562015-08-23 01:11:06 +02001172 self.logger.info("%s stop bits: %s" % ('set' if stopbits else 'get', self.serial.stopbits))
cliechti130d1f02009-08-04 02:10:58 +00001173 self.rfc2217SendSubnegotiation(
Chris Liechticb6ce1b2016-02-02 01:53:56 +01001174 SERVER_SET_STOPSIZE,
1175 struct.pack(b"!B", RFC2217_STOPBIT_MAP[self.serial.stopbits]))
cliechti130d1f02009-08-04 02:10:58 +00001176 elif suboption[1:2] == SET_CONTROL:
1177 if suboption[2:3] == SET_CONTROL_REQ_FLOW_SETTING:
1178 if self.serial.xonxoff:
1179 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_USE_SW_FLOW_CONTROL)
1180 elif self.serial.rtscts:
1181 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_USE_HW_FLOW_CONTROL)
1182 else:
1183 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_USE_NO_FLOW_CONTROL)
1184 elif suboption[2:3] == SET_CONTROL_USE_NO_FLOW_CONTROL:
1185 self.serial.xonxoff = False
1186 self.serial.rtscts = False
cliechti6a300772009-08-12 02:28:56 +00001187 if self.logger:
1188 self.logger.info("changed flow control to None")
cliechti130d1f02009-08-04 02:10:58 +00001189 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_USE_NO_FLOW_CONTROL)
1190 elif suboption[2:3] == SET_CONTROL_USE_SW_FLOW_CONTROL:
1191 self.serial.xonxoff = True
cliechti6a300772009-08-12 02:28:56 +00001192 if self.logger:
1193 self.logger.info("changed flow control to XON/XOFF")
cliechti130d1f02009-08-04 02:10:58 +00001194 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_USE_SW_FLOW_CONTROL)
1195 elif suboption[2:3] == SET_CONTROL_USE_HW_FLOW_CONTROL:
1196 self.serial.rtscts = True
cliechti6a300772009-08-12 02:28:56 +00001197 if self.logger:
1198 self.logger.info("changed flow control to RTS/CTS")
cliechti130d1f02009-08-04 02:10:58 +00001199 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_USE_HW_FLOW_CONTROL)
1200 elif suboption[2:3] == SET_CONTROL_REQ_BREAK_STATE:
cliechti6a300772009-08-12 02:28:56 +00001201 if self.logger:
1202 self.logger.warning("requested break state - not implemented")
Chris Liechti033f17c2015-08-30 21:28:04 +02001203 pass # XXX needs cached value
cliechti130d1f02009-08-04 02:10:58 +00001204 elif suboption[2:3] == SET_CONTROL_BREAK_ON:
1205 self.serial.setBreak(True)
cliechti6a300772009-08-12 02:28:56 +00001206 if self.logger:
1207 self.logger.info("changed BREAK to active")
cliechti130d1f02009-08-04 02:10:58 +00001208 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_BREAK_ON)
1209 elif suboption[2:3] == SET_CONTROL_BREAK_OFF:
1210 self.serial.setBreak(False)
cliechti6a300772009-08-12 02:28:56 +00001211 if self.logger:
1212 self.logger.info("changed BREAK to inactive")
cliechti130d1f02009-08-04 02:10:58 +00001213 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_BREAK_OFF)
1214 elif suboption[2:3] == SET_CONTROL_REQ_DTR:
cliechti6a300772009-08-12 02:28:56 +00001215 if self.logger:
1216 self.logger.warning("requested DTR state - not implemented")
Chris Liechti033f17c2015-08-30 21:28:04 +02001217 pass # XXX needs cached value
cliechti130d1f02009-08-04 02:10:58 +00001218 elif suboption[2:3] == SET_CONTROL_DTR_ON:
1219 self.serial.setDTR(True)
cliechti6a300772009-08-12 02:28:56 +00001220 if self.logger:
1221 self.logger.info("changed DTR to active")
cliechti130d1f02009-08-04 02:10:58 +00001222 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_DTR_ON)
1223 elif suboption[2:3] == SET_CONTROL_DTR_OFF:
1224 self.serial.setDTR(False)
cliechti6a300772009-08-12 02:28:56 +00001225 if self.logger:
1226 self.logger.info("changed DTR to inactive")
cliechti130d1f02009-08-04 02:10:58 +00001227 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_DTR_OFF)
1228 elif suboption[2:3] == SET_CONTROL_REQ_RTS:
cliechti6a300772009-08-12 02:28:56 +00001229 if self.logger:
1230 self.logger.warning("requested RTS state - not implemented")
Chris Liechti033f17c2015-08-30 21:28:04 +02001231 pass # XXX needs cached value
cliechti130d1f02009-08-04 02:10:58 +00001232 #~ self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_RTS_ON)
1233 elif suboption[2:3] == SET_CONTROL_RTS_ON:
1234 self.serial.setRTS(True)
cliechti6a300772009-08-12 02:28:56 +00001235 if self.logger:
1236 self.logger.info("changed RTS to active")
cliechti130d1f02009-08-04 02:10:58 +00001237 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_RTS_ON)
1238 elif suboption[2:3] == SET_CONTROL_RTS_OFF:
1239 self.serial.setRTS(False)
cliechti6a300772009-08-12 02:28:56 +00001240 if self.logger:
1241 self.logger.info("changed RTS to inactive")
cliechti130d1f02009-08-04 02:10:58 +00001242 self.rfc2217SendSubnegotiation(SERVER_SET_CONTROL, SET_CONTROL_RTS_OFF)
1243 #~ elif suboption[2:3] == SET_CONTROL_REQ_FLOW_SETTING_IN:
1244 #~ elif suboption[2:3] == SET_CONTROL_USE_NO_FLOW_CONTROL_IN:
1245 #~ elif suboption[2:3] == SET_CONTROL_USE_SW_FLOW_CONTOL_IN:
1246 #~ elif suboption[2:3] == SET_CONTROL_USE_HW_FLOW_CONTOL_IN:
1247 #~ elif suboption[2:3] == SET_CONTROL_USE_DCD_FLOW_CONTROL:
1248 #~ elif suboption[2:3] == SET_CONTROL_USE_DTR_FLOW_CONTROL:
1249 #~ elif suboption[2:3] == SET_CONTROL_USE_DSR_FLOW_CONTROL:
1250 elif suboption[1:2] == NOTIFY_LINESTATE:
cliechti7cb78e82009-08-05 15:47:57 +00001251 # client polls for current state
1252 self.rfc2217SendSubnegotiation(
Chris Liechti142ae562015-08-23 01:11:06 +02001253 SERVER_NOTIFY_LINESTATE,
1254 to_bytes([0])) # sorry, nothing like that implemented
cliechti130d1f02009-08-04 02:10:58 +00001255 elif suboption[1:2] == NOTIFY_MODEMSTATE:
cliechti6a300772009-08-12 02:28:56 +00001256 if self.logger:
1257 self.logger.info("request for modem state")
cliechti7cb78e82009-08-05 15:47:57 +00001258 # client polls for current state
1259 self.check_modem_lines(force_notification=True)
cliechti130d1f02009-08-04 02:10:58 +00001260 elif suboption[1:2] == FLOWCONTROL_SUSPEND:
cliechti6a300772009-08-12 02:28:56 +00001261 if self.logger:
1262 self.logger.info("suspend")
cliechti130d1f02009-08-04 02:10:58 +00001263 self._remote_suspend_flow = True
1264 elif suboption[1:2] == FLOWCONTROL_RESUME:
cliechti6a300772009-08-12 02:28:56 +00001265 if self.logger:
1266 self.logger.info("resume")
cliechti130d1f02009-08-04 02:10:58 +00001267 self._remote_suspend_flow = False
1268 elif suboption[1:2] == SET_LINESTATE_MASK:
Chris Liechti033f17c2015-08-30 21:28:04 +02001269 self.linstate_mask = ord(suboption[2:3]) # ensure it is a number
cliechti6a300772009-08-12 02:28:56 +00001270 if self.logger:
cliechtif325c032009-12-25 16:09:49 +00001271 self.logger.info("line state mask: 0x%02x" % (self.linstate_mask,))
cliechti130d1f02009-08-04 02:10:58 +00001272 elif suboption[1:2] == SET_MODEMSTATE_MASK:
Chris Liechti033f17c2015-08-30 21:28:04 +02001273 self.modemstate_mask = ord(suboption[2:3]) # ensure it is a number
cliechti6a300772009-08-12 02:28:56 +00001274 if self.logger:
cliechtif325c032009-12-25 16:09:49 +00001275 self.logger.info("modem state mask: 0x%02x" % (self.modemstate_mask,))
cliechti130d1f02009-08-04 02:10:58 +00001276 elif suboption[1:2] == PURGE_DATA:
1277 if suboption[2:3] == PURGE_RECEIVE_BUFFER:
Chris Liechti3ad62fb2015-08-29 21:53:32 +02001278 self.serial.reset_input_buffer()
cliechti6a300772009-08-12 02:28:56 +00001279 if self.logger:
1280 self.logger.info("purge in")
cliechti130d1f02009-08-04 02:10:58 +00001281 self.rfc2217SendSubnegotiation(SERVER_PURGE_DATA, PURGE_RECEIVE_BUFFER)
1282 elif suboption[2:3] == PURGE_TRANSMIT_BUFFER:
Chris Liechti3ad62fb2015-08-29 21:53:32 +02001283 self.serial.reset_output_buffer()
cliechti6a300772009-08-12 02:28:56 +00001284 if self.logger:
1285 self.logger.info("purge out")
cliechti130d1f02009-08-04 02:10:58 +00001286 self.rfc2217SendSubnegotiation(SERVER_PURGE_DATA, PURGE_TRANSMIT_BUFFER)
1287 elif suboption[2:3] == PURGE_BOTH_BUFFERS:
Chris Liechti3ad62fb2015-08-29 21:53:32 +02001288 self.serial.reset_input_buffer()
1289 self.serial.reset_output_buffer()
cliechti6a300772009-08-12 02:28:56 +00001290 if self.logger:
1291 self.logger.info("purge both")
cliechti130d1f02009-08-04 02:10:58 +00001292 self.rfc2217SendSubnegotiation(SERVER_PURGE_DATA, PURGE_BOTH_BUFFERS)
1293 else:
cliechti6a300772009-08-12 02:28:56 +00001294 if self.logger:
1295 self.logger.error("undefined PURGE_DATA: %r" % list(suboption[2:]))
cliechti130d1f02009-08-04 02:10:58 +00001296 else:
cliechti6a300772009-08-12 02:28:56 +00001297 if self.logger:
1298 self.logger.error("undefined COM_PORT_OPTION: %r" % list(suboption[1:]))
cliechti130d1f02009-08-04 02:10:58 +00001299 else:
cliechti6a300772009-08-12 02:28:56 +00001300 if self.logger:
1301 self.logger.warning("unknown subnegotiation: %r" % (suboption,))
cliechti130d1f02009-08-04 02:10:58 +00001302
1303
1304# simple client test
cliechti8099bed2009-08-01 23:59:18 +00001305if __name__ == '__main__':
1306 import sys
1307 s = Serial('rfc2217://localhost:7000', 115200)
1308 sys.stdout.write('%s\n' % s)
1309
cliechti8099bed2009-08-01 23:59:18 +00001310 sys.stdout.write("write...\n")
Chris Liechtib4cda3a2015-08-08 17:12:08 +02001311 s.write(b"hello\n")
cliechti8099bed2009-08-01 23:59:18 +00001312 s.flush()
cliechti8099bed2009-08-01 23:59:18 +00001313 sys.stdout.write("read: %s\n" % s.read(5))
cliechti8099bed2009-08-01 23:59:18 +00001314 s.close()