Skip to content

Add TUM trajectory support to Step 2, treated like GNSS - #487

Merged
JanuszBedkowski merged 2 commits into
mainfrom
mp/step2_tum
Aug 15, 2026
Merged

Add TUM trajectory support to Step 2, treated like GNSS#487
JanuszBedkowski merged 2 commits into
mainfrom
mp/step2_tum

Conversation

@michalpelka

Copy link
Copy Markdown
Contributor

Loads TUM-format trajectories (Core/tum.h/.cpp), renders them as GPU point dots via a new ScanRenderer::PointsGPU cache (upload once, draw many, avoiding per-frame VAO/VBO churn), and draws correspondence lines to each scan's nearest local_trajectory sample by timestamp (matching timestamps.first in nanoseconds against TUM's Unix-epoch-seconds timestamp, scaled by 1e9).

Also adds a manual-loop-closure "Fuse trajectory with TUM (trajectory is rigid)" action mirroring the existing GNSS one, via a new PoseGraphLoopClosure::FuseTrajectoryWithTUM().

Gallery:
TUM trajectory and correspondences
Screenshot 2026-08-14 at 23 10 04

Tum registration:
Screenshot 2026-08-14 at 23 10 27

After registration:
Screenshot 2026-08-14 at 23 10 47

michalpelka and others added 2 commits August 14, 2026 23:12
Loads TUM-format trajectories (Core/tum.h/.cpp), renders them as GPU
point dots via a new ScanRenderer::PointsGPU cache (upload once, draw
many, avoiding per-frame VAO/VBO churn), and draws correspondence lines
to each scan's nearest local_trajectory sample by timestamp (matching
timestamps.first in nanoseconds against TUM's Unix-epoch-seconds
timestamp, scaled by 1e9).

Also adds a manual-loop-closure "Fuse trajectory with TUM (trajectory
is rigid)" action mirroring the existing GNSS one, via a new
PoseGraphLoopClosure::FuseTrajectoryWithTUM().

Co-Authored-By: Claude Sonnet 5 <noreply@anthropic.com>
Signed-off-by: Michal Pelka <michalpelka@gmail.com>
@michalpelka michalpelka mentioned this pull request Aug 14, 2026
@JanuszBedkowski
JanuszBedkowski merged commit 8615fc9 into main Aug 15, 2026
7 checks passed
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

None yet

Projects

None yet

Development

Successfully merging this pull request may close these issues.

2 participants