Diagnostica › Filtro

Filtro — Metriche real-time

Posa stimata, covarianza, qualità del matching e determinismo del ciclo AMCL.

● live
aggiornato mai fa

Sprint 9.A.5 + 9.A.5-bis + 9.B.4-c + 9.A.3-d + 9.B.6-c + 9.B.6-d.2 + 9.B.6-d.3-a/b/c. 7 widget live: posa + covarianza 3σ real-time, jitter, quality flags, residui + inlier ratio NDT (observe-mode), NEES window χ²(3 dof, 95 %) AMCL-vs-ground-truth, residui Mahalanobis ESKF + accept/reject lifetime, NEES paired ESKF-vs-AMCL. Header card ESKF: pulsante Reset filtro + chip 4-state lifecycle FSM (UNINIT / BOOTSTRAPPING / WARM / HEALTHY) sorgente /slox/eskf/health latched. NEES GT richiede slox_ground_truth (validation-only); l'ESKF è auto-incluso in slox.launch.py dalla slice -d.3-a.

Posa & covarianza 3σ
— · in attesa di prima pose
● live posa · stub ellisse
map frame+X →in attesa di prima pose su /slox/pose_with_quality
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 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
Scala 0 – 3 ms. Soglie: SLOX p99 < 2 ms · Bosch ref < 1 ms.
Residui matching · inlier ratio (NDT)
in attesa /slox/match_diagnostics
● in attesa · 9.B.4-b
Il nodo 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
Il nodo 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
transitions — · last —
Il nodo 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
Il nodo 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
Servono tre publisher allineati: /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 converging
Sorgenti bit: bit 0–2 da quality_node, bit 3–4 da Sprint 7.2 sensor failsafe, bit 5 da Sprint 9.B.10 feature starvation.
Sorgente: IRosLiveStream (FilterJitter, PoseWithQuality, AmclCovariance, MatchDiagnostics, GroundTruthPose). Aggiornamento push, no polling.
Si è verificato un errore non gestito. Ricarica 🗙