forked from wuxiaohua1011/ROAR_iOS
-
Notifications
You must be signed in to change notification settings - Fork 0
Expand file tree
/
Copy pathtransform_streamer.py
More file actions
47 lines (39 loc) · 1.55 KB
/
transform_streamer.py
File metadata and controls
47 lines (39 loc) · 1.55 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
import logging
from ROAR.utilities_module.module import Module
from ROAR.utilities_module.data_structures_models import Transform
from typing import Optional, List
from pathlib import Path
from websocket import WebSocket
class TransformStreamer(Module):
def save(self, **kwargs):
# no need to save. use Agent's saving mechanism
pass
def __init__(self, host: str, port: int, name: str = "transform",
threaded: bool = True, update_interval: float = 0.01):
super().__init__(threaded=threaded, name=name, update_interval=update_interval)
self.logger = logging.getLogger(f"{self.name} server [{host}:{port}]")
self.host = host
self.port = port
self.transform: Transform = Transform()
self.ws = WebSocket()
self.logger.info(f"{name} initialized")
def connect(self):
for i in range(10):
try:
self.ws.connect(f"ws://{self.host}:{self.port}/{self.name}", timeout=0.1)
except Exception as e:
self.logger.error(e)
def receive(self):
try:
result: bytes = self.ws.recv()
try:
self.transform = Transform.fromBytes(result)
except Exception as e:
self.logger.error(f"Failed to parse data {e}. {result}")
except Exception as e:
# self.logger.error(f"Failed to get data: {e}")
pass
def run_in_series(self, **kwargs):
self.receive()
def shutdown(self):
super(TransformStreamer, self).shutdown()