Skip to content

Commit

Permalink
fix: Kalman Filter with ATLAS Stepper (#1223)
Browse files Browse the repository at this point in the history
Fix the issues related to the ATLASStepper so that it is usable with the KF :
- The pVector is the updated in `update` instead of `resetState` it seems this is the equivalent of the jacToGlobal in the EigenStepper
- The pVector is not updated when calling `transportCovarianceToBound` this would let to the covariance changing depending on how many time this method was called
- The ATLAS Stepper now create state with the transpose of its jacobian (which correspond to the same jacobian as the Eigen Stepper one)
- With this implementation the stepper curently doesn't work when encountering non-measurement surfaces, this is probably due to some kind of reinitialisation not being perform correctly ? This should be investigated.

And the `PropagationCompareAtlasEigenConstant` now also compares the covariances.
  • Loading branch information
Corentin-Allaire authored May 18, 2022
1 parent 6c2807a commit 7a4ea5a
Show file tree
Hide file tree
Showing 4 changed files with 315 additions and 334 deletions.
Loading

0 comments on commit 7a4ea5a

Please sign in to comment.