-
Notifications
You must be signed in to change notification settings - Fork 7
/
Copy pathsimple_rpc.py
249 lines (190 loc) · 7.44 KB
/
simple_rpc.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
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
from functools import wraps
from time import sleep
from types import MethodType
from typing import Any, TextIO
from serial import serial_for_url
from serial.serialutil import SerialException
from yaml import FullLoader, dump, load
from .extras import make_function
from .io import read, read_byte_string, until, write
from .protocol import parse_line
_protocol = 'simpleRPC'
_version = (4, 0, 0)
_list_req = 0xff
def _assert_protocol(protocol: str) -> None:
if protocol != _protocol:
raise ValueError('invalid protocol header')
def _assert_version(version: tuple) -> None:
if version[0] != _version[0] or version[1] > _version[1]:
raise ValueError(
'version mismatch (device: {}, client: {})'.format(
'.'.join(map(str, version)),
'.'.join(map(str, _version))))
class _Interface(object):
"""Generic simpleRPC interface."""
def __init__(
self: object, device: str, baudrate: int=9600, wait: int=2,
autoconnect: bool=True, load: TextIO=None) -> None:
"""
:arg device: Device name.
:arg baudrate: Baud rate.
:arg wait: Time in seconds before communication starts.
:arg autoconnect: Automatically connect.
:arg load: Load interface definition from file.
"""
self._wait = wait
self._connection = serial_for_url(
device, do_not_open=True, baudrate=baudrate)
self.device = {
'endianness': '<',
'methods': {},
'protocol': '',
'size_t': 'H',
'version': (0, 0, 0)}
if autoconnect:
self.open(load)
def __enter__(self: object) -> object:
return self
def __exit__(
self: object, exc_type: None, exc_val: None, exc_tb: None) -> None:
self.close()
def _open(self: object) -> None:
try:
self._connection.open()
except SerialException:
raise IOError('could not open device')
def _close(self: object) -> None:
self._connection.close()
def _select(self: object, index: int) -> None:
"""Initiate a remote procedure call, select the method.
:arg index: Method index.
"""
self._write('B', index)
def _write(self: object, obj_type: Any, obj: Any) -> None:
"""Provide parameters for a remote procedure call.
:arg obj_type: Type of the parameter.
:arg obj: Value of the parameter.
"""
write(
self._connection, self.device['endianness'], self.device['size_t'],
obj_type, obj)
def _read_byte_string(self: object) -> bytes:
return read_byte_string(self._connection)
def _read(self: object, obj_type: Any) -> Any:
"""Read a return value from a remote procedure call.
:arg obj_type: Return type.
:returns: Return value.
"""
return read(
self._connection, self.device['endianness'], self.device['size_t'],
obj_type)
def _get_methods(self: object) -> None:
"""Get remote procedure call methods."""
self._select(_list_req)
_assert_protocol(self._read_byte_string().decode())
self.device['protocol'] = _protocol
version = tuple(self._read('B') for _ in range(3))
_assert_version(version)
self.device['version'] = version
self.device['endianness'], self.device['size_t'] = (
chr(c) for c in self._read_byte_string())
for index, line in enumerate(
until(lambda x: x == b'', self._read_byte_string)):
method = parse_line(index, line)
self.device['methods'][method['name']] = method
def _load(self: object, handle: TextIO=None) -> None:
"""Load the interface definition from a file.
:arg handle: Open file handle.
"""
self.device = load(handle, Loader=FullLoader)
_assert_protocol(self.device.get('protocol', ''))
_assert_version(self.device.get('version', (0, 0, 0)))
def is_open(self: object) -> bool:
"""Query interface state."""
pass
def open(self: object, handle: TextIO=None) -> None:
"""Connect to device.
:arg handle: Open file handle.
"""
sleep(self._wait)
if handle:
self._load(handle)
else:
self._get_methods()
for method in self.device['methods'].values():
setattr(
self, method['name'], MethodType(make_function(method), self))
def close(self: object) -> None:
"""Disconnect from device."""
for method in self.device['methods']:
delattr(self, method)
self.device['methods'].clear()
def call_method(self: object, name: str, *args: Any) -> Any:
"""Execute a method.
:arg name: Method name.
:arg args: Method parameters.
:returns: Return value of the method.
"""
if name not in self.device['methods']:
raise ValueError('invalid method name: {}'.format(name))
method = self.device['methods'][name]
parameters = method['parameters']
if len(args) != len(parameters):
raise TypeError(
'{} expected {} arguments, got {}'.format(
name, len(parameters), len(args)))
# Call the method.
self._select(method['index'])
# Provide parameters (if any).
if method['parameters']:
for index, parameter in enumerate(method['parameters']):
self._write(parameter['fmt'], args[index])
# Read return value (if any).
if method['return']['fmt']:
return self._read(method['return']['fmt'])
# A `void` method writes a 0 for synchronisation purposes.
self._read('B')
return None
def save(self: object, handle: TextIO) -> None:
"""Save the interface definition to a file.
:arg handle: Open file handle.
"""
dump(self.device, handle, width=76, default_flow_style=False)
class SerialInterface(_Interface):
"""Serial simpleRPC interface."""
@wraps(_Interface.is_open)
def is_open(self: object) -> bool:
return self._connection.isOpen()
@wraps(_Interface.open)
def open(self: object, handle: TextIO=None) -> None:
self._open()
super().open(handle)
@wraps(_Interface.close)
def close(self: object) -> None:
super().close()
self._close()
class SocketInterface(_Interface):
"""Socket simpleRPC interface."""
def _auto_open(f: callable) -> callable:
"""Decorator for automatic opening and closing of ethernet sockets."""
@wraps(f)
def _auto_open_wrapper(
self: object, *args: Any, **kwargs: Any) -> Any:
self._open()
result = f(self, *args, **kwargs)
self._close()
return result
return _auto_open_wrapper
@wraps(_Interface.is_open)
def is_open(self: object) -> bool:
return len(self.device['methods']) > 0
open = _auto_open(_Interface.open)
call_method = _auto_open(_Interface.call_method)
class Interface(object):
"""Generic simpleRPC interface wrapper."""
@wraps(_Interface.__init__)
def __new__(
cls: object, device: str, *args: Any, **kwargs: Any) -> object:
if device.startswith('socket'):
return SocketInterface(device, *args, **kwargs)
return SerialInterface(device, *args, **kwargs)