Repository navigation
odometry_fusion: one error-state filter for every source, with or without an IMU - #3
Open
jeff-hykin wants to merge 14 commits into
Open
jeff-hykin wants to merge 14 commits into
jeff-hykin wants to merge 14 commits into
Conversation
…g a source out Without an IMU an absolute source pulls the blended pose back by a per-dimension scalar Kalman gain, so the low-noise source carries the short term and the absolute one the long term. With an IMU its pose is an absolute fix. A rejected delta now re-anchors to the filter pose instead of leaving every later target behind, and a source rejected for a second straight is fused ungated.
… and test what each fix changes
…drift" This reverts commit 213b847.
…ariance, and test what each fix changes" This reverts commit aaafadb.
…m locking a source out" This reverts commit e8acbeb.
… velocity without an IMU Sources declare a kind: pose (aligned once, then absolute), twist (body velocity) or pose_delta (relative motion by stochastic cloning). Replaces the no-IMU blend, anchored deltas and per_dimension_error_variance; planar mode pins z, roll and pitch by projection.
…mp keeps its heading
…ces, in both modes per_dimension_error_variance went with the old IMU-only rows, but besides the planar case (now `planar`) it held a base that cannot slide sideways to vy = 0; nothing replaced that.
…hey could only drag its bias, and real rocking tilted the filter
…ocity and, without an IMU, holds the motion model still, so the pose settles instead of wandering under a pose source's noise
This file contains hidden or bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Sign up for free
to join this conversation on GitHub.
Already have an account?
Sign in to comment
Add this suggestion to a batch that can be applied as a single commit.This suggestion is invalid because no changes were made to the code.Suggestions cannot be applied while the pull request is closed.Suggestions cannot be applied while viewing a subset of changes.Only one suggestion per line can be applied in a batch.Add this suggestion to a batch that can be applied as a single commit.Applying suggestions on deleted lines is not supported.You must change the existing code in this line in order to create a valid suggestion.Outdated suggestions cannot be applied.This suggestion has been applied or marked resolved.Suggestions cannot be applied from pending reviews.Suggestions cannot be applied on multi-line comments.Suggestions cannot be applied while the pull request is queued to merge.Suggestion cannot be applied right now. Please check back later.
Replaces the no-IMU blend and its patches with one ESKF (constant-velocity prediction without an IMU, sources fused by kind: pose, twist or pose_delta, planar mode in both); on an R1 replay jitter drops from 13.8 mm (Point-LIO alone) to 4.9 mm.