Integrate EKF-Based Fusion of NDT Pose and Gyro Odometry Twist

Aperta
#755 0 commenti 0 reazioni 1 assegnatario Vedi su GitHub

I maintainer di solito rispondono entro 2 giorni

@nokosaaan ci sta già lavorando.

Dal 26/10/2026.

  • #689 di @nokosaaan — aperta
  • #690 di @nokosaaan — aperta
  • #796 di @nokosaaan — aperta

Valutazione

Questa issue non è ancora stata valutata.

Descrizione

Implement EKF localization in Awkernel to fuse NDT pose estimates and gyro odometry twist estimates, matching the behavior of the selected Autoware reference implementation. Produce periodic state estimates while handling asynchronous measurements and observation delays.

Scope:

  • Accept timestamped NDT pose and gyro odometry twist estimates with covariance
  • Implement state initialization, periodic prediction, and measurement updates
  • Preserve the reference state model, noise parameters, measurement gating, and delay-compensation behavior
  • Define coordinate-frame conventions, timestamp handling, and measurement buffering
  • Publish estimated pose and twist with covariance for downstream use
  • Define handling of missing, stale, rejected, and out-of-order measurements

Acceptance criteria:

  • State estimates and covariance match the reference within predefined tolerances under identical inputs, initialization, parameters, and prediction/update timing.
  • Tests cover straight motion, turning, stationary conditions, and different pose/twist input rates.
  • Delayed measurements, temporary NDT dropouts, and rejected observations are tested against documented expected behavior.
  • Initialization and reset behavior are reproducible and do not retain unintended state from previous runs.
  • Covariance outputs remain finite, symmetric, and positive semidefinite within defined numerical tolerances for valid test cases.
  • Prediction periods, measurement acceptance rules, and output timestamps are documented.
  • Execution time, scheduling delay, and memory usage are measured at representative input rates.
  • Test datasets, configurations, and reproduction steps are documented.

Out of scope:

NDT scan matching, gyro odometry computation, automatic initial-pose estimation, feedback of EKF estimates into NDT, and vehicle control.

Lingua principale
Rust
Stelle
282
Fork
12
Merge medio
2g 9h
PR unite (30g)
28

Preparare l'ambiente

Questo progetto non fornisce container di sviluppo, Dockerfile né guida per i contributori, quindi l'ambiente è a tuo carico: parti dal suo README e consulta la nostra guida al primo contributo per i passaggi generali.

Come iniziare

  1. Leggi tutta la issue e poi la guida ai contributi del progetto.
  2. Commenta sulla issue per dire che te ne occupi tu — evita che due persone facciano lo stesso lavoro.
  3. Fai un fork del repository e lavora su un branch.
  4. Apri una pull request che faccia riferimento al numero della issue.

Altre issue di tier4/awkernel

Tutte le issue di tier4/awkernel

Issue simili

Altre issue su Rust

Ricevi le nuove issue nella tua casella

Un breve riepilogo di issue GitHub adatte ai principianti.