-
Notifications
You must be signed in to change notification settings - Fork 0
Expand file tree
/
Copy pathserial_controller.py
More file actions
205 lines (163 loc) · 7.04 KB
/
serial_controller.py
File metadata and controls
205 lines (163 loc) · 7.04 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
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
#!/usr/bin/python
from threading import Thread, Event
from Queue import Queue, Empty, Full
from serial import Serial
from serial.tools.list_ports import comports
import logging
from time import sleep
from sys import platform
from os import path, makedirs
######################Logging setup##########################################
log = logging.getLogger('serial_controller_module')
log.setLevel(logging.INFO)
#create a file handler
if 'win' in platform:
log_dir = 'C:\ProgramData\connectduino\logs\\'
else:
log_dir = '/var/log/connectduino/'
if not path.exists(log_dir):
makedirs(log_dir)
file_name = 'serialduino.log'
handler = logging.FileHandler(path.join(log_dir, file_name))
handler.setLevel(logging.INFO)
#create a Logging format
formatter = logging.Formatter('%(asctime)s - %(name)s - %(levelname)s - %(message)s')
handler.setFormatter(formatter)
#add the handlers to the Logger
log.addHandler(handler)
class SerialController:
def __init__(self, queue):
self.serial_connections = {}
self.data_queue = queue
self.shutdown_event = Event()
self.serial_connection_listener = SerialConnectionListener(self.shutdown_event, self.data_queue)
self.serial_connection_listener.start()
self.log = logging.getLogger('serial_controller_module.SerialController')
self.log.debug("leaving SerialController init method")
def shutdown(self):
self.shutdown_event.set()
while self.shutdown_event.is_set():
pass
class SerialConnectionListener(Thread):
def __init__(self, shutdown_event, data_queue):
super(SerialConnectionListener, self).__init__()
self.shutdown_time = shutdown_event
self.listener_map = {}
self.listener_shutdown_event_map = {}
self.data_queue = data_queue
self.log = logging.getLogger('serial_controller_module.SerialConnectionListener')
def run(self):
log.info("running SerialConnectionListener thread")
try:
while not self.shutdown_time.is_set():
#log.debug('checking for ports')
self.remove_dead_ports()
#check for new connections
ports = comports()
#log.debug('ports found = ' + str(ports))
for port in ports:
if port.device not in self.listener_map:
self.listener_shutdown_event_map[port.device] = Event()
self.listener_map[port.device] = SerialListener(port.device, self.listener_shutdown_event_map[port.device], self.data_queue)
self.listener_map[port.device].start()
self.log.info("Listener created on port " + port.device)
self.log.debug('connected ports = ' + str(self.listener_map.keys()))
#sleep(.1)
except:
self.log.exception("Exception caught in SerialConnectionListener")
finally:
self.log.info('Shutting down SerialConnectionListener thread')
self.shutdown_listeners()
def remove_dead_ports(self):
#self.log.debug('removing dead ports')
dead_ports = []
for port, event in self.listener_shutdown_event_map.iteritems():
if event.is_set():
dead_ports.append(port)
for port in dead_ports:
self.log.debug('shutting down dead port' + port)
del self.listener_shutdown_event_map[port]
del self.listener_map[port]
def shutdown_listeners(self):
for port, event in self.listener_shutdown_event_map.iteritems():
event.set()
while len(self.listener_map) > 0:
dead_listeners = []
for port, listener in self.listener_map.iteritems():
if not listener.is_alive():
dead_listeners.append(port)
for port in dead_listeners:
del self.listener_map[port]
#log.debug('waiting on ' + str(self.listener_map.keys()))
self.shutdown_time.clear()
class SerialListener(Thread):
def __init__(self, port, shutdown_event, data_queue):
super(SerialListener, self).__init__()
self.port = port
self.shutdown_event = shutdown_event
self.data_queue = data_queue
self.log = logging.getLogger('serial_controller_module.SerialListener-' + self.port)
def run(self):
try:
#connect to port
self.log.debug('connecting to serial port ' + self.port)
conn = Serial(self.port, timeout=.005)
while not self.shutdown_event.is_set():
#get data from port
#self.log.debug('reading data from port ' + self.port)
self.log.debug('self.shutdown_event.is_set() = ' + str(self.shutdown_event.is_set()))
data = conn.readline()
self.log.debug('done reading data from port ' + self.port)
if data:
#self.log.debug('queueing data = ' + data)
try:
log.debug('queuing data')
self.data_queue.put_nowait(data)
except Full:
log.error('queue is full discarding data = ' + data)
else:
self.log.debug('data queued = ' + data)
#else:
# self.log.debug('no data read from port ' + self.port)
self.log.debug('self.shutdown_event.is_set() = ' + str(self.shutdown_event.is_set()))
self.log.info('shutdown event received closing port ' + self.port)
conn.close()
self.shutdown_event.clear()
except:
self.log.exception('exception thrown, shutting down port ' + self.port)
self.shutdown_event.set()
if __name__ == '__main__':
def analyze_queue(data_list):
for i, data in enumerate(sorted(data_list)):
if i != data:
return False
return True
log.info('\n\n#######################Starting up Server############################')
queue = Queue()
log.info('creating connection_listener')
connection_listener = SerialController(queue)
nums = []
try:
while True:
try:
#log.debug('getting value')
val = queue.get(timeout=.05)
queue.task_done()
#log.debug('done getting value')
except Empty:
log.debug("queue empty on get call") # noisy logging
pass
else:
try:
nums.append(int(val))
#log.info('value received = ' + str(val))
#queue.task_done()
except:
pass
except KeyboardInterrupt:
log.info('Keyboard interrupt received. Shutting down connection listener')
log.info('length of array = ' + str(len(nums)))
log.info(str(sorted(nums)))
log.info('All present: ' + str(analyze_queue(nums)))
connection_listener.shutdown()
log.info('Shutting down main')