48 lines
2.2 KiB
Python
48 lines
2.2 KiB
Python
"""Dump per instant: pose, and per sensor corr_x, corr_y (minus the sensor median over the window), error_value (r = rejected).
|
|
Usage: python3 dump.py START END [OUT]"""
|
|
import sys, statistics
|
|
sys.path.insert(0, "tools/scripts")
|
|
import data
|
|
|
|
F = "data/FLORIDA"
|
|
S, E = data.parse_time(sys.argv[1]), data.parse_time(sys.argv[2])
|
|
W0, W1 = data.parse_time("2026-10-01T00:00Z"), data.parse_time("2026-10-11T09:45Z")
|
|
ms = data.load(F)
|
|
cam = {p["t"].replace(second=0, microsecond=0): p for p in data.load_camera(F)}
|
|
order = ["p1_r", "r1_r", "Massif 2", "Pont Ernen", "Sellette 3", "Sellette 4", "Sellette 5", "Sellette 6"]
|
|
short = {"p1_r": "p1", "r1_r": "r1", "Massif 2": "M2", "Pont Ernen": "PE", "Sellette 3": "S3", "Sellette 4": "S4", "Sellette 5": "S5", "Sellette 6": "S6"}
|
|
lev = {}
|
|
for s in order:
|
|
w = data.filter_window(ms[s], W0, W1)
|
|
lev[s] = tuple(statistics.median([m[c] for m in w if m[c] is not None]) for c in ("corr_x", "corr_y"))
|
|
by = {}
|
|
for s in order:
|
|
for m in data.filter_window(ms[s], S, E):
|
|
by.setdefault(m["t"], {})[s] = m
|
|
tg = ["Massif 2", "Sellette 4", "Sellette 5", "Sellette 6", "Pont Ernen", "Sellette 3"]
|
|
hdr = "time pan tilt rot scale | " + " | ".join(f"{short[s]:>2} cx cy ev" for s in tg) + " | p1 ev r1 ev"
|
|
out = [hdr]
|
|
for t in sorted(by):
|
|
p = cam.get(t.replace(second=0, microsecond=0))
|
|
ps = f"{p['pan']:7.4f} {p['tilt']:7.4f} {p['rotation']:7.4f} {p['scale']:.5f}" if p else " --- no pose --- "
|
|
cells = []
|
|
for s in tg:
|
|
m = by[t].get(s)
|
|
if not m:
|
|
cells.append(" missing "); continue
|
|
r = "r" if data.rejected(m) else " "
|
|
if m["corr_x"] is None:
|
|
cells.append(f" - - {m['error_value']:.2f}{r}")
|
|
else:
|
|
cells.append(f"{m['corr_x']-lev[s][0]:+.2f} {m['corr_y']-lev[s][1]:+.2f} {m['error_value']:.2f}{r}")
|
|
refs = []
|
|
for s in ("p1_r", "r1_r"):
|
|
m = by[t].get(s)
|
|
refs.append(f"{m['error_value']:.2f}{'r' if data.rejected(m) else ' '}" if m else " - ")
|
|
out.append(f"{data.iso(t)[5:16]} {ps} | " + " | ".join(cells) + " | " + " ".join(refs))
|
|
txt = "\n".join(out)
|
|
if len(sys.argv) > 3:
|
|
open(sys.argv[3], "w").write(txt + "\n")
|
|
else:
|
|
print(txt)
|