-
Notifications
You must be signed in to change notification settings - Fork 1
/
Copy pathdte.py
136 lines (115 loc) · 4.89 KB
/
dte.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
from .dte_nus import DTENUS
from .dte_params import DTEParamMap
from .dte_types import BASE64, PASPW
import re
import logging
logger = logging.getLogger(__name__)
class DTE():
def __init__(self, device):
self._nus = DTENUS(device)
def _encode_command(self, command, params=[], param_values={}, args=[]):
if params:
payload = ','.join([DTEParamMap.param_to_key(x) for x in params])
elif args:
payload = ','.join(args)
elif param_values:
payload = ','.join(['{}={}'.format(DTEParamMap.param_to_key(x), DTEParamMap.encode(x, param_values[x])) for x in param_values])
else:
payload = ''
return '${cmd}#{length:03x};{payload}\r'.format(cmd=command, length=len(payload), payload=payload)
def _decode_response(self, resp):
success_regexp = '^\\$O;(?P<cmd>[A-Z]+)#(?P<len>[0-9a-fA-F]+);(?P<payload>.*)\r$'
fail_regexp = '^\\$N;(?P<cmd>[A-Z]+)#(?P<len>[0-9a-fA-F]+);(?P<error>[0-9]+)\r$'
success = re.match(success_regexp, resp)
if success:
return success.group('payload')
fail = re.match(fail_regexp, resp)
if fail:
raise Exception('{} - error {}'.format(fail.group('cmd'), fail.group('error')))
raise Exception('Bad response - {}'.format(resp))
def _decode_multi_response(self, resp):
return [self._decode_response(r + '\r') for r in resp.split('\r') if r]
def _decode_key_values(self, payload):
m = {}
for x in payload.strip().split(','):
key,value = x.split('=')
m[DTEParamMap.key_to_param(key)] = DTEParamMap.decode(key, value)
return m
def parmr(self, params=[]):
resp = self._nus.send(self._encode_command('PARMR', params=params))
return self._decode_key_values(self._decode_response(resp))
def statr(self, params=[]):
resp = self._nus.send(self._encode_command('STATR', params=params))
return self._decode_key_values(self._decode_response(resp))
def parmw(self, param_values={}):
resp = self._nus.send(self._encode_command('PARMW', param_values=param_values))
self._decode_response(resp)
def dumpd(self, log_type='sensor'):
log_d = {'system': 0,
'sensor': 1,
'gnss': 1,
'als': 2,
'ph': 3,
'rtd': 4,
'cdt': 5,
'axl': 6,
'pressure': 7 }
resp = self._nus.send(self._encode_command('DUMPD', args=['{}'.format(log_d[log_type])]), multi_response=True)
responses = self._decode_multi_response(resp)
raw_data = b''
for r in responses:
_, _, data = r.split(',')
decoded_data = BASE64.decode(data)
raw_data += decoded_data
return raw_data
def paspw(self, json_file_data):
resp = self._nus.send(self._encode_command('PASPW', args=[PASPW.encode(json_file_data)]), timeout=5.0)
self._decode_response(resp)
def erase(self, log_type):
log_d = {'all': 3,
'system': 2,
'sensor': 1,
'gnss': 1,
'als': 4,
'ph': 5,
'rtd': 6,
'cdt': 7,
'axl': 8,
'pressure': 9 }
resp = self._nus.send(self._encode_command('ERASE', args=['{}'.format(log_d[log_type])]))
self._decode_response(resp)
def factw(self):
resp = self._nus.send(self._encode_command('FACTW'))
self._decode_response(resp)
def rstvw(self, var_id):
resp = self._nus.send(self._encode_command('RSTVW', args=[str(var_id)]))
self._decode_response(resp)
def rstbw(self):
resp = self._nus.send(self._encode_command('RSTBW'))
self._decode_response(resp)
def scalw(self, sensor, step, value):
sensor_d = {'axl': 0,
'pressure': 1,
'als': 2,
'ph': 3,
'rtd': 4,
'cdt': 5,
'mcp47x6': 6 }
resp = self._nus.send(self._encode_command('SCALW', args=[str(sensor_d[sensor]), str(step), str(value)]))
self._decode_response(resp)
def scalr(self, sensor, step):
sensor_d = {'axl': 0,
'pressure': 1,
'als': 2,
'ph': 3,
'rtd': 4,
'cdt': 5,
'mcp47x6': 6 }
resp = self._nus.send(self._encode_command('SCALR', args=[str(sensor_d[sensor]), str(step)]))
return self._decode_response(resp)
def argostx(self, mod, power, freq, size, tcxo):
mod_d = {'A2': 0,
'A3': 1,
'A4': 2}
resp = self._nus.send(self._encode_command('SATTX', args=[str(mod_d[mod]), str(power), str(freq), str(size), str(tcxo)]))
self._decode_response(resp)