Diagnostica › Filtro
aggiornato mai fa
L'ellisse 3σ è un placeholder:
il publisher della covarianza 3×3 sarà aggiunto in
Sprint 9.A.5-bis backend; oggi disegniamo un'ellisse
derivata dal solo
Scala 0 – 3 ms.
Soglie: SLOX p99 < 2 ms ·
Bosch ref < 1 ms.
Il nodo
Il nodo
transitions — · last —
Il nodo
Il nodo
Servono tre publisher allineati:
Sorgenti bit: bit 0–2 da
Filtro — Metriche real-time
Posa stimata, covarianza, qualità del matching e determinismo del ciclo AMCL.
● live
Posa & covarianza 3σ
— · in attesa di prima pose
● live posa · stub ellisse
quality per fissare l'ingombro
visivo.
Jitter filtro (AMCL inter-arrival)
— ms · in attesa
Nessun publish su /slox/filter_jitter ancora ricevuto.
● live
1 ms Bosch
2 ms SLOX
mean
— ms
p95
— ms
p99
— ms
max
— ms
Residui matching · inlier ratio (NDT)
in attesa /slox/match_diagnostics
● in attesa · 9.B.4-b
slox_ndt_matcher (Sprint 9.B.4-b) non ha
ancora pubblicato sul topic /slox/match_diagnostics.
L'avvio è automatico via slox.launch.py; la prima
misura arriva quando /map, /scan_front
e /slox/pose_with_quality sono tutti vivi.
Sorgente: /slox/match_diagnostics @ ~5 Hz da
slox_ndt_matcher (observe-mode; non altera la pose AMCL).
Mahalanobis è unit-less (residui normalizzati dalla σ del filtro).
NEES window (χ² 95% 3-DoF)
in attesa /slox/ground_truth/pose
● in attesa · 9.A.3-b
slox_ground_truth (Sprint 9.A.3-b) è
un tool di validazione: NON viene avviato in produzione.
La harness lo lancia con
ros2 launch slox_ground_truth ground_truth.launch.py csv_path:=...
+ un log prismi della total station. Senza prismi
rigidi e Leica TS/MS, NEES resta in attesa per design.
NEES = eᵀ Σ⁻¹ e con e = (x_AMCL − x_GT, y, θ); Σ blocco
diagonale 2-D xy ⨁ yaw da /slox/amcl_covariance
(9.A.5-bis). Sorgente GT: /slox/ground_truth/pose
da total station Leica (Sprint 9.A.3-b validation-only).
Stato ESKF · 7-D filter
in attesa /slox/filter_state
seq 0 · init: false
● in attesa · 9.B.6-d.3-a
slox_eskf (Sprint 9.B.6-b) è
opt-in: lancialo con
ros2 launch slox_eskf eskf_observe.launch.py.
È observe-only — non sostituisce AMCL.
Residui Mahalanobis filtro (ESKF chi² gate)
in attesa /slox/filter_state
● in attesa · 9.B.6-b
slox_eskf non sta pubblicando su
/slox/filter_state. È un sidecar
observe-only: lo avvii a parte rispetto al lancio
di produzione.
Sorgente: /slox/filter_state.last_update_* e
counters lifetime. Verde a
7.82
(χ² 95%) è la soglia di guardia; oltre = candidate outlier.
NEES filtro-vs-AMCL (paired, χ² 95 % 3-DoF)
in attesa ESKF + AMCL allineati
● in attesa · paired-NEES
/slox/filter_state (ESKF, 9.B.6-b),
/slox/pose_with_quality (AMCL) e
/slox/amcl_covariance (9.A.5-bis).
Manca uno dei tre → widget in attesa.
NEES = eᵀ (P_ESKF + P_AMCL)⁻¹ e con
e = (px_ESKF − px_AMCL, py, wrap(θ)). Test di
consistenza fra due stimatori indipendenti,
NON un vero NEES (no ground truth). Sotto H0 ~ χ²(3).
Quality breakdown · flags PoseWithQuality
— · in attesa di prima pose
● live
bit 0
VALID
posa non valida
bit 1
DEGRADED
quality nominale
bit 2
MAPPING
AMCL attivo
bit 3
LIDAR
stream lidar nominale
bit 4
ODOM
stream odom nominale
bit 5
DEAD-RECK
match convergingquality_node, bit 3–4 da
Sprint 7.2 sensor failsafe, bit 5 da
Sprint 9.B.10 feature starvation.