-
Notifications
You must be signed in to change notification settings - Fork 0
Expand file tree
/
Copy pathnet.py
More file actions
74 lines (59 loc) · 2.41 KB
/
Copy pathnet.py
File metadata and controls
74 lines (59 loc) · 2.41 KB
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
import math
from frame import Frame
from packet import Packet
class NetLayer:
def __init__(self):
self.frame_buffer = []
def rx(self, frames):
self.frame_buffer += frames
self.sync()
packets = self.frames_to_packet()
return packets
def tx(self, packet):
frames = []
if packet is not None:
frames = self.packet_to_frames(packet)
return frames
def packet_to_frames(self, packet):
frames = []
byte_array = []
byte_array += packet.id # Packet.HEADER_ID_BYTES
byte_array += packet.size.to_bytes(Packet.HEADER_SIZE_BYTES, byteorder='big')
byte_array += packet.receiver.to_bytes(Packet.HEADER_RECEIVER_BYTES, byteorder='big')
byte_array += packet.sender.to_bytes(Packet.HEADER_SENDER_BYTES, byteorder='big')
byte_array += packet.data
count = int(math.ceil(len(byte_array) / Frame.PAYLOAD_BYTES))
for i in range(count):
start_byte = i * Frame.PAYLOAD_BYTES
frame = Frame(i, count, byte_array[start_byte:start_byte + Frame.PAYLOAD_BYTES])
frames.append(frame)
return frames
def frames_to_packet(self):
packets = []
while True:
count = len(self.frame_buffer)
if count == 0:
return packets
packet_frames = self.frame_buffer[0].end
if packet_frames > count:
return packets
# we have enough frames to make a packet
byte_array = []
for i in range(packet_frames):
byte_array += self.frame_buffer[i].data
self.frame_buffer = self.frame_buffer[packet_frames:]
packet_id = int.from_bytes(byte_array[0:16], 'big')
packet_size = int.from_bytes(byte_array[16:18], 'big')
packet_receiver = int.from_bytes(byte_array[18:24], 'big')
packet_sender = int.from_bytes(byte_array[24:30], 'big')
packet_data = byte_array[30:30+packet_size]
packet = Packet(packet_id, packet_data, packet_receiver, packet_sender)
packets.append(packet)
return packets
def sync(self):
# Make sure we are in sync with packet bounds
while len(self.frame_buffer) > 0:
if self.frame_buffer[0].seq != 0:
self.frame_buffer = self.frame_buffer[1:]
else:
return