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
|
#!/usr/bin/env python2
# -*- coding: utf-8 -*-
# TRX Toolkit
# DATA interface implementation
#
# (C) 2017-2019 by Vadim Yanitskiy <axilirator@gmail.com>
#
# All Rights Reserved
#
# This program is free software; you can redistribute it and/or modify
# it under the terms of the GNU General Public License as published by
# the Free Software Foundation; either version 2 of the License, or
# (at your option) any later version.
#
# This program is distributed in the hope that it will be useful,
# but WITHOUT ANY WARRANTY; without even the implied warranty of
# MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
# GNU General Public License for more details.
#
# You should have received a copy of the GNU General Public License along
# with this program; if not, write to the Free Software Foundation, Inc.,
# 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
import logging as log
from udp_link import UDPLink
from data_msg import *
class DATAInterface(UDPLink):
def __init__(self, *udp_link_args):
# Default header version (legacy)
self._hdr_ver = 0x00
UDPLink.__init__(self, *udp_link_args)
log.debug("Init TRXD interface (%s)" % self.desc_link())
def set_hdr_ver(self, ver):
if not ver in DATAMSG.known_versions:
return False
self._hdr_ver = ver
return True
def match_hdr_ver(self, msg):
if msg.ver == self._hdr_ver:
return True
log.error("(%s) Rx DATA message (%s) with unexpected header "
"version %u (!= expected %u), ignoring..."
% (self.desc_link(), msg.desc_hdr(),
msg.ver, self._hdr_ver))
return False
def recv_raw_data(self):
data, _ = self.sock.recvfrom(512)
return data
def recv_l12trx_msg(self):
# Read raw data from socket
data = self.recv_raw_data()
# Attempt to parse as a L12TRX message
try:
msg = DATAMSG_L12TRX()
msg.parse_msg(bytearray(data))
except:
log.error("Failed to parse a L12TRX message "
"from R:%s:%u" % (self.remote_addr, self.remote_port))
return None
# Make sure the header version matches
# the configured one (self._hdr_ver)
if not self.match_hdr_ver(msg):
return None
return msg
def recv_trx2l1_msg(self):
# Read raw data from socket
data = self.recv_raw_data()
# Attempt to parse as a L12TRX message
try:
msg = DATAMSG_TRX2L1()
msg.parse_msg(bytearray(data))
except:
log.error("Failed to parse a TRX2L1 message "
"from R:%s:%u" % (self.remote_addr, self.remote_port))
return None
# Make sure the header version matches
# the configured one (self._hdr_ver)
if not self.match_hdr_ver(msg):
return None
return msg
def send_msg(self, msg, legacy = False):
# Validate a message
if not msg.validate():
raise ValueError("Message incomplete or incorrect")
# Generate TRX message
payload = msg.gen_msg(legacy)
# Send message
self.send(payload)
|
