cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 1 | #!/usr/bin/env python |
Chris Liechti | fbdd8a0 | 2015-08-09 02:37:45 +0200 | [diff] [blame] | 2 | # |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 3 | # redirect data from a TCP/IP connection to a serial port and vice versa |
| 4 | # using RFC 2217 |
Chris Liechti | fbdd8a0 | 2015-08-09 02:37:45 +0200 | [diff] [blame] | 5 | # |
Chris Liechti | 34290f4 | 2015-08-17 03:08:24 +0200 | [diff] [blame] | 6 | # (C) 2009-2015 Chris Liechti <cliechti@gmx.net> |
Chris Liechti | fbdd8a0 | 2015-08-09 02:37:45 +0200 | [diff] [blame] | 7 | # |
| 8 | # SPDX-License-Identifier: BSD-3-Clause |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 9 | |
Chris Liechti | 4caf6a5 | 2015-08-04 01:07:45 +0200 | [diff] [blame] | 10 | import logging |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 11 | import socket |
Chris Liechti | 4caf6a5 | 2015-08-04 01:07:45 +0200 | [diff] [blame] | 12 | import sys |
| 13 | import time |
| 14 | import threading |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 15 | import serial |
| 16 | import serial.rfc2217 |
| 17 | |
Chris Liechti | 6948bd8 | 2015-09-07 23:38:37 +0200 | [diff] [blame] | 18 | |
Chris Liechti | 4caf6a5 | 2015-08-04 01:07:45 +0200 | [diff] [blame] | 19 | class Redirector(object): |
Chris Liechti | 34290f4 | 2015-08-17 03:08:24 +0200 | [diff] [blame] | 20 | def __init__(self, serial_instance, socket, debug=False): |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 21 | self.serial = serial_instance |
| 22 | self.socket = socket |
| 23 | self._write_lock = threading.Lock() |
cliechti | 5cc3eb1 | 2009-08-11 23:04:30 +0000 | [diff] [blame] | 24 | self.rfc2217 = serial.rfc2217.PortManager( |
Chris Liechti | 0269b2c | 2016-02-14 23:45:23 +0100 | [diff] [blame] | 25 | self.serial, |
| 26 | self, |
| 27 | logger=logging.getLogger('rfc2217.server') if debug else None) |
cliechti | 5cc3eb1 | 2009-08-11 23:04:30 +0000 | [diff] [blame] | 28 | self.log = logging.getLogger('redirector') |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 29 | |
| 30 | def statusline_poller(self): |
cliechti | 5cc3eb1 | 2009-08-11 23:04:30 +0000 | [diff] [blame] | 31 | self.log.debug('status line poll thread started') |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 32 | while self.alive: |
| 33 | time.sleep(1) |
| 34 | self.rfc2217.check_modem_lines() |
cliechti | 5cc3eb1 | 2009-08-11 23:04:30 +0000 | [diff] [blame] | 35 | self.log.debug('status line poll thread terminated') |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 36 | |
Chris Liechti | 34290f4 | 2015-08-17 03:08:24 +0200 | [diff] [blame] | 37 | def shortcircuit(self): |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 38 | """connect the serial port to the TCP port by copying everything |
| 39 | from one side to the other""" |
| 40 | self.alive = True |
| 41 | self.thread_read = threading.Thread(target=self.reader) |
Chris Liechti | 6948bd8 | 2015-09-07 23:38:37 +0200 | [diff] [blame] | 42 | self.thread_read.daemon = True |
| 43 | self.thread_read.name = 'serial->socket' |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 44 | self.thread_read.start() |
| 45 | self.thread_poll = threading.Thread(target=self.statusline_poller) |
Chris Liechti | 6948bd8 | 2015-09-07 23:38:37 +0200 | [diff] [blame] | 46 | self.thread_poll.daemon = True |
| 47 | self.thread_poll.name = 'status line poll' |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 48 | self.thread_poll.start() |
| 49 | self.writer() |
| 50 | |
| 51 | def reader(self): |
| 52 | """loop forever and copy serial->socket""" |
cliechti | 5cc3eb1 | 2009-08-11 23:04:30 +0000 | [diff] [blame] | 53 | self.log.debug('reader thread started') |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 54 | while self.alive: |
| 55 | try: |
Chris Liechti | 6948bd8 | 2015-09-07 23:38:37 +0200 | [diff] [blame] | 56 | data = self.serial.read(self.serial.in_waiting or 1) |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 57 | if data: |
| 58 | # escape outgoing data when needed (Telnet IAC (0xff) character) |
Greg Bowser | d005842 | 2016-11-22 13:38:24 -0500 | [diff] [blame] | 59 | self.write(b''.join(self.rfc2217.escape(data))) |
Chris Liechti | 4caf6a5 | 2015-08-04 01:07:45 +0200 | [diff] [blame] | 60 | except socket.error as msg: |
Chris Liechti | 9a16666 | 2016-06-21 23:22:53 +0200 | [diff] [blame] | 61 | self.log.error('{}'.format(msg)) |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 62 | # probably got disconnected |
| 63 | break |
| 64 | self.alive = False |
cliechti | 5cc3eb1 | 2009-08-11 23:04:30 +0000 | [diff] [blame] | 65 | self.log.debug('reader thread terminated') |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 66 | |
| 67 | def write(self, data): |
| 68 | """thread safe socket write with no data escaping. used to send telnet stuff""" |
Chris Liechti | 4caf6a5 | 2015-08-04 01:07:45 +0200 | [diff] [blame] | 69 | with self._write_lock: |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 70 | self.socket.sendall(data) |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 71 | |
| 72 | def writer(self): |
| 73 | """loop forever and copy socket->serial""" |
| 74 | while self.alive: |
| 75 | try: |
| 76 | data = self.socket.recv(1024) |
| 77 | if not data: |
| 78 | break |
Greg Bowser | d005842 | 2016-11-22 13:38:24 -0500 | [diff] [blame] | 79 | self.serial.write(b''.join(self.rfc2217.filter(data))) |
Chris Liechti | 4caf6a5 | 2015-08-04 01:07:45 +0200 | [diff] [blame] | 80 | except socket.error as msg: |
Chris Liechti | 9a16666 | 2016-06-21 23:22:53 +0200 | [diff] [blame] | 81 | self.log.error('{}'.format(msg)) |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 82 | # probably got disconnected |
| 83 | break |
cliechti | d9a06ce | 2009-08-10 01:30:53 +0000 | [diff] [blame] | 84 | self.stop() |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 85 | |
| 86 | def stop(self): |
| 87 | """Stop copying""" |
cliechti | 5cc3eb1 | 2009-08-11 23:04:30 +0000 | [diff] [blame] | 88 | self.log.debug('stopping') |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 89 | if self.alive: |
| 90 | self.alive = False |
| 91 | self.thread_read.join() |
cliechti | d9a06ce | 2009-08-10 01:30:53 +0000 | [diff] [blame] | 92 | self.thread_poll.join() |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 93 | |
| 94 | |
| 95 | if __name__ == '__main__': |
Chris Liechti | 34290f4 | 2015-08-17 03:08:24 +0200 | [diff] [blame] | 96 | import argparse |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 97 | |
Chris Liechti | 34290f4 | 2015-08-17 03:08:24 +0200 | [diff] [blame] | 98 | parser = argparse.ArgumentParser( |
Chris Liechti | 6948bd8 | 2015-09-07 23:38:37 +0200 | [diff] [blame] | 99 | description="RFC 2217 Serial to Network (TCP/IP) redirector.", |
| 100 | epilog="""\ |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 101 | NOTE: no security measures are implemented. Anyone can remotely connect |
| 102 | to this service over the network. |
| 103 | |
| 104 | Only one connection at once is supported. When the connection is terminated |
| 105 | it waits for the next connect. |
| 106 | """) |
| 107 | |
Chris Liechti | 34290f4 | 2015-08-17 03:08:24 +0200 | [diff] [blame] | 108 | parser.add_argument('SERIALPORT') |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 109 | |
Chris Liechti | 6948bd8 | 2015-09-07 23:38:37 +0200 | [diff] [blame] | 110 | parser.add_argument( |
Chris Liechti | 0269b2c | 2016-02-14 23:45:23 +0100 | [diff] [blame] | 111 | '-p', '--localport', |
| 112 | type=int, |
| 113 | help='local TCP port, default: %(default)s', |
| 114 | metavar='TCPPORT', |
| 115 | default=2217) |
cliechti | 5cc3eb1 | 2009-08-11 23:04:30 +0000 | [diff] [blame] | 116 | |
Chris Liechti | 6948bd8 | 2015-09-07 23:38:37 +0200 | [diff] [blame] | 117 | parser.add_argument( |
Chris Liechti | 0269b2c | 2016-02-14 23:45:23 +0100 | [diff] [blame] | 118 | '-v', '--verbose', |
| 119 | dest='verbosity', |
| 120 | action='count', |
| 121 | help='print more diagnostic messages (option can be given multiple times)', |
| 122 | default=0) |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 123 | |
Chris Liechti | 34290f4 | 2015-08-17 03:08:24 +0200 | [diff] [blame] | 124 | args = parser.parse_args() |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 125 | |
Chris Liechti | 34290f4 | 2015-08-17 03:08:24 +0200 | [diff] [blame] | 126 | if args.verbosity > 3: |
| 127 | args.verbosity = 3 |
Chris Liechti | 0269b2c | 2016-02-14 23:45:23 +0100 | [diff] [blame] | 128 | level = (logging.WARNING, |
| 129 | logging.INFO, |
| 130 | logging.DEBUG, |
| 131 | logging.NOTSET)[args.verbosity] |
cliechti | 5cc3eb1 | 2009-08-11 23:04:30 +0000 | [diff] [blame] | 132 | logging.basicConfig(level=logging.INFO) |
Chris Liechti | 6948bd8 | 2015-09-07 23:38:37 +0200 | [diff] [blame] | 133 | #~ logging.getLogger('root').setLevel(logging.INFO) |
cliechti | 5cc3eb1 | 2009-08-11 23:04:30 +0000 | [diff] [blame] | 134 | logging.getLogger('rfc2217').setLevel(level) |
| 135 | |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 136 | # connect to serial port |
Chris Liechti | cd42db9 | 2015-08-17 03:24:34 +0200 | [diff] [blame] | 137 | ser = serial.serial_for_url(args.SERIALPORT, do_not_open=True) |
Chris Liechti | 6948bd8 | 2015-09-07 23:38:37 +0200 | [diff] [blame] | 138 | ser.timeout = 3 # required so that the reader thread can exit |
| 139 | # reset control line as no _remote_ "terminal" has been connected yet |
| 140 | ser.dtr = False |
| 141 | ser.rts = False |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 142 | |
cliechti | 5cc3eb1 | 2009-08-11 23:04:30 +0000 | [diff] [blame] | 143 | logging.info("RFC 2217 TCP/IP to Serial redirector - type Ctrl-C / BREAK to quit") |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 144 | |
| 145 | try: |
| 146 | ser.open() |
Chris Liechti | 34290f4 | 2015-08-17 03:08:24 +0200 | [diff] [blame] | 147 | except serial.SerialException as e: |
Chris Liechti | 6948bd8 | 2015-09-07 23:38:37 +0200 | [diff] [blame] | 148 | logging.error("Could not open serial port {}: {}".format(ser.name, e)) |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 149 | sys.exit(1) |
| 150 | |
Chris Liechti | 6948bd8 | 2015-09-07 23:38:37 +0200 | [diff] [blame] | 151 | logging.info("Serving serial port: {}".format(ser.name)) |
| 152 | settings = ser.get_settings() |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 153 | |
| 154 | srv = socket.socket(socket.AF_INET, socket.SOCK_STREAM) |
| 155 | srv.setsockopt(socket.SOL_SOCKET, socket.SO_REUSEADDR, 1) |
Chris Liechti | 34290f4 | 2015-08-17 03:08:24 +0200 | [diff] [blame] | 156 | srv.bind(('', args.localport)) |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 157 | srv.listen(1) |
Chris Liechti | 6948bd8 | 2015-09-07 23:38:37 +0200 | [diff] [blame] | 158 | logging.info("TCP/IP port: {}".format(args.localport)) |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 159 | while True: |
| 160 | try: |
Chris Liechti | 6948bd8 | 2015-09-07 23:38:37 +0200 | [diff] [blame] | 161 | client_socket, addr = srv.accept() |
| 162 | logging.info('Connected by {}:{}'.format(addr[0], addr[1])) |
| 163 | client_socket.setsockopt(socket.IPPROTO_TCP, socket.TCP_NODELAY, 1) |
| 164 | ser.rts = True |
| 165 | ser.dtr = True |
cliechti | d9a06ce | 2009-08-10 01:30:53 +0000 | [diff] [blame] | 166 | # enter network <-> serial loop |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 167 | r = Redirector( |
Chris Liechti | 0269b2c | 2016-02-14 23:45:23 +0100 | [diff] [blame] | 168 | ser, |
| 169 | client_socket, |
| 170 | args.verbosity > 0) |
cliechti | d9a06ce | 2009-08-10 01:30:53 +0000 | [diff] [blame] | 171 | try: |
Chris Liechti | 34290f4 | 2015-08-17 03:08:24 +0200 | [diff] [blame] | 172 | r.shortcircuit() |
cliechti | d9a06ce | 2009-08-10 01:30:53 +0000 | [diff] [blame] | 173 | finally: |
cliechti | 5cc3eb1 | 2009-08-11 23:04:30 +0000 | [diff] [blame] | 174 | logging.info('Disconnected') |
cliechti | d9a06ce | 2009-08-10 01:30:53 +0000 | [diff] [blame] | 175 | r.stop() |
Chris Liechti | 6948bd8 | 2015-09-07 23:38:37 +0200 | [diff] [blame] | 176 | client_socket.close() |
| 177 | ser.dtr = False |
| 178 | ser.rts = False |
Chris Liechti | 34290f4 | 2015-08-17 03:08:24 +0200 | [diff] [blame] | 179 | # Restore port settings (may have been changed by RFC 2217 |
| 180 | # capable client) |
Chris Liechti | 6948bd8 | 2015-09-07 23:38:37 +0200 | [diff] [blame] | 181 | ser.apply_settings(settings) |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 182 | except KeyboardInterrupt: |
Chris Liechti | 6948bd8 | 2015-09-07 23:38:37 +0200 | [diff] [blame] | 183 | sys.stdout.write('\n') |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 184 | break |
Chris Liechti | 4caf6a5 | 2015-08-04 01:07:45 +0200 | [diff] [blame] | 185 | except socket.error as msg: |
Chris Liechti | 6948bd8 | 2015-09-07 23:38:37 +0200 | [diff] [blame] | 186 | logging.error(str(msg)) |
cliechti | ef39b8b | 2009-08-07 18:22:49 +0000 | [diff] [blame] | 187 | |
cliechti | 5cc3eb1 | 2009-08-11 23:04:30 +0000 | [diff] [blame] | 188 | logging.info('--- exit ---') |