-
Notifications
You must be signed in to change notification settings - Fork 0
/
switchedrelay.py
207 lines (166 loc) · 6.93 KB
/
switchedrelay.py
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
import sys
import time
import threading
import logging
import traceback
from select import poll
from select import POLLIN, POLLOUT, POLLHUP, POLLERR, POLLNVAL
#from pytun import TunTapDevice, IFF_TAP, IFF_NO_PI
from tun import TAP , IFF_TAP, IFF_NO_PI
from limiter import RateLimitingState
import tornado.ioloop
import tornado.web
import tornado.options
from tornado.concurrent import return_future
from tornado import websocket
FORMAT = '%(asctime)-15s %(message)s'
RATE = 40980.0 #unit: bytes
BROADCAST = '%s%s%s%s%s%s' % (chr(0xff),chr(0xff),chr(0xff),chr(0xff),chr(0xff),chr(0xff))
PING_INTERVAL = 30
logger = logging.getLogger('relay')
macmap = {}
@return_future
def delay_future(t, callback):
timestamp = time.time()
if timestamp < t:
return
else:
callback(t)
class TunThread(threading.Thread):
def __init__(self, *args, **kwargs):
super(TunThread, self).__init__(*args, **kwargs)
self.running = True
#self.tun = TunTapDevice(name="tap0", flags= (IFF_TAP | IFF_NO_PI))
self.tun = TAP(name='tap0', flags=(IFF_TAP | IFF_NO_PI))
self.tun.addr = '10.5.0.1'
self.tun.netmask = '255.255.0.0'
self.tun.mtu = 1500
self.tun.up()
def write(self, message):
self.tun.write(message)
def run(self):
p = poll()
p.register(self.tun, POLLIN)
try:
while(self.running):
#TODO: log IP headers in the future
pollret = p.poll(1000)
for (f,e) in pollret:
if f == self.tun.fileno() and (e & POLLIN):
buf = self.tun.read(self.tun.mtu+18) #MTU doesn't include header or CRC32
if len(buf):
logger.info('recv data from tap, len%s:' % len(buf))
mac = buf[0:6]
if mac == BROADCAST or (ord(mac[0]) & 0x1) == 1:
for socket in macmap.values():
def send_message():
try:
socket.rate_limited_downstream(str(buf))
except:
pass
loop.add_callback(send_message)
elif macmap.get(mac, False):
def send_message():
try:
macmap[mac].rate_limited_downstream(str(buf))
except:
pass
loop.add_callback(send_message)
except Exception:
tb = traceback.format_exc()
logger.error('tun thread: error. Closing\n%s' % tb)
finally:
self.tun.close()
class MainHandler(websocket.WebSocketHandler):
def __init__(self, *args, **kwargs):
super(MainHandler, self).__init__(*args,**kwargs)
self.remote_ip = self.request.headers.get('X-Forwarded-For', self.request.remote_ip)
logger.info('new user port[%s]: connected to switch device.' % self.remote_ip)
self.thread = None
self.mac = ''
self.allowance = RATE #unit: messages
self.last_check = time.time() #floating-point, e.g. usec accuracy. Unit: seconds
self.upstream = RateLimitingState(RATE, name='upstream', clientip=self.remote_ip)
self.downstream = RateLimitingState(RATE, name='downstream', clientip=self.remote_ip)
ping_future = delay_future(time.time()+PING_INTERVAL, self.do_ping)
loop.add_future(ping_future, lambda: None)
def do_ping(self, timestamp):
self.ping(str(timestamp))
ping_future = delay_future(time.time()+PING_INTERVAL, self.do_ping)
loop.add_future(ping_future, lambda: None)
def on_pong(self, data):
pass
def rate_limited_downstream(self, message):
if self.downstream.do_throttle(message):
self.write_message(message, binary=True)
def open(self):
self.set_nodelay(True)
def on_message(self, message):
#TODO: log IP headers in the future
dst_mac = ':'.join('{0:02x}'.format(ord(a)) for a in message[0:6])
src_mac = ':'.join('{0:02x}'.format(ord(a)) for a in message[6:12])
logger.info('recv packat from client:src mac:%s, dest mac:%s' % (src_mac,dst_mac))
#print("data:", message)
#Logs which user is tied to which MAC so that we detect which user is acting maliciously
if self.mac != message[6:12]:
if macmap.get(self.mac, False):
del macmap[self.mac]
self.mac = message[6:12]
formatted_mac = ':'.join('{0:02x}'.format(ord(a)) for a in message[6:12])
logger.info('user[%s]: update mac %s' % (self.remote_ip, formatted_mac))
# update mac forward table
macmap[self.mac] = self
dest = message[0:6]
try:
if dest == BROADCAST or (ord(dest[0]) & 0x1) == 1:
print('broadcast or multicast frame recvd')
if self.upstream.do_throttle(message):
print("broadcast to all port:", macmap.keys())
for socket in macmap.values():
try:
socket.write_message(str(message),binary=True)
except Exception:
print('write broad packat except:',e)
pass
print("broadcast to tap0")
tunthread.write(message)
elif macmap.get(dest, False):
print('found dst client')
if self.upstream.do_throttle(message):
try:
macmap[dest].write_message(str(message),binary=True)
except:
print('write err')
pass
else:
print('no found dst mac, default forward to tap0')
if self.upstream.do_throttle(message):
tunthread.write(message)
except:
tb = traceback.format_exc()
logger.error('%s: error on receive. Closing\n%s' % (self.remote_ip, tb))
try:
self.close()
except:
pass
def on_close(self):
logger.info('%s: disconnected.' % self.remote_ip)
if self.thread is not None:
self.thread.running = False
try:
del macmap[self.mac]
except:
pass
application = tornado.web.Application([(r'/', MainHandler)])
if __name__ == '__main__':
tunthread = TunThread()
tunthread.start()
args = sys.argv
tornado.options.parse_command_line(args)
application.listen(8080)
loop = tornado.ioloop.IOLoop.instance()
try:
loop.start()
except:
pass
tunthread.running = False;