109 lines
4.1 KiB
Python
109 lines
4.1 KiB
Python
import os, sys, time, csv, statistics, threading, queue
|
|
|
|
scriptDir = os.path.dirname(os.path.realpath(__file__))
|
|
DEFAULT_OUTDIR = os.path.join(scriptDir, "logs")
|
|
|
|
class DeviceWorker:
|
|
"""
|
|
Arbeitet genau wie dein Single-Gerät-Logger:
|
|
- filter_window_size Rohsamples pro Loop
|
|
- ~10 Hz Loop (interval=0.1)
|
|
- 1 Hz Logging (eine CSV-Zeile pro Sekunde)
|
|
Wichtig: kontrolliert NICHT die Session!
|
|
"""
|
|
def __init__(self, dev, outdir=DEFAULT_OUTDIR, filter_window_size=10, interval=0.1):
|
|
self.dev = dev
|
|
self.serial = getattr(dev, "serial", "UNKNOWN")
|
|
self.outdir = outdir
|
|
self._log_path = None
|
|
self.filter_window_size = filter_window_size
|
|
self.interval = interval
|
|
|
|
self._running = False
|
|
self._stop_evt = threading.Event()
|
|
self._cmdq = queue.Queue()
|
|
self._writer_q = queue.Queue(maxsize=50)
|
|
|
|
self._reader_t = threading.Thread(target=self._reader_loop, daemon=True)
|
|
self._writer_t = threading.Thread(target=self._writer_loop, daemon=True)
|
|
|
|
# ---- API ----
|
|
def start(self):
|
|
print(f"[{self.serial}] Worker.start()")
|
|
if not self._reader_t.is_alive(): self._reader_t.start()
|
|
if not self._writer_t.is_alive(): self._writer_t.start()
|
|
self._cmdq.put(("start", None))
|
|
|
|
def stop(self):
|
|
print(f"[{self.serial}] Worker.stop()")
|
|
self._cmdq.put(("stop", None))
|
|
|
|
def _reader_loop(self):
|
|
print(f"[{self.serial}] Reader gestartet (interval={self.interval}, n={self.filter_window_size})")
|
|
last_log = 0.0
|
|
while not self._stop_evt.is_set():
|
|
try:
|
|
cmd, _ = self._cmdq.get_nowait()
|
|
if cmd == "start":
|
|
self._running = True
|
|
print(f"[{self.serial}] RUNNING")
|
|
elif cmd == "stop":
|
|
self._running = False
|
|
print(f"[{self.serial}] STOPPED")
|
|
except queue.Empty:
|
|
pass
|
|
|
|
if not self._running:
|
|
time.sleep(0.05)
|
|
continue
|
|
|
|
try:
|
|
# WÄHLE HIER DIE SIGNATUR, DIE DEIN SINGLE-LOGGER NUTZT:
|
|
# Beispiel A (deine Datei ließ 'read(n, 500, True)' vermuten):
|
|
samples = self.dev.read(self.filter_window_size, 500, True)
|
|
# Beispiel B (andere pysmu-Versionen):
|
|
# samples = self.dev.read(self.filter_window_size, -1)
|
|
|
|
if not samples:
|
|
time.sleep(self.interval)
|
|
continue
|
|
|
|
vA = statistics.mean(row[0] for row in samples)
|
|
vB = statistics.mean(row[2] for row in samples)
|
|
|
|
now = time.time()
|
|
if now - last_log >= 1.0:
|
|
self._writer_q.put((now, vA, vB))
|
|
last_log = now
|
|
|
|
except Exception as e:
|
|
print(f"[{self.serial}] Read-Fehler: {e}")
|
|
time.sleep(0.05)
|
|
|
|
time.sleep(max(0.05, self.interval))
|
|
|
|
def _writer_loop(self):
|
|
try:
|
|
os.makedirs(self.outdir, exist_ok=True)
|
|
except Exception as e:
|
|
print(f"[{self.serial}] os.makedirs-Fehler für '{self.outdir}': {e}")
|
|
return
|
|
|
|
self._log_path = os.path.join(self.outdir, f"{time.strftime('%Y%m%d_%H%M%S')}_{self.serial}.csv")
|
|
print(f"[{self.serial}] Writer startet → {self._log_path}")
|
|
|
|
try:
|
|
with open(self._log_path, "w", newline="") as f:
|
|
w = csv.writer(f)
|
|
w.writerow(["timestamp", "A", "B"]) # Datei wird JETZT angelegt
|
|
while not (self._stop_evt.is_set() and self._writer_q.empty()):
|
|
try:
|
|
ts, vA, vB = self._writer_q.get(timeout=0.5)
|
|
except queue.Empty:
|
|
continue
|
|
w.writerow([ts, vA, vB])
|
|
f.flush()
|
|
except Exception as e:
|
|
print(f"[{self.serial}] Writer-Fehler ({self._log_path}): {e}")
|
|
finally:
|
|
print(f"[{self.serial}] Writer beendet: {self._log_path}") |